发明名称 基于轨迹在线规划的桥式吊车高效消摆控制方法
摘要 基于轨迹在线规划的桥式吊车高效消摆控制方法。该方法包括:构造一个摆角消除环节,可有效地抑制负载的大幅度摆动,并快速地消除台车到达目标位置之后负载的残余摆角;将摆角消除环节与定位参考轨迹以线性方式组合在一起,生成最终轨迹,可保证台车的精确定位,同时能够有效地消除负载的摆角与残余摆角。相比已有的吊车轨迹规划技术,该方法可在线地生成消摆轨迹,其简单易行、在线运算量小、台车运送效率高、消摆速度快,非常适用于吊车系统的实时控制。
申请公布号 CN102795544B 申请公布日期 2014.05.07
申请号 CN201210292959.8 申请日期 2012.08.16
申请人 南开大学 发明人 方勇纯;孙宁;张一淳
分类号 B66C13/06(2006.01)I;B66C13/22(2006.01)I 主分类号 B66C13/06(2006.01)I
代理机构 天津佳盟知识产权代理有限公司 12002 代理人 侯力
主权项 1.一种基于轨迹在线规划的桥式吊车高效消摆控制方法,其特征在于该方法包括:第1、轨迹规划方案提出一种全新的桥式吊车在线轨迹规划方案;要规划的加速度轨迹<img file="FDA0000463708930000011.GIF" wi="112" he="76" />具有如下表达式:<maths num="0001"><![CDATA[<math><mrow><msub><mover><mi>x</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><mi>c</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><msub><mover><mi>x</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><mi>r</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>+</mo><mi>&rho;</mi><mrow><mo>(</mo><mi>&theta;</mi><mo>,</mo><mover><mi>&theta;</mi><mo>&CenterDot;</mo></mover><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>4</mn><mo>)</mo></mrow></mrow></math>]]></maths>式中,t表示时间,变量后面(t)表示该变量为关于时间的变量,第一部分<img file="FDA0000463708930000013.GIF" wi="114" he="76" />为定位参考加速度轨迹,用来保证台车的精确定位;第二部分<img file="FDA0000463708930000014.GIF" wi="136" he="81" />则表示摆角消除环节,是关于负载摆角θ(t)及其角速度<img file="FDA0000463708930000015.GIF" wi="88" he="81" />的函数,用以抑制与消除负载的摆动,其中负载摆角θ(t)简记为θ,角速度<img file="FDA0000463708930000016.GIF" wi="97" he="81" />简记为<img file="FDA0000463708930000017.GIF" wi="69" he="74" />具体步骤包括:第1.1、摆角消除环节设计;通过充分地分析台车与负载之间的动态耦合关系,为台车运动设计一种新型的摆角消除环节<img file="FDA0000463708930000018.GIF" wi="169" he="81" />它具有如下结构:<maths num="0002"><![CDATA[<math><mrow><mi>&rho;</mi><mrow><mo>(</mo><mi>&theta;</mi><mo>,</mo><mover><mi>&theta;</mi><mo>&CenterDot;</mo></mover><mo>)</mo></mrow><mo>=</mo><msub><mover><mi>x</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><mi>e</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><mi>&kappa;</mi><mover><mi>&theta;</mi><mo>&CenterDot;</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>6</mn><mo>)</mo></mrow></mrow></math>]]></maths>其中,<img file="FDA00004637089300000110.GIF" wi="108" he="77" />为摆角消除环节,同<img file="FDA00004637089300000111.GIF" wi="170" he="81" />为方便描述及统一表达而引进,κ≥1为正的消摆增益;第1.2、定位参考加速度轨迹<img file="FDA00004637089300000112.GIF" wi="107" he="76" />的选取;主要考虑台车的运行效率、轨迹的光滑性,在此应用常规的S形轨迹;第2、轨迹在线生成在确定参考加速度轨迹<img file="FDA00004637089300000113.GIF" wi="143" he="76" />摆角消除环节<img file="FDA00004637089300000114.GIF" wi="107" he="75" />的具体表达式后,借助实时仿真或实验软件在线求解如下微分方程,得到θ(t)与<img file="FDA00004637089300000115.GIF" wi="115" he="81" /><maths num="0003"><![CDATA[<math><mrow><mi>l</mi><mover><mi>&theta;</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>+</mo><mi>cos</mi><mi>&theta;</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>&CenterDot;</mo><mi>&rho;</mi><mrow><mo>(</mo><mi>&theta;</mi><mo>,</mo><mover><mi>&theta;</mi><mo>&CenterDot;</mo></mover><mo>)</mo></mrow><mo>+</mo><mi>g</mi><mi>sin</mi><mi>&theta;</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><mo>-</mo><msub><mrow><mi>cos</mi><mi>&theta;</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>&CenterDot;</mo><mover><mi>x</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover></mrow><mi>r</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>5</mn><mo>)</mo></mrow></mrow></math>]]></maths>式中,l为吊绳长度,<img file="FDA00004637089300000117.GIF" wi="95" he="80" />为摆角加速度,g表示重力加速度;将在线计算得到的负载摆角θ(t)及摆角速度<img file="FDA00004637089300000118.GIF" wi="86" he="81" />代入式<img file="FDA00004637089300000119.GIF" wi="139" he="81" />的表达式(6),再由式(4)获得规划加速度轨迹<img file="FDA00004637089300000120.GIF" wi="136" he="76" />进而通过在线积分运算得到速度轨迹<img file="FDA00004637089300000121.GIF" wi="111" he="75" />及位移轨迹x<sub>c</sub>(t)如下:<maths num="0004"><![CDATA[<math><mrow><msub><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mi>c</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><msub><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mi>r</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>+</mo><msub><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mi>e</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><msub><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mi>r</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>+</mo><mi>&kappa;&theta;</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>21</mn><mo>)</mo></mrow></mrow></math>]]></maths><maths num="0005"><![CDATA[<math><mrow><msub><mi>x</mi><mi>c</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><msub><mi>x</mi><mi>r</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>+</mo><msub><mi>x</mi><mi>e</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><msub><mi>x</mi><mi>r</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>+</mo><mi>&kappa;</mi><msubsup><mo>&Integral;</mo><mn>0</mn><mi>t</mi></msubsup><mi>&theta;d&tau;</mi><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>22</mn><mo>)</mo></mrow></mrow></math>]]></maths>式中,<img file="FDA00004637089300000124.GIF" wi="113" he="75" />为<img file="FDA00004637089300000125.GIF" wi="112" he="75" />关于时间的积分,x<sub>r</sub>(t)为<img file="FDA00004637089300000126.GIF" wi="112" he="75" />关于时间的积分,<img file="FDA00004637089300000127.GIF" wi="108" he="75" />为<img file="FDA00004637089300000128.GIF" wi="109" he="75" />关于时间的积分,x<sub>c</sub>(t)为<img file="FDA00004637089300000129.GIF" wi="111" he="75" />关于时间的积分,<img file="FDA00004637089300000130.GIF" wi="110" he="75" />为<img file="FDA00004637089300000131.GIF" wi="104" he="75" />关于时间的积分,x<sub>e</sub>(t)为<img file="FDA00004637089300000132.GIF" wi="111" he="75" />关于时间的积分;第3、控制方法实现借助传感器实时反馈的台车位移信号x(t)与速度信号<img file="FDA0000463708930000021.GIF" wi="118" he="72" />实时计算x(t)、<img file="FDA0000463708930000022.GIF" wi="90" he="72" />与轨迹x<sub>c</sub>(t)、<img file="FDA0000463708930000023.GIF" wi="109" he="75" />之间的偏差,利用常规的PD控制器产生相应的驱动电机控制指令,实现吊车系统的高效消摆控制。
地址 300071 天津市南开区卫津路94号