CN107024865A - 欠驱动桅杆式起重机定位消摆非线性控制方法 - Google Patents
欠驱动桅杆式起重机定位消摆非线性控制方法 Download PDFInfo
- Publication number
- CN107024865A CN107024865A CN201710300394.6A CN201710300394A CN107024865A CN 107024865 A CN107024865 A CN 107024865A CN 201710300394 A CN201710300394 A CN 201710300394A CN 107024865 A CN107024865 A CN 107024865A
- Authority
- CN
- China
- Prior art keywords
- boom
- phi
- angle
- control
- pitch
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 55
- 238000013461 design Methods 0.000 claims abstract description 12
- 230000001133 acceleration Effects 0.000 claims description 9
- 230000008030 elimination Effects 0.000 claims description 8
- 238000003379 elimination reaction Methods 0.000 claims description 8
- 239000011159 matrix material Substances 0.000 claims description 7
- 230000008569 process Effects 0.000 claims description 6
- 230000005484 gravity Effects 0.000 claims description 5
- 239000013641 positive control Substances 0.000 claims description 3
- 239000000725 suspension Substances 0.000 abstract 3
- 230000000694 effects Effects 0.000 description 11
- 238000004458 analytical method Methods 0.000 description 8
- 238000002474 experimental method Methods 0.000 description 5
- 238000004364 calculation method Methods 0.000 description 4
- 230000008878 coupling Effects 0.000 description 4
- 238000010168 coupling process Methods 0.000 description 4
- 238000005859 coupling reaction Methods 0.000 description 4
- 238000009795 derivation Methods 0.000 description 4
- 238000007493 shaping process Methods 0.000 description 4
- 238000013459 approach Methods 0.000 description 3
- 230000008859 change Effects 0.000 description 2
- 238000011217 control strategy Methods 0.000 description 2
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 description 1
- DRUQKRWRXOUEGS-NGERZBJRSA-N Samin Chemical compound C1=C2OCOC2=CC([C@H]2OC[C@H]3[C@@H]2CO[C@@H]3O)=C1 DRUQKRWRXOUEGS-NGERZBJRSA-N 0.000 description 1
- 230000003044 adaptive effect Effects 0.000 description 1
- 238000013528 artificial neural network Methods 0.000 description 1
- 230000015572 biosynthetic process Effects 0.000 description 1
- 150000001875 compounds Chemical class 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000008094 contradictory effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000003292 diminished effect Effects 0.000 description 1
- 239000012636 effector Substances 0.000 description 1
- 238000004146 energy storage Methods 0.000 description 1
- 230000003203 everyday effect Effects 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000005312 nonlinear dynamic Methods 0.000 description 1
- 230000010355 oscillation Effects 0.000 description 1
- 229920006395 saturated elastomer Polymers 0.000 description 1
- 230000036962 time dependent Effects 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control And Safety Of Cranes (AREA)
Abstract
一种欠驱动桅杆式起重机定位消摆非线性控制方法，属于机电系统控制领域。该方法包括：根据起重机的动力学模型构造能量函数，并充分利用可驱动变量（吊杆旋转角和俯仰角）和不可驱动变量（负载径向摆角和切向摆角）之间的耦合关系，构造李雅普诺夫候选函数，从而设计出一种新型的非线性控制器。除此之外，为对吊杆转动的超调量进行有效限制，在控制器中加入限幅项，防止吊杆在目标位置附近来回摆动。此方法可以实现准确定位控制与快速消摆控制。
Description
技术领域
本发明属于机电系统控制领域，可以对动力学模型十分复杂的三维欠驱动桅杆式起重机系统进行有效的消摆和定位控制。
背景技术
在实际应用中，大多数机械系统都是欠驱动的。所谓欠驱动，就是系统独立的驱动量少于系统的自由度。近几十年来，学者们为解决类似系统的控制问题做出了巨大的努力，其研究对象包括欠驱动机器人系统[1,2]、吊车系统[3,4]、旋转激励平移振荡器系统[5]等。其中，吊车是一种典型的欠驱动系统，被广泛应用于建筑工地、码头和工厂等地完成货物的装卸工作。然而，由于人工操作的不确定性，有时很难将货物准确地运送到指定地点。更严重的是，错误的操作可能会导致一系列危险意外的发生。因此，在实际应用中，亟待设计有效的自动控制方法解决上述问题。
对于欠驱动桥式起重机系统，已有的控制方法可分为开环控制、闭环控制两类。具体而言，开环控制方法包括轨迹规划[3,6]和输入整形[7]等。而闭环控制方法往往可以更加有效地处理外界干扰，获得较好的控制效果，例如基于能量的控制方法[8,9]、滑模控制[10]、自适应控制[11]等。
在各式吊车系统中，桅杆式起重机在实际应用中十分常见，并且在日常生活中扮演着重要角色，比如进行路面维修、货物搬运等任务。可是，通常桅杆式起重机都是由人工来操作，这会导致运行效率低和吊杆无法准确定位等问题。与已被广泛研究的桥式起重机相比，桅杆式起重机状态量之间存在着更强的耦合。具体而言，它具有俯仰和旋转两方向的运动，会产生复杂的离心力，导致其动力学方程呈现出高度的非线性和复杂性，使得控制器设计的难度进一步增加。
目前，为了解决桅杆式起重机的控制问题，一些有趣而富有意义的工作正积极展开。在文献[12],[13]中，桅杆式起重机的控制过程被分为两部分，首先将状态变量转移到平衡点附近，然后保证吊杆稳定在期望位置附近并且消除负载的摆动。开环轨迹规划方法[14-16],如直接转移变换(Straight Transfer Transformation，STT)模型，都可以有效地对桅杆式起重机进行控制。此外，Samin等人在文献[17],[18]中讨论了三种输入整形方法，包括指定负振幅(Specified NegativeAmplitude，SNA)整形器、正定零振动(PositiveZero Vibration，PZV)整形器和正定零振动双微分(Positive Zero-Vibration-Derivative-Derivative，PZVDD)整形器。按照上述方法对输入信号进行整形，可以在吊杆旋转过程中减弱负载的摆动幅度。值得一提的是，上述介绍的控制方法都需要在平衡点附近将起重机非线性模型线性化，并在线性模型的基础上设计控制器。然而，如果状态变量(如摆角)在外界扰动的影响下偏离平衡点，控制器的控制效果将会被大大减弱。文献[19]提出一种开环最优控制方法，通过使用二次规划方法求得非线性方程的最优控制量，以实现起重机的消摆与定位。文献[20]基于前馈控制方法，将经过滤波的输入整形器应用于桅杆式起重机系统，成功实现消摆目标。与开环控制相比，闭环控制方法增强了系统的鲁棒性并且可以在存在干扰的情况下取得较好的控制效果。因此，近年来研究人员开始着力进行闭环方法的研究。为了减小负载的摆动幅度，Masoud等人提出一种基于延迟位置反馈的消摆控制方法[21]。而在文献[22]中，提出了一类基于积分器的部分状态反馈控制策略，可以在保证准确定位的同时实现负载消摆。考虑到模型参数的可变性，文献[23]设计出解决可变绳长问题的控制方法，在完成定位消摆的同时保证了系统的鲁棒性。除了上述基于模型的控制器之外，一系列智能算法，例如神经网络[24]、模糊控制[25]等，也都成功应用于桅杆式起重机控制中，进一步优化并提升了控制效果。
通过对上述已有方法的综合分析，一些重要的问题凸显出来并急需设计有效的解决方法：1)现有闭环控制方法均需要先对系统模型线性化，接着再进行控制器设计。然而，一旦系统受到未知干扰导致系统状态偏离平衡点，线性化后的模型将无法准确描述其当前实际运行状态，也就无法对起重机进行有效控制。2)大多数闭环控制器都未具体说明如何解决吊杆移动超调的问题。当控制增益选择不恰当时，可能产生严重的超调，使吊杆来回移动，进而引发潜在的危险和不必要的能量损耗。
综上所述，为解决非线性模型线性化带来的问题以及有效地限制吊杆的超调幅度，亟需一种稳定的非线性控制器，以取得更好的控制效果。
发明内容
本发明的目的是针对已存在的桅杆式起重机系统控制方法的不足之处，设计出一种新型的非线性控制器，保证桅杆式起重机系统平稳有效地运行。
考虑到起重机动力学模型为非线性的，本发明通过对系统储能函数的分析，在控制器中加入精心构造的耦合项以提高控制性能，并且能够限制旋转超调。另一方面，此种控制方法并不需要将起重机动力学模型线性化或者忽略特殊的非线性项，即使状态变量都远离平衡点时也能实现较好的控制效果。对于其闭环稳定性，可以利用李雅普诺夫方法和拉塞尔不变性原理进行严格的理论证明。此外，基于硬件平台的实验结果也验证了本发明方法的可行性和有效性。
本发明提供的欠驱动桅杆式起重机消摆定位控制方法包括：
第1、定义误差信号、状态向量和超调约束
定义起重机吊杆的俯仰角误差e1与旋转角误差e2分别为
e1＝φ1-φ1d,e2＝φ2-φ2d
其中，φ1,φ2分别表示吊杆的俯仰角和旋转角，φ1d,φ2d分别表示吊杆的俯仰角和旋转角的目标值；定义起重机状态向量为其中，θ1,θ2分别为负载在径向和切向两个方向上的摆角；符号“”表示矩阵/向量转置；定义吊杆在俯仰和旋转两个方向上所允许出现的最大超调量分别为ζ1,ζ2,即要求φ1-φ1d＜ζ1,φ2-φ2d＜ζ2。
第2、定义控制目标
在运动过程中，控制目标要求吊杆俯仰角φ1和旋转角φ2到达目标值，同时消除负载的径向摆角θ1和切向摆角θ2；除此之外，φ1和φ2的超调量不得超过ζ1和ζ2；具体表达形式如下：
其中，分别代表吊杆在俯仰和旋转方向上的角速度以及负载径向摆角和切向摆角的角速度。
第3、控制器设计
设计非线性控制器u1,u2如下：
其中，kp1,kp2,kd1,kd2,β1,β2,kh1,kh2均为正的控制增益，M,m,MB分别为吊杆质量、负载质量和基座质量，L,LB分别为吊杆长度和基座长度，g为重力加速度。
第4、控制方法实现
利用固定在吊杆和伺服电机上的编码器测量吊杆的俯仰角φ1和旋转角φ2，以及负载的摆角θ1和θ2，并利用式(16)，得到作用在吊杆俯仰方向和旋转方向上的输入力矩，驱动吊杆移动到指定位置并快速消除负载摆动。
本发明方法的理论依据及推导过程
第1、系统非线性动力学模型及控制目标
基于拉格朗日方法建立的起重机系统动力学方程如下所示：
其中，分别为负载径向摆角及其相应的角速度和角加速度，分别指负载切向摆角及其相应的角速度和角加速度，分别表示吊杆俯仰角及其相应的角速度和角加速度，分别代表吊杆旋转角及其相应的角速度和角加速度，t表示时间，变量后面(t)表示该变量为关于时间t的函数；为简明起见，略去大多数变量后面的(t)；u1(t),u2(t)分别为俯仰和旋转方向上的驱动力矩，m,M和MB分别表示负载质量、吊杆质量和基座质量，l代表绳长，L指吊杆长度，LB则为基座长度，g表示重力加速度，Ib是基座的转动惯量，此外，Jx,Jy,Jz表示吊杆在三维空间内的转动惯量。
为方便后文进行控制器的设计，可以将上述动力学方程转化为矩阵-向量形式：
其中，是系统的状态向量，和分别为系统状态向量关于时间的一阶导数和二阶导数，符号“”表示矩阵/向量转置，为惯性矩阵，向量的具体表达式将在后文中进行详细描述，u是系统的控制输入向量，其中，各矩阵/向量的具体表达形式如下所示：
其中，
m44＝mL2(sinφ1)2+ml2(θ1 2+θ2 2)+2mlLθ1sinφ1+Jx(sinφ1)2+Jz(cosφ1)2+Ib,
m12＝m21＝ml2θ1θ2,m13＝m31＝mlL(-θ1sinφ1+cosφ1),m14＝m41＝-ml2θ2,
m23＝m32＝-mlLθ2sinφ1,m24＝m42＝ml2θ1+mlLsinφ1,m34＝m43＝-mlLθ2cosφ1.
其中，
本发明的目标为：在不进行线性化的前提下，设计出一种非线性控制器，可以在实现起重机定位和负载消摆的同时，有效限制吊杆运动的超调量。从自动控制的角度来看，利用数学公式可将该目标描述如下：
其中，分别表示吊杆的俯仰角和旋转角及其相应的角速度，分别表示负载的径向摆角和切向摆角及其相应的角速度，φ1d,φ2d分别表示吊杆的俯仰角和旋转角的目标值，ζ1,ζ2分别为吊杆在俯仰和旋转两个方向上所允许出现的最大超调值。
考虑到起重机在实际应用中，其负载始终位于吊杆下方，另外参考诸多文献，如[3,4],[6-25]，作如下假设：
假设1：在起重机运行过程中，负载的径向摆角θ1(t)和切向摆角θ2(t)以及吊杆的俯仰角φ1(t)和旋转角φ2(t)的变化范围始终在(-π/2,π/2)之间。
第2、控制器设计
为方便进一步推导分析，首先定义起重机吊杆的俯仰角误差e1(t)与旋转角误差e2(t)分别为
其中，分别表示吊杆的俯仰角和旋转角及其相应的角速度，φ1d,φ2d分别表示吊杆的俯仰角和旋转角的目标值，分别为俯仰角误差和旋转角误差关于时间的一阶导数。
其次，通过对系统进行仔细分析，得到其机械能E的表达式如下：
然后，对式(10)关于时间求导，并代入式(1)-(4)，经过严格的数学推理可知
基于上述能量函数的表达形式，可设计李雅普诺夫候选函数W(t)如下：
其中，表示控制增益。对W(t)关于时间求导，可以得到
为了消去式中的交叉项并保证是非正定的，首先设计如下控制器：
其中为控制增益。将式(14)代入式(13)中，可以得到
从上式中可以看出W(t)的变化仅与可驱动变量φ1(t)和φ2(t)有关。尽管利用控制器(14)已证明闭环系统在平衡点附近是稳定的，但是系统的欠驱动状态变量，即负载摆角，所提供的反馈信息并没有得到充分利用。除此之外，一般闭环反馈控制方法[例如(14)]的普遍问题就是无法在理论上限制超调。例如，当吊杆接近目标位置时，可能会出现吊杆往复运动，甚至出现严重超调。
为避免上述问题，本发明提出如下的新型非线性控制器：
其中为控制增益，分别表示φ1(t),φ2(t)的超调限制。此新型非线性控制器增加了两个额外项。两式中的第一项用来确保最大超调误差始终保持在某一确定范围内并且快速收敛于零。而两式中另一非线性耦合部分和则将不可驱动变量融入到控制器中，以提高控制效果。
第3、稳定性分析
这部分将利用李雅普诺夫方法和拉塞尔不变性原理，对闭环反馈系统进行严格的稳定性分析，验证控制器(16)的有效性。
为实现控制目标，首先选取如下标量函数V(t)作为李雅普诺夫候选函数：
对V(t)关于时间求导并利用式(11)，可以得到
于是将控制器(16)代入上式(18)中，经过计算整理可知
即：
V(t)≤V(0)＜＜+∞ (20)
根据V(t)的具体形式可知，V(t)始终是非负定的，即V(t)≥0。另外，由于V(0)是有界的，很容易得到如下结论：
不失一般性，将吊杆俯仰角和旋转角的初始值选定为0，即：φ1(0)＝0,φ2(0)＝0。于是，可以发现|φ1(0)|＜φ1d+ζ1,|φ2(0)|＜φ2d+ζ2。假设φ1(t)或φ2(t)逐渐增长至φ1d+ζ1或φ2d+ζ2,这也就意味着V(t)→∞[见式(18)]，此结论与式(20)相矛盾。因此，超调幅度将会被限制在给定范围内，即
|φ1|＜φ1d+ζ1,|φ2|＜φ2d+ζ2 (22)
基于上述结论，可以推断出
u1,u2∈L∞
接下来将利用拉塞尔不变性原理来完成证明。为此，定义集合Φ：
同时，定义Γ为Φ中的最大不变子集，根据式(19)可知，在Γ中，
其中，λ1,λ2为待确定的常数；于是，在集合Γ中，可以得到
将式(23)代入式(3)中,可以求得如下等式：
为进行后续分析，将式(26)等号左右两侧重新改写为
并且，对其关于时间进行积分，可得到如下结果：
其中，λ3为待确定的常数。如果常数则当t→∞时，易知
此结论与式(23)中和等结论相矛盾。于是，通过反证法可以求得
利用式(28)，可以将式(24)改写为
由式(22)可以推论出式(29)中的第一项不会为零。于是，最终得到如下结论：
与式(26)的计算方法相同，将式(23)代入式(4)中并加以整理，可得到
其中，λ4为待确定常数。对式(31)进行与上文类似的推导[见式(26)-(30)]，可以得到如下结论：
将不变集Γ中的结论代入式(1)和(2)，可以得到如下方程组：
联立(33)和(34)两式可知如下结论：
接下来，将式(36)代入式(26)，能够得到如下等式：
然后，对式(37)关于时间积分两次可以得到
其中，λ5和λ6是待确定的常数。假设λ5≠0，则当t→∞时，
上式与结论sinφ1(t),cosφ1(t),θ1(t)∈L∞[见式(23)]相矛盾，因此λ5＝0。于是，进一步化简式(38)，可以计算出
这是一个以θ1(t)为变量的一元二次方程，由于φ1＝φ1d[见式(30)]为定值，可以推出θ1(t)必为一常数。由此可知
进一步，通过将结论(30),(32)和(39)代入式(2)，并消去多余的项，可以得到如下方程：
由于恒成立，可以进一步地得到如下结论：
最后，将上述结论(39)及(40)代入式(35)，可计算求得如下结果：
通过总结上述结论，可知集合Γ仅包括闭环平衡点，于是利用拉塞尔不变性原理[8]可以证明闭环系统渐近稳定，即本发明所设计的控制器可以实现预期目标。
本发明的优点与价值：
为解决桅杆式起重机旋转定位和负载消摆等相关问题，本发明设计出一种非线性控制方法，可以实现对起重机进行有效控制。另外，本控制器引入了两个非线性项，可以保证对反馈信息的充分利用和对吊杆超调量的有效限制，得到更好的控制效果，有望应用于实际大型起重机系统中，具有良好的现实工程意义。
附图说明
图1为本发明所提方法的实验结果，其中俯仰角、旋转角、径向摆角、切向摆角、俯仰控制量和旋转控制量分别对应φ1、φ2、θ1、θ2、u1和u2；图中，实线从上到下依次刻画了俯仰角、旋转角、径向摆角、切向摆角、俯仰控制量和旋转控制量，虚线从上到下依次表示俯仰角、旋转角的目标值φ1d＝0.6rad,φ2d＝0.6rad；
图2为文献[23]中线性二次型调节器(Linear Quadratic Regulator,LQR)最优控制方法的实验结果，其中俯仰角、旋转角、径向摆角、切向摆角、俯仰控制量和旋转控制量分别对应φ1、φ2、θ1、θ2、u1和u2；图中，实线从上到下依次刻画了俯仰角、旋转角、径向摆角、切向摆角、俯仰控制量和旋转控制量，虚线从上到下依次表示俯仰角、旋转角的目标值φ1d＝0.6rad,φ2d＝0.6rad。
具体实施方式：
第1、实验步骤描述
第1.1、定义误差信号、状态向量和超调约束
定义起重机吊杆的俯仰角误差e1与旋转角误差e2分别为
e1＝φ1-φ1d,e2＝φ2-φ2d
其中，φ1,φ2分别表示吊杆的俯仰角和旋转角，φ1d,φ2d分别表示吊杆的俯仰角和旋转角的目标值；定义起重机状态向量为其中，θ1,θ2分别为负载在径向和切向两个方向上的摆角；符号“”表示矩阵/向量转置；定义吊杆在俯仰和旋转两个方向上所允许出现的最大超调值分别为ζ1,ζ2,即要求φ1-φ1d＜ζ1,φ2-φ2d＜ζ2。
第1.2、定义控制目标
在运动过程中，控制目标要求吊杆俯仰角φ1和旋转角φ2到达指定位置，同时消除负载的径向摆角θ1和切向摆角θ2；除此之外，φ1和φ2的超调量不得超过ζ1和ζ2；具体表达形式如下：
其中，分别代表吊杆在俯仰和旋转方向上的角速度以及负载径向摆角和切向摆角的角速度。
第1.3、控制器设计
设计非线性控制器u1,u2如下：
其中，kp1,kp2,kd1,kd2,β1,β2,kh1,kh2均为正的控制增益，M,m,MB分别为吊杆质量，负载质量和基座质量，L,LB分别为吊杆长度和基座长度；g为重力加速度。
第1.4、控制方法实现
利用固定在吊杆和伺服电机上的编码器测量吊杆的俯仰角φ1和旋转角φ2，以及负载的摆角θ1和θ2，并利用式(16)，得到作用在吊杆俯仰方向和旋转方向上的输入力矩，驱动吊杆移动到指定位置并快速消除负载摆动。
第2、实验结果描述
为验证本发明所设计的控制方法的有效性，按照上述步骤，在实验室自主搭建的桅杆式起重机平台上进行实验。在实验中，负载质量、吊杆质量、基座质量、重力加速度、吊绳长度、吊杆长度以及基座长度的取值分别如下：
m＝0.34kg,M＝2kg,MB＝4.8kg,g＝9.8m/s2,
l＝0.175m,L＝0.65m,LB＝0.15m.
将本发明所提出的控制方法与LQR最优控制方法[23]进行对比，比较吊杆的定位效果和负载的消摆效果。在所有实验中，吊杆俯仰角和旋转角的初始状态都设置为0rad，即φ1(0)＝0rad,φ2(0)＝0rad，对应的目标值分别选取为φ1d＝0.6rad,φ2d＝0.6rad。此外，为避免吊杆突然启动引起负载摆角过大，本实验此处加入软启动，具体表达形式如下：
φ1d＝0.6tanh(1.3t)[rad],φ2d＝0.6tanh(1.15t)[rad]
首先，本发明所提出的非线性控制器(16)选取参数如下：
kp1＝16,kd1＝0.2,kh1＝2.15,kp2＝2.9,kd2＝0.75,kh2＝1.55,
β1＝β2＝0.01,ζ1＝ζ2＝0.005
对于LQR最优控制方法，经过MATLAB工具箱的计算，得到其具体的表达式为：
附图1和附图2给出了实验结果。本发明所提控制器在4s内就可以使俯仰角和旋转角到达指定位置，并且负载的径向摆角和切向摆角在6s内即可收敛于零。而LQR方法虽然可以使吊杆到达指定角度位置，但存在稳态误差，负载摆动幅度较大，10s左右才能够完全收敛。综上所述，相比对比方法，本发明方法可以在更短的时间内取得更好的控制效果。
参考文献
[1]J.X.Xu,Z.Q.Guo,and T.H.Lee,Design and implementation of integralsliding mode control on an underactuated two-wheeled mobile robot,IEEETransactions on Industrial Electronics,vol.61,no.7,pp.3671-3681,Jul.2014.
[2]Ailon and I.Zohar,Control strategies for driving a group ofnonholonomic kinematic mobile robots in formation along a time-parameterizedpath,IEEE/ASME Transactions on Mechatronics,vol.17,no.2,pp.326-336,Apr.2012.
[3]N.Sun,Y.Fang,Y.Zhang,and B.Ma,A novel kinematic coupling-basedtrajectory planning method for overhead cranes,IEEE/ASME Transactions onMechatronics,vol.17,no.1,pp.166-173,Feb.2012.
[4]K.C.C.Peng,W.Singhose,and D.H.Frakes,Hand-motion crane controlusing radio-frequency real-time location systems,IEEE/ASME Transactions onMechatronics,vol.17,no.3,pp.464-471,Feb.2012.
[5]Q.Quan and K.-Y.Cai,Additive-state-decomposition-based trackingcontrol for TORA benchmark,Journal of Sound and Vibration,vol.332,no.20,pp.4829-4841,Sep.2013.
[6]N.Sun and Y.Fang,An efficient online trajectory generating methodfor underactuated crane systems,International Journal of Robust and NonlinearControl,vol.24,no.11,pp.1653-1663,Jul.2014.
[7]K.Sorensen and W.Singhose,Command-induced vibration analysis usinginput shaping principles,Automatica,vol.44,no.9,pp.2392-2397,Sep.2008.
[8]N.Sun and Y.Fang,New energy analytical results for the regulationof underactuated overhead cranes:An end-effector motion-based approach,IEEETransactions on Industrial Electronics,vol.59,no.12,pp.4723-4734,Dec.2012.
[9]N.Sun,Y.Fang,and X.Zhang,Energy coupling output feedback controlof 4-DOF underactuated cranes with saturated inputs,Automatica,vol.49,no.5,pp.1318-1325,May 2013.
[10]L.H.Lee,C.H.Huang,S.C.Ku,Z.H.Yang,and C.Y.Chang,Efficient visualfeedback method to control a three-dimensional overhead crane,IEEETransactions on Industrial Electronics,vol.61,no.8,pp.4073-4083,Aug.2014.
[11]Q.H.Ngo and K.S.Hong,Sliding-mode antisway control of an offshorecontainer crane,IEEE/ASME Transactions on Mechatronics,vol.17,no.2,pp.201-209,Apr.2012.
[12]Y.Sakawa,and A.Nakazumi,Modeling and control of a rotary crane,Journal of Dynamic Systems,Measurement,and Control,vol.107,no.3,pp.200-206,Jun.1985.
[13]R.Souissi,and A.J.Koivo,Modeling and control of a rotary cranefor swing-free transport of payloads,Proceedings of the first IEEE Conferenceon Control Applications,pp.782-787,Sep.1992.
[14]N.Uchiyama,H.Ouyang,and S.Sano,Simple rotary crane dynamicsmodeling and open-loop control for residual load sway suppression by onlyhorizontal boom motion,Mechatronics,vol.23,no.8,pp.1223-1236,Dec.2013.
[15]S.Sano,H.Ouyang,and N.Uchiyama,Residual load sway suppression forrotary cranes using simple dynamics model and S-curve trajectory,Proceedingsof the 17th IEEE International Conference on Emerging Technologies andFactory Automation,pp.1-5,Sep.2012.
[16]K.Terashima,Y.Shen,and K.Yano,Modeling and optimal control of arotary crane using the straight transfer transformation method,ControlEngineering Practice,vol.15,no.9,pp.1179-1192,Sep.2007.
[17]R.E.Samin,Z.Mohamed,J.Jalani,and R.Ghazali,Input shapingtechniques for anti-sway control of a 3-DOF rotary crane system,Proceedingsof the first International Conference on Artificial Intelligence,Modellingand Simulation,pp.184-189,Dec.2013.
[18]R.E.Samin,Z.Mohamed,J.Jalani,and R.Ghazali,A hybrid controllerfor control of a 3-DOF rotary crane system,Proceedings of the firstInternational Conference on Artificial Intelligence,Modelling and Simulation,pp.190-195,Dec.2013.
[19]E.Arnold,O.Sawodny,A.Hildebrandt,and K.Schneider,Anti-sway systemfor boom cranes based on an optimal control approach,Proceedings of the IEEEAmerican Control Conference,vol.4,pp.3166-3171,Jun.2003.
[20]M.A.Ahmad,R.M.T.R.Ismail,M.S.Ramli,N.F.Zakaria,and N.M.A.Ghani,Robust feed-forward schemes for anti-sway control of rotary crane,Proceedingsof the International Conference on Computational Intelligence,ModellingandSimulation,pp.17-22,Sep.2009.
[21]Z.N.Masoud,A.H.Nayfeh,and A.Al-Mousa,Delayed position-feedbackcontroller for the reduction of payload pendulations of rotary cranes,Journalof Vibration and Control,vol.9,no.1-2,pp.257-277,Jan.2003.
[22]N.Uchiyama,Robust control of rotary crane by partial-statefeedback with integrator,Mechatronics,vol.19,no.8,pp.1294-1302,Dec.2009.
[23]S.Sano,H.Ouyang,H.Yamashita,and N.Uchiyama,LMI approach to robustcontrol of rotary cranes under load sway frequency variance,Journal of SystemDesign and Dynamics,vol.5,no.7,pp.1402-1417,Jul.2011.
[24]K.Nakazono,K.Ohnishi,H.Kinjo,and T.Yamamoto,Vibration control ofload for rotary crane system using neural network with GA-based training,Artificial Life and Robotics,vol.13,no.1,pp.98-101,Dec.2008.
[25]M.A.Ahmad,M.S.Saealal,M.A.Zawawi,and R.M.T.Raja Ismail,Classicalangular tracking and intelligent anti-sway control for rotary crane system,Proceedings of the IEEE International Conference on Electrical,Control andComputer Engineering,pp.82-87,Jun.2011.
Claims (1)
1.一种欠驱动桅杆式起重机定位消摆非线性控制方法，其特征在于该方法包括：
第1、定义误差信号、状态向量和超调约束
定义起重机吊杆的俯仰角误差e1与旋转角误差e2分别为
e1＝φ1-φ1d,e2＝φ2-φ2d
其中，φ1,φ2分别表示吊杆的俯仰角和旋转角，φ1d,φ2d分别表示吊杆的俯仰角和旋转角的目标值；定义起重机状态向量为其中，θ1,θ2分别为负载在径向和切向两个方向上的摆角；符号表示矩阵/向量转置；定义吊杆在俯仰和旋转两个方向上所允许出现的最大超调量分别为ζ1,ζ2,即要求φ1-φ1d＜ζ1,φ2-φ2d＜ζ2；
第2、定义控制目标
在运动过程中，控制目标要求吊杆俯仰角φ1和旋转角φ2到达目标值，同时消除负载的径向摆角θ1和切向摆角θ2；除此之外，φ1和φ2的超调量不得超过ζ1和ζ2；具体表达形式如下：
φ1＜φ1d+ζ1,φ2＜φ2d+ζ2
其中，分别代表吊杆在俯仰和旋转方向上的角速度以及负载径向摆角和切向摆角的角速度；
第3、控制器设计
设计非线性控制器u1,u2如下：
其中，kp1,kp2,kd1,kd2,β1,β2,kh1,kh2均为正的控制增益，M,m,MB分别为吊杆质量、负载质量和基座质量，L,LB分别为吊杆长度和基座长度，g为重力加速度；
第4、控制方法实现
利用固定在吊杆和伺服电机上的编码器测量吊杆的俯仰角φ1和旋转角φ2，以及负载的摆角θ1和θ2，并利用式(16)，得到作用在吊杆俯仰方向和旋转方向上的输入力矩，驱动吊杆移动到指定位置并快速消除负载摆动。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710300394.6A CN107024865B (zh) | 2017-05-02 | 2017-05-02 | 欠驱动桅杆式起重机定位消摆非线性控制方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710300394.6A CN107024865B (zh) | 2017-05-02 | 2017-05-02 | 欠驱动桅杆式起重机定位消摆非线性控制方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN107024865A true CN107024865A (zh) | 2017-08-08 |
| CN107024865B CN107024865B (zh) | 2019-12-03 |
Family
ID=59526692
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201710300394.6A Active CN107024865B (zh) | 2017-05-02 | 2017-05-02 | 欠驱动桅杆式起重机定位消摆非线性控制方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN107024865B (zh) |
Cited By (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108469736A (zh) * | 2018-04-28 | 2018-08-31 | 南开大学 | 基于状态观测的船用吊车消摆定位控制方法和系统 |
| CN108508750A (zh) * | 2018-05-08 | 2018-09-07 | 重庆大学 | 一种tora系统的输出反馈控制方法 |
| CN112068429A (zh) * | 2020-08-31 | 2020-12-11 | 五邑大学 | 基于sfcs算法的滑模控制器参数整定方法、装置及存储介质 |
| CN112835293A (zh) * | 2021-01-07 | 2021-05-25 | 中南大学 | 一种基于嵌套饱和技术的桥式起重机系统稳定性研究方法 |
| CN112850495A (zh) * | 2021-03-26 | 2021-05-28 | 山东大学 | 考虑状态约束的双摆型回转起重机轨迹规划控制方法及系统 |
Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20020176455A1 (en) * | 2001-04-12 | 2002-11-28 | Ioana Triandaf | Tracking sustained chaos |
| CN102795544A (zh) * | 2012-08-16 | 2012-11-28 | 南开大学 | 基于轨迹在线规划的桥式吊车高效消摆控制方法 |
| CN104444817A (zh) * | 2014-11-14 | 2015-03-25 | 南开大学 | 欠驱动吊车自适应消摆定位控制方法 |
| CN104528528A (zh) * | 2014-08-08 | 2015-04-22 | 浙江工业大学 | 基于消摆信号的桥式起重机非线性控制方法 |
-
2017
- 2017-05-02 CN CN201710300394.6A patent/CN107024865B/zh active Active
Patent Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20020176455A1 (en) * | 2001-04-12 | 2002-11-28 | Ioana Triandaf | Tracking sustained chaos |
| CN102795544A (zh) * | 2012-08-16 | 2012-11-28 | 南开大学 | 基于轨迹在线规划的桥式吊车高效消摆控制方法 |
| CN104528528A (zh) * | 2014-08-08 | 2015-04-22 | 浙江工业大学 | 基于消摆信号的桥式起重机非线性控制方法 |
| CN104444817A (zh) * | 2014-11-14 | 2015-03-25 | 南开大学 | 欠驱动吊车自适应消摆定位控制方法 |
Non-Patent Citations (1)
| Title |
|---|
| 孙宁 等: "欠驱动桥式吊车消摆跟踪控制", 《控制理论与应用》 * |
Cited By (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108469736A (zh) * | 2018-04-28 | 2018-08-31 | 南开大学 | 基于状态观测的船用吊车消摆定位控制方法和系统 |
| CN108469736B (zh) * | 2018-04-28 | 2020-06-30 | 南开大学 | 基于状态观测的船用吊车消摆定位控制方法和系统 |
| CN108508750A (zh) * | 2018-05-08 | 2018-09-07 | 重庆大学 | 一种tora系统的输出反馈控制方法 |
| CN108508750B (zh) * | 2018-05-08 | 2021-05-11 | 重庆大学 | 一种tora系统的输出反馈控制方法 |
| CN112068429A (zh) * | 2020-08-31 | 2020-12-11 | 五邑大学 | 基于sfcs算法的滑模控制器参数整定方法、装置及存储介质 |
| CN112835293A (zh) * | 2021-01-07 | 2021-05-25 | 中南大学 | 一种基于嵌套饱和技术的桥式起重机系统稳定性研究方法 |
| CN112850495A (zh) * | 2021-03-26 | 2021-05-28 | 山东大学 | 考虑状态约束的双摆型回转起重机轨迹规划控制方法及系统 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN107024865B (zh) | 2019-12-03 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| Wu et al. | Disturbance-compensation-based continuous sliding mode control for overhead cranes with disturbances | |
| CN107024865B (zh) | 欠驱动桅杆式起重机定位消摆非线性控制方法 | |
| Sun et al. | Nonlinear motion control of complicated dual rotary crane systems without velocity feedback: Design, analysis, and hardware experiments | |
| Chen et al. | Nonlinear control of underactuated systems subject to both actuated and unactuated state constraints with experimental verification | |
| Zhang et al. | Adaptive proportional-derivative sliding mode control law with improved transient performance for underactuated overhead crane systems | |
| Sun et al. | Slew/translation positioning and swing suppression for 4-DOF tower cranes with parametric uncertainties: Design and hardware experimentation | |
| Chen et al. | An adaptive tracking control method with swing suppression for 4-DOF tower crane systems | |
| Sun et al. | Adaptive anti-swing and positioning control for 4-DOF rotary cranes subject to uncertain/unknown parameters with hardware experiments | |
| Qian et al. | Switching logic-based nonlinear feedback control of offshore ship-mounted tower cranes: A disturbance observer-based approach | |
| Zhang et al. | Minimum-time trajectory planning for underactuated overhead crane systems with state and control constraints | |
| Sun et al. | Nonlinear antiswing control of offshore cranes with unknown parameters and persistent ship-induced perturbations: Theoretical design and hardware experiments | |
| Sun et al. | Nonlinear motion control of underactuated three-dimensional boom cranes with hardware experiments | |
| CN105174061B (zh) | 基于伪谱法的双摆吊车全局时间最优轨迹规划方法 | |
| Yang et al. | Motion trajectory-based transportation control for 3-D boom cranes: Analysis, design, and experiments | |
| Liu et al. | An antiswing trajectory planning method with state constraints for 4-DOF tower cranes: design and experiments | |
| CN109911771B (zh) | 变系数自抗扰控制器设计方法、及吊车自抗扰控制器 | |
| CN104876128B (zh) | 带有状态约束的三维桥式吊车增强耦合非线性控制方法 | |
| Yang et al. | Swing suppression and accurate positioning control for underactuated offshore crane systems suffering from disturbances | |
| Tysse et al. | Lyapunov-based damping controller with nonlinear MPC control of payload position for a knuckle boom crane | |
| Zhai et al. | Observer-based adaptive fuzzy control of underactuated offshore cranes for cargo stabilization with respect to ship decks | |
| Giacomelli et al. | MPC-PID control of operator-in-the-loop overhead cranes: A practical approach | |
| CN113942934B (zh) | 基于速度控制的集装箱桥式起重机精准定位及防摇控制方法 | |
| Li et al. | Kinematic coupling‐based trajectory planning for rotary crane system with double‐pendulum effects and output constraints | |
| Yao et al. | Tracking approach of double pendulum cranes with variable rope lengths using sliding mode technique | |
| Wu et al. | Deep reinforcement learning-based control for asynchronous motor-actuated triple pendulum crane systems with distributed mass payloads |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant | ||
| OL01 | Intention to license declared | ||
| OL01 | Intention to license declared |