发明名称 欠驱动吊车自适应消摆定位控制方法
摘要 一种欠驱动吊车自适应消摆定位控制方法。该方法包括:构造一种新型的储能函数,在此基础上,充分考虑轨道长度限制、参数未知/不确定等因素,设计一种新型的自适应消摆控制方法,增强台车运动与负载摆动之间的耦合关系,能保证台车准确定位,快速消除负载摆动,并可通过更新律在线补偿参数未知/不确定性因素带来的影响。相比已有方法,该方法能保证台车运动不超出轨道长度限制范围,可取得良好的控制效果,并对参数不确定性与外界扰动具有良好的鲁棒性。
申请公布号 CN104444817B 申请公布日期 2016.08.24
申请号 CN201410649866.5 申请日期 2014.11.14
申请人 南开大学 发明人 孙宁;方勇纯;陈鹤
分类号 G05B13/00(2006.01)I;B66C13/18(2006.01)I 主分类号 G05B13/00(2006.01)I
代理机构 天津佳盟知识产权代理有限公司 12002 代理人 侯力
主权项 一种欠驱动吊车自适应消摆定位控制方法,其特征在于该方法包括:第1、确定控制目标与约束选择台车的初始位置为x<sub>i</sub>,目标位置为x<sub>f</sub>,运送距离为p<sub>d</sub>=x<sub>f</sub>‑x<sub>i</sub>,满足<maths num="0001"><math><![CDATA[<mrow><msub><mi>p</mi><mi>d</mi></msub><mo>=</mo><msub><mi>x</mi><mi>f</mi></msub><mo>-</mo><msub><mi>x</mi><mi>i</mi></msub><mo>,</mo><msub><mi>x</mi><mi>i</mi></msub><mo>=</mo><mo>-</mo><mfrac><msub><mi>p</mi><mi>d</mi></msub><mn>2</mn></mfrac><mo>,</mo><msub><mi>x</mi><mi>f</mi></msub><mo>=</mo><mfrac><msub><mi>p</mi><mi>d</mi></msub><mn>2</mn></mfrac></mrow>]]></math><img file="FDA0000967253610000011.GIF" wi="630" he="103" /></maths>轨道长度约束为χ,即在控制过程中,保证x(t)∈(‑χ,χ),其中,x(t)表示台车位移;t表示时间,变量后面(t)表示该变量为关于时间t的函数;第2、定义误差信号、参数向量与可测向量定义台车定位误差e<sub>x</sub>(t)与负载摆角误差e<sub>θ</sub>(t)分别为<maths num="0002"><math><![CDATA[<mrow><msub><mi>e</mi><mi>x</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><mi>x</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>-</mo><mfrac><msub><mi>p</mi><mi>d</mi></msub><mn>2</mn></mfrac><mo>,</mo><msub><mi>e</mi><mi>&theta;</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><mi>&theta;</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>7</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000967253610000012.GIF" wi="1294" he="103" /></maths>其中,x(t)表示台车位移,θ(t)表示负载摆角,<img file="FDA0000967253610000013.GIF" wi="73" he="103" />表示目标位置;定义未知参数向量<img file="FDA0000967253610000014.GIF" wi="437" he="86" />和可测向量<img file="FDA0000967253610000015.GIF" wi="587" he="87" />其中,φ<sub>1</sub>(t),φ<sub>2</sub>(t),ω<sub>1</sub>,ω<sub>2</sub>的定义分别如下:<maths num="0003"><math><![CDATA[<mrow><msub><mi>&phi;</mi><mn>1</mn></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><mfrac><mi>&kappa;</mi><mrow><mn>1</mn><mo>+</mo><mi>&kappa;</mi></mrow></mfrac><msup><mrow><mo>&lsqb;</mo><mi>sin</mi><mi>&theta;</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mi>cos</mi><mi>&theta;</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>,</mo><mi>sin</mi><mi>&theta;</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><msup><mover><mi>&theta;</mi><mo>&CenterDot;</mo></mover><mn>2</mn></msup><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>,</mo><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mover><mi>&theta;</mi><mo>&CenterDot;</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mi>sin</mi><mi>&theta;</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mi>cos</mi><mi>&theta;</mi><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><mover><mi>&theta;</mi><mo>&CenterDot;</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>&rsqb;</mo></mrow><mi>T</mi></msup></mrow>]]></math><img file="FDA0000967253610000016.GIF" wi="1644" he="102" /></maths><maths num="0004"><math><![CDATA[<mrow><msub><mi>&phi;</mi><mn>2</mn></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><msup><mrow><mo>&lsqb;</mo><mo>-</mo><mi>tanh</mi><mrow><mo>(</mo><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mo>(</mo><mi>t</mi><mo>)</mo><mo>/</mo><mi>&epsiv;</mi><mo>)</mo></mrow><mo>,</mo><mo>|</mo><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>|</mo><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>&rsqb;</mo></mrow><mi>T</mi></msup></mrow>]]></math><img file="FDA0000967253610000017.GIF" wi="707" he="75" /></maths>ω<sub>1</sub>=[mg,ml,m,d/l]<sup>T</sup>ω<sub>2</sub>=[f<sub>r0</sub>,k<sub>r</sub>]<sup>T</sup>其中,κ表示正的控制增益,x(t),<img file="FDA0000967253610000018.GIF" wi="83" he="62" />分别表示台车位移与台车速度,θ(t),<img file="FDA0000967253610000019.GIF" wi="83" he="69" />表示负载摆角与角速度,tanh表示双曲正切函数,ε,f<sub>r0</sub>,k<sub>r</sub>为摩擦力参数,d为阻力参数,m,l,g分别表示负载质量、吊绳长度以及重力加速度;第3、控制律确定设计自适应消摆定位控制律F(t)如下:<maths num="0005"><math><![CDATA[<mrow><mtable><mtr><mtd><mrow><mi>F</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><mo>-</mo><mfrac><msub><mi>k</mi><mi>p</mi></msub><mrow><mn>1</mn><mo>+</mo><mi>&kappa;</mi></mrow></mfrac><msub><mi>e</mi><mi>x</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>-</mo><mfrac><mrow><mn>2</mn><msub><mi>k</mi><mi>e</mi></msub><mo>&lsqb;</mo><mrow><mo>(</mo><msup><mi>&chi;</mi><mn>2</mn></msup><mo>-</mo><msup><mi>x</mi><mn>2</mn></msup><mo>(</mo><mi>t</mi><mo>)</mo><mo>)</mo></mrow><mo>+</mo><mi>x</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><msub><mi>e</mi><mi>x</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>&rsqb;</mo></mrow><msup><mrow><mo>(</mo><msup><mi>&chi;</mi><mn>2</mn></msup><mo>-</mo><msup><mi>x</mi><mn>2</mn></msup><mo>(</mo><mi>t</mi><mo>)</mo><mo>)</mo></mrow><mn>2</mn></msup></mfrac><msub><mi>e</mi><mi>x</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><mo>-</mo><msub><mi>k</mi><mi>d</mi></msub><mrow><mo>(</mo><mn>1</mn><mo>+</mo><msub><mi>k</mi><mi>&theta;</mi></msub><msup><mi>sin</mi><mn>2</mn></msup><mi>&theta;</mi><mo>(</mo><mi>t</mi><mo>)</mo><mo>)</mo></mrow><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>-</mo><msup><mi>&phi;</mi><mi>T</mi></msup><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mover><mi>&omega;</mi><mo>^</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mrow></mtd></mtr></mtable><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>11</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA00009672536100000110.GIF" wi="1398" he="255" /></maths>其中,k<sub>e</sub>,k<sub>p</sub>,k<sub>d</sub>,k<sub>θ</sub>,κ是正的控制增益,<img file="FDA00009672536100000111.GIF" wi="94" he="62" />表示ω的在线估计,其更新律<img file="FDA00009672536100000112.GIF" wi="90" he="71" />为<maths num="0006"><math><![CDATA[<mrow><mover><mover><mi>&omega;</mi><mo>^</mo></mover><mo>&CenterDot;</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><mi>&Gamma;</mi><mi>&phi;</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>12</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA00009672536100000113.GIF" wi="1254" he="71" /></maths>其中,<img file="FDA0000967253610000021.GIF" wi="726" he="67" />表示正定对角更新增益矩阵,满足γ<sub>i</sub>>0,i=1,2,...,6,γ<sub>i</sub>表示正定对角更新增益矩阵Γ中对角线上的第i个元素;第4、控制方法实现利用吊车上安装的传感器,实时测量台车位移x(t),台车速度<img file="FDA0000967253610000022.GIF" wi="107" he="54" />负载摆角θ(t),摆角速度<img file="FDA0000967253610000023.GIF" wi="111" he="71" />利用式(11)与(12),计算得到控制信号,用来控制电机输出相应的作用力,实现对欠驱动吊车系统的防摆定位控制。
地址 300071 天津市南开区卫津路94号