发明名称 一种离线的桥式吊车轨迹控制方法
摘要 一种离线的桥式吊车轨迹控制方法,具有约束的欠驱动桥式吊车加速度轨迹控制方法,包括如下步骤:步骤1、轨迹规划方案,采用光滑的加速度运动轨迹;步骤2、确定轨迹参数,对于任意运送过程,通过求解吊车系统的运动学方程,分析台车加速度与负载摆动之间的耦合关系,计算出实际最大加速度a<sub>max</sub>、匀加速t<sub>a</sub>时间和匀速时间t<sub>c</sub>即可得到一种理想的加速度轨迹满足如下一些核心的性能指标;步骤3、控制方法的实现,借助传感器实时得到的台车位移信号x(t)及速度信号<img file="DDA0000536698760000011.GIF" wi="117" he="64" />实时计算x(t)、<img file="DDA0000536698760000012.GIF" wi="96" he="64" />与加速度信号<img file="DDA0000536698760000013.GIF" wi="112" he="64" />的连续积分信号x<sub>v</sub>(t)、<img file="DDA0000536698760000014.GIF" wi="117" he="64" />之间的偏差,使用传统的PD控制器产生相应的驱动电机的控制命令,实现对吊车的控制,完成运输任务。
申请公布号 CN104129713A 申请公布日期 2014.11.05
申请号 CN201410330405.1 申请日期 2014.07.11
申请人 浙江工业大学 发明人 武宪青;欧县华;何熊熊
分类号 B66C13/18(2006.01)I 主分类号 B66C13/18(2006.01)I
代理机构 杭州天正专利事务所有限公司 33201 代理人 王兵;黄美娟
主权项 具有约束的欠驱动桥式吊车加速度轨迹控制方法,包括如下步骤:步骤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>&RightArrow;</mo><mo>&infin;</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>&le;</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>&le;</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>&theta;</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><mn>0</mn><mo>,</mo><mo>&ForAll;</mo><mi>t</mi><mo>&GreaterEqual;</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控制器产生相应的驱动电机的控制命令,实现对吊车的控制,完成运输任务。
地址 310014 浙江省杭州市下城区潮王路18号