主权项 |
具有约束的欠驱动桥式吊车加速度轨迹控制方法,包括如下步骤:步骤1、轨迹规划方案,采用光滑的加速度运动轨迹,其表达式如下:<img file="FDA0000536698730000011.GIF" wi="1301" he="990" />其中,a<sub>max</sub>为实际运送过程中所采用的最大加速度,τ∈(0,T4),t<sub>1</sub>=τ,t<sub>2</sub>=τ+t<sub>a</sub>,t<sub>3</sub>=2τ+t<sub>a</sub>,t<sub>4</sub>=2τ+t<sub>a</sub>+t<sub>c</sub>,t<sub>5</sub>=3τ+t<sub>a</sub>+t<sub>c</sub>,t<sub>6</sub>=3τ+2t<sub>a</sub>+t<sub>c</sub>,t<sub>7</sub>=4τ+2t<sub>a</sub>+t<sub>c</sub>,τ,t<sub>a</sub>,t<sub>c</sub>分别表示变加速(变减速)、匀加速(匀减速)和匀速时间常数,T为负载在恒定加速度下的振动周期;步骤2、确定轨迹参数对于任意运送过程,通过求解吊车系统的运动学方程,分析台车加速度与负载摆动之间的耦合关系,计算出实际最大加速度a<sub>max</sub>、匀加速t<sub>a</sub>时间和匀速时间t<sub>c</sub>即可得到一种理想的加速度轨迹满足如下一些核心的性能指标:a)台车在有限的时间内到达目标位置p<sub>d</sub>∈R,即<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><munder><mi>lim</mi><mrow><mi>t</mi><mo>→</mo><mo>∞</mo></mrow></munder><mi>x</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><msub><mi>p</mi><mi>d</mi></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000536698730000012.GIF" wi="477" he="101" /></maths>其中x(t)为台车的位移;b)在运送过程中,台车速度及加速度满足<maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><mo>|</mo><mover><mi>x</mi><mo>.</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>|</mo><mo>≤</mo><msub><mi>v</mi><mi>ub</mi></msub><mo>,</mo><mo>|</mo><mover><mi>x</mi><mrow><mo>.</mo><mo>.</mo></mrow></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>|</mo><mo>≤</mo><msub><mi>a</mi><mi>ub</mi></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>4</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000536698730000013.GIF" wi="716" he="85" /></maths>其中<img file="FDA0000536698730000021.GIF" wi="212" he="75" />分别为台车运送过程中的速度与加速度,v<sub>ub</sub>,a<sub>ub</sub>∈R<sup>+</sup>分别为吊车平台所能达到的最大速度及最大加速度;c)在运送过程中,负载最大摆角满足|θ(t)|≤θ<sub>ub</sub> (5)其中θ(t)为台车运送过程中负载的摆角,θ<sub>ub</sub>∈R<sup>+</sup>分别为吊车系统所能允许的最大摆角;d)当台车匀速运行或到达目标位置以后,负载与台车处于同一竖直线上,即负载与台车之间无相对运动<maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><mi>θ</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><mn>0</mn><mo>,</mo><mo>∀</mo><mi>t</mi><mo>≥</mo><msub><mi>t</mi><mi>f</mi></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>6</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000536698730000026.GIF" wi="530" he="74" /></maths>其中t<sub>f</sub>为台车到达目标位置的时间;步骤3、控制方法的实现借助传感器实时得到的台车位移信号x(t)及速度信号<img file="FDA0000536698730000022.GIF" wi="123" he="75" />实时计算x(t)、<img file="FDA0000536698730000023.GIF" wi="98" he="75" />与加速度信号<img file="FDA0000536698730000024.GIF" wi="120" he="78" />的连续积分信号x<sub>v</sub>(t)、<img file="FDA0000536698730000025.GIF" wi="121" he="78" />之间的偏差,使用传统的PD控制器产生相应的驱动电机的控制命令,实现对吊车的控制,完成运输任务。 |