主权项 |
一种欠驱动吊车自适应消摆定位控制方法,其特征在于该方法包括:第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>θ</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><mi>θ</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>φ</mi><mn>1</mn></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><mfrac><mi>κ</mi><mrow><mn>1</mn><mo>+</mo><mi>κ</mi></mrow></mfrac><msup><mrow><mo>[</mo><mi>sin</mi><mi>θ</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mi>cos</mi><mi>θ</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>,</mo><mi>sin</mi><mi>θ</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><msup><mover><mi>θ</mi><mo>·</mo></mover><mn>2</mn></msup><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>,</mo><mover><mi>x</mi><mo>·</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mover><mi>θ</mi><mo>·</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mi>sin</mi><mi>θ</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mi>cos</mi><mi>θ</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>,</mo><mi>cos</mi><mi>θ</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mover><mi>θ</mi><mo>·</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>]</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>φ</mi><mn>2</mn></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><msup><mrow><mo>[</mo><mo>-</mo><mi>tanh</mi><mrow><mo>(</mo><mover><mi>x</mi><mo>·</mo></mover><mo>(</mo><mi>t</mi><mo>)</mo><mo>/</mo><mi>ϵ</mi><mo>)</mo></mrow><mo>,</mo><mo>|</mo><mover><mi>x</mi><mo>·</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>|</mo><mover><mi>x</mi><mo>·</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>]</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>κ</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>[</mo><mrow><mo>(</mo><msup><mi>χ</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>]</mo></mrow><msup><mrow><mo>(</mo><msup><mi>χ</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>θ</mi></msub><msup><mi>sin</mi><mn>2</mn></msup><mi>θ</mi><mo>(</mo><mi>t</mi><mo>)</mo><mo>)</mo></mrow><mover><mi>x</mi><mo>·</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>-</mo><msup><mi>φ</mi><mi>T</mi></msup><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mover><mi>ω</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>ω</mi><mo>^</mo></mover><mo>·</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><mi>Γ</mi><mi>φ</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mover><mi>x</mi><mo>·</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),计算得到控制信号,用来控制电机输出相应的作用力,实现对欠驱动吊车系统的防摆定位控制。 |