什么值得买App下载 App ›
连续签到专享现金活动

西门子200 SMART倒立摆程序调试全流程解析

本文主要针对西门子200 SMART V2.8版本下的倒立摆控制程序进行详细解析。内容涵盖从系统回原点准备、速度环与位置环PID参数整定,到自动起摆(七百程序)逻辑实现的全过程。通过提取具体的调试参数阈值与对应的系统现象,明确了各控制环节的调试要点与逻辑关系。
01调试准备与基础设置
  1. 模式选择与回原点
    调试需在绝对模式下进行,首先执行回原点操作。
  2. 编码器复位
    回原点后保持编码器静止,若数值不为零需进行清零复位,确保基准准确。
  3. 人工辅助姿态
    调试初期需手动将摆杆扶至接近180度的垂直位置。
02速度环参数整定
速度环整定主要调节增益参数,暂不涉及积分项,微分项作用在此环节表现不明显。
参数设置系统现象调试结论
增益 = 5摆杆摆动速度很慢,小车能跟上手动摆动速度,但摆动幅度极小。参数过小,反应迟钝。
增益 = 15摆动速度恢复正常,视觉效果较为稳定。基本符合要求。
增益 = 18快速晃动时若出现丢步或异响(吱吱响),说明细分数过小;若无问题则速度适配。参数适中,小车能跟上摆动频率。

速度环增益调试现象对照表

仅调节速度环时,松开手后摆杆虽然能保持垂直,但小车会向左或向右持续加速偏移,这是因为未加入位置环控制。
03位置环参数整定
  1. 初始增益调节
    加入位置环增益0.05后,速度略有受控但仍向左跑;将增益提升至0.1,结合微分0.2至0.5,系统开始在原点附近震荡且幅度逐渐增大,说明参数仍需调整。
  2. 参数稳定优化
    增益提升至1.0时,滑台位置基本稳定在原点附近(如1013),摆杆角度维持在180度左右。若此时加入微量积分(如0.00几),滑台将更精准地锁定在0至1之间。
  3. 最终效果验证
    整定完成后,角度稳定在180度+,滑台位置在5至10之间跳动。施加外部干扰(轻推),摆杆能自动回到原点位置。
04自动起摆(七百程序)逻辑
“七百程序”用于实现倒立摆的自动起摆功能,其核心逻辑在于利用滑台的往复运动使摆杆获得动量,并在摆杆顺时针旋转接近目标角度时接管控制权。该程序要求在回原点后通过启动按钮触发。
关键参数参考数值说明
起摆角度阈值1950 (约178-179度)当检测到摆杆顺时针旋转且角度大于等于此值时,触发接管逻辑。
速度环增益18维持滑台运动速度的基础增益。
位置环增益/微分0.26 / 1.0起摆成功后稳定系统所需的PID参数。
往复运动高速500滑台左右往复运动以积蓄能量的速度。
往复运动低速470最后一次接近目标角度时的切入速度,速度较低便于接管。

自动起摆关键参数设置

程序执行时,滑台在0到70(死位置)之间往复运动。当摆杆顺时针摆动并检测到角度达到设定阈值(如179度)时,系统自动切换至平衡控制模式。调试时需注意,微分项在起摆切入瞬间起到关键的“刹车”作用,若设为0,滑台会随摆杆角度一直跑偏无法稳定。

评论

评论区空态插画

当前文章无评论,是时候发表评论了