CN104876128A - 带有状态约束的三维桥式吊车增强耦合非线性控制方法 - Google Patents
带有状态约束的三维桥式吊车增强耦合非线性控制方法 Download PDFInfo
- Publication number
- CN104876128A CN104876128A CN201510169821.2A CN201510169821A CN104876128A CN 104876128 A CN104876128 A CN 104876128A CN 201510169821 A CN201510169821 A CN 201510169821A CN 104876128 A CN104876128 A CN 104876128A
- Authority
- CN
- China
- Prior art keywords
- theta
- centerdot
- prime
- load
- chassis
- 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
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B66—HOISTING; LIFTING; HAULING
- B66C—CRANES; LOAD-ENGAGING ELEMENTS OR DEVICES FOR CRANES, CAPSTANS, WINCHES, OR TACKLES
- B66C13/00—Other constructional features or details
- B66C13/18—Control systems or devices
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Mechanical Engineering (AREA)
- Control And Safety Of Cranes (AREA)
Abstract
一种带有状态约束的三维桥式吊车增强耦合非线性控制方法,首先引入两个结合台车位移与负载摆角的广义信号,将台车精确定位与有效消除负载摆动的双重目标转换为对广义信号的调节控制,基于此构造出一个新的类似能量函数;为使台车跟踪误差以及负载摆角始终在允许的范围内,将两个“势函数”与新的类似能量的函数结合起来,设计出一种新型的储能函数。该方法对不同绳长、负载质量、目标位置以及外部扰动具有强鲁棒性;台车在X、Y轴方向上的位移被限定在合适的范围内,增强了***的暂态控制性能;在整个运输过程中由负载摆动产生的位移被限定在一个允许的范围内,从而直接限制了摆角的幅值。
Description
技术领域
本发明涉及一种用于欠驱动三维桥式吊车***控制的带有状态约束的增强耦合非线性的控制方法,属于三维桥式吊车***非线性控制技术领域。
背景技术
随着社会的进步,桥式吊车***作为大型的运输工具已广泛的应用在石油、化工、港口、铁路、建筑工地等场合。到目前为止,由于吊车***高性能控制方法的缺失,大多数吊车仍由有经验的工作人员操作。但是,训练这些操作人员需要耗费大量的时间并且人工操作具有效率低下、定位精度差、易发生误操作等缺点。考虑到人工操作的弊端,国内外众多学者致力于高性能控制方法的研究。吊车***的控制目标为快速精确的将台车运送至目标位置同时有效抑制并消除负载的摆动(参见文献1)。然而,桥式吊车***是一类典型的欠驱动***,操作人员仅能操作台车的运动而无法直接对负载的摆动施加控制,因此同时得到台车的精确定位和抑制负载摆动的目标是非常困难的(参见文献2)。
近年来,研究人员针对欠驱动吊车***的消摆定位控制问题提出了一系列有意义的控制方法。其中,最常用的控制方法为无反馈信号的开环控制方法。典型的开环控制方法有:最优控制(参见文献3、4和5)、输入整形(参见文献6-11)、轨迹规划方法(参见文献12-16)。CN102795544B公开的《基于轨迹在线规划的桥式吊车高效消摆控制方法》。这些开环控制方法具有算法简单、易于实现的优点。然而,开环控制方法的性能严重的依赖于吊车模型的精确程度,当模型参数(如绳长)不确定时此方法很难消除由吊车***内部或者外部扰动引起的误差,其控制性能会大打折扣。与开环控制方法相比,闭环控制方法引入了反馈信号。因此,闭环控制方法对内部或外部扰动不敏感。文献17以及文献18利用吊车***自身的无源特性提出了比例微分(PD)控制器、能量平方(E2)耦合控制器、动能耦合(KEC)控制器,得到了非线性控制器耦合性越强吊车***的暂态响应性能越好的结论。其中PD控制器结构简单,易于工程实现,但其消摆性能较差;E2耦合控制器和KEC耦合控制器可以改善消摆控制性能,但是结构较复杂且严重依赖吊车***模型参数,不易于工程实现。为增强耦合,文献19-21针对二维桥式吊车***提出了一系列增强耦合非线性的控制方法,通过在控制率中添加一些与模型参数相关的项,改善了***暂态控制性能,但相应的增加了其设计方法的复杂性,并且这些方法极易受到***模型参数不确定性的影响。CN104129712A公开的《一种增强抗摆的桥式吊车调节控制方法》、CN102765665A公开的《基于负载广义运动的桥式吊车非线性耦合控制方法》。文献22和23提出了在***参数(如负载质量、绳长)不确定的情况时,利用目标轨迹自适应跟踪的方法,可以同时保证台车精确定位与有效消除负载摆动的自适应控制方法,根据***响应对吊绳长度等参数进行在线估计,并实时的调整控制输出,提高了整个***对外界环境的适应性,且该方法额外考虑了复杂摩擦力以及空气阻力的影响。文献24和25研究出了一种可以保证***稳定性的自适应滑模控制方法,在一定程度上缓解了常规滑模控制方法的抖振问题,但在证明***稳定性时,需忽略闭环***中的部分非线性耦合项,若***的状态偏离平衡点,这些方法的控制性能将大打折扣。除了上述的基于模型的控制方法外,智能控制方法如模糊控制(参见文献26和27)已成功的应用于吊车***中。
以上增强耦合非线性的控制方法都是针对二维桥式吊车***提出的,仅能保证误差信号(包括台车位移与目标位置之差和摆角)渐进收敛于0,而无法保证运输过程中误差信号的范围。吊车在轨道上运动,而这个轨道的长度是受实际物理约束的。当设定的目标点接近轨道的边缘或者控制增益没有调节好时,台车可能会超出允许的范围,造成碰撞事故(参见文献29);从安全性的角度来说,负载的摆角应控制在一定的范围内,因此台车运输过程中,保证误差信号的范围在设定范围内是非常重要的。在实际应用中,二维桥式吊车一次只能沿着一个方向移动,工作效率较低。为提高***的工作效率,需要将负载的X轴方向(水平方向)运送与Y轴方向(竖直方向)运送同时进行,因此研究三维桥式吊车***具有很重要的意义。三维桥式吊车***有两个控制输入(施加于台车上的力Fx、Fy,见图1),4个***待控自由度(台车位移x、y,负载摆角θx、θy,见图1)。相较二维吊车***而言三维吊车***具有更多的状态变量,并且每个状态变量的耦合性、非线性更强,使得其控制器的设计更加的困难。
针对二维桥式吊车***已有的控制方法应用于三维桥式吊车***中存在的无法保证误差信号范围、工作效率低的问题,提出一种带有状态约束的三维桥式吊车***增强耦合非线性的控制方法,该方法稳定性高、鲁棒性和暂态控制性能好,并且可保证整个运输过程中误差信号始终在允许的范围内。
其中:
文献1:A.Khatamianfar,and A.V.Savkin.“A new tracking control approach for 3D overheadcrane systems using model predictive control,”in Proceedings of the European ControlConference,2014:796-801.
文献2:N.Sun,Y.Fang.“A partially saturated nonlinear controller for overhead cranes withexperimental implementation,”in Proceedings of the 2013IEEE International Conferance onRobotics and Automation,2013:4458-4463.
文献3:B.Tuan,H.Chen,and X.Zhang.“A practical optimal controller for underactuated gantrycrane systems,”in Proceedings of the International Symposium on Systems and Control inAerospace and A Astronautics,2006,726-730.
文献4:X.Zhang,Y.Fang,and N.Sun.“Minimum-time trajectory planning for underactuatedoverhead crane systems with state and control constraints,”IEEE Transactions on IndustrialElectronics,2014,61(12):6915-6925.
文献5:W.Piazzi,and A.Visioli.“Optimal dynamic-inversion–based control of an overheadcrane,”IET Control Theory and Applications,2002,149(5):405-411.
文献6:A.Khalid,J.Huey,W.Singhose,J.Lawrence,and D.Frakes.“Human operatorperformance testing using an input-shaped bridge crane,”ASME Journal of Dynamic Systems,Measurement and Control,2006,128(4):835-841.
文献7:K.Sorensen,W.Singhose,and S.Dickerson.“A controller enabling precise positioningand sway reduction in bridge and gantry cranes,”Control Engineering Practice,2007,15(7):825-837.
文献8:K.Dooroo,and W.Singhose.“Performance studies of human operators driving double-pendulum bridge cranes,”Control Engineering Practice,2010,18(6):567-576.
文献9:K.Sorensen,and W.Singhose.“Command-induced vibration analysis using input shapingprinciples,”Automatica,2008,44(9):2392-2397.
文献10:S.Garrido,M.Abderrahim,A.Gimenez,R.Diez,and C.Balaguer.“Anti-swing inputshaping control of an automatic construction crane,”IEEE Transactions on Automation Scienceand Engineering,2008,5(3):549-557.
文献11:D.Blackburn,W.Singhose,J.Kitchen.“Command shaping for nonlinear cranedynamics,”Journal of Vibration and Control,2010,16(4):477-501.
文献12:N.Sun,Y.Fang,X.Zhang,and Y.Yuan.“Transportation task-oriented trajectory planningfor underactuated overhead cranes using geometric analysis,”IET Control Theory andApplications,2012,6(10):1410-1423.
文献13:N.Sun,Y.Fang,Y.Zhang,and B.Ma.“A novel kinematic coupling-based trajectoryplanning method for overhead cranes,”IEEE/ASME Transactions on Mechatronics,2012,17(1):166-173.
文献14:N.Uchiyama,H.Ouyang,and S.Sano.“Simple rotary crane dynamics modeling andopen-loop control for residual load sway suppression by only horizontal boom motion,”IEEE/ASME Transactions on Mechatronics,2013,23(8):1223-1236.
文献15:N.Sun,Y.Fang,X.Zhang,and Y.Yuan.“Phase plane analysis based motion planning forunderactuated overhead cranes,”in Proceedings of the 2011IEEE International Conference onRobotics and Automation,2011:3283-3488.
文献16:N.Sun,and Y.Fang.“An efficient online trajectory generating method for underactuatedcrane systems,”International Journal of Robust and Nonlinear Control,2014,24(11):1653-1663.
文献17:Y.Fang,W.Dixon.D.Dawson,and E.Zergeroglu.“Nonlinear coupling control laws foran underactuated overhead crane system,”IEEE/ASME Transactions on Mechatronics,2008,130(3):1-7.
文献18:Y.Fang.“Lyapunov-based control for mechaniacal and vision–based systems,”ClemsonUniversity,PHD Dissertation,2002.
文献19:N.Sun,Y.Fang,and X.Zhang.“Energy coupling output feedback control of 4-D ofunderactuated cranes with saturated inputs,”Automatica,2013,49(5):1318-1325.
文献20:N.Sun,and Y.Fang.“New energy analytical results for the regulation of underactuatedoverhead cranes:An end-effector motion-based approach,”IEEE Transactions on IndustrialElectronics,2012,29(12):4723-4734.
文献21:N.Sun,Y.Fang,and X.Wu.“An enhanced coupling nonlinear control method for bridgecranes,”IET Control Theory and Applications,2014,8(13):1215-1223.
文献22:Y.Fang,B.Ma,P.Wang,and X.Zhang.“A motion planning-based adaptive controlmethod for an underactuated crane system,”IEEE Transactions on Control systemsTechnology,2012,20(1):241-248.
文献23:孙宁,方勇纯,王鹏程,张雪波.“欠驱动三维桥式吊车***自适应跟踪控制器设计,”自动化学报,2010,36(9):1287-1294.
文献24:Q.H.Ngo.,Hong,and K.Shik.“Sliding-mode antisway control of an offshore containercrane,”IEEE/ASME Transactions on Mechatronic,2012,17(12):201-209.
文献25:Q.H.Ngo.,Hong,and K.Shik.“Adaptive sliding mode control of container cranes,”IETControl Theory and Applications,2012,6(5):662-668.
文献26:M.Park,D.Chwa,and S.Hong.“Antisway tracking control of overhead cranes withsystem uncertainty and actuator nonlinearity using an adaptive fuzzy sliding-mode control,”IEEE Transaction on Industrial Electronics,2008,55(11):3972-3984.
文献27:W.Chen,and M.Saif.“Output feedback controller design for a class of MIMO nonlinearsystems using high-order sliding-mode differentiators with application to a laboratory 3-Dcrane,”IEEE Transactions on Industrial Electronics,2008,55(11):3985-3997.
文献28:B.Gao.“Nonlinear control of a class of underactuated mechanical systems,”HarbinInstitute of Nonlinear Technology,PHD Dissertation,2007.
文献29:N.Sun,Y.Fang,and H.Chen.“Adaptive control of underactuated crane systems subjectto bridge length limitation and parametric uncertainties,”in Proceedings of the 33rd ChineseControl Conference,2014:3568-3573.
发明内容
本发明针对已有的欠驱动吊车***的消摆定位控制方法存在的无法保证误差信号范围、二维桥式吊车***工作效率低的问题,提出一种稳定性高、鲁棒性和暂态控制性能好的带有状态约束的三维桥式吊车增强耦合非线性控制方法,该方法可保证三维桥式吊车***的误差信号在预先设定的范围内并渐进收敛至0。
本发明的带有状态约束的三维桥式吊车增强耦合非线性控制方法,是:
首先引入两个结合台车位移与负载摆角的广义信号,将台车精确定位与有效消除负载摆动的双重目标转换为对广义信号的调节控制,基于此构造出一个新的类似能量函数;为使台车跟踪误差以及负载摆角始终在允许的范围内,将两个“势函数”与新的类似能量的函数结合起来,设计出一种新型的储能函数;具体步骤如下:
步骤1:对实际的吊车***进行物理建模,得到物理模型,负载通过缆绳与台车相连,台车在作用力Fx的作用下沿X轴方向移动,在作用力Fy的作用下沿Y轴方向移动,固定绳长的三维桥式吊车***动力学模型为:
其中,Mx、My、m分别代表台车质量、台车与轨道质量之和、负载质量;l和g分别为绳长及重力加速度;θx表示负载在XZ平面的投影与轴线所形成的夹角;θy表示负载与XZ平面的夹角;Fx和Fy为控制输入;frx与fry代表X、Y轴方向的摩擦力;Sx,Sy,Cx,Cy为sinθx,sinθy,cosθx,cosθy的缩写;
式(1)-(4)写为矢量形式:
其中,q=[x y θx θy]T∈R4代表状态向量;x(t)、y(t)为台车在X、Y轴方向上台车的位移;
M(q)∈R4*4为惯性矩阵;表示科里奥利-向心矩阵;G(q)为重力向量;U∈R4代表控制输入向量;这些矩阵/向量详细写为:
G(q)=[0 0 mglSxCy mglCxSy]T,
U=[Fx-frx Fy-fry 0 0]T,
M(q)与满足以下结论:
其中,表示M(q)关于时间的导数;
基于负载一直是在台车下方摆动的事实,进行以下合理假设:
假设1:在整个运输过程中,负载在X和Y轴方向的摆角一直在(–π/2,π/2)范围内,即
-π/2<θx<π/2
, (7)
-π/2<θy<π/2
步骤2:固定绳长的三维吊车***中有两个控制输入Fx和Fy以及四个自由度x、y、θx和θy,吊车控制***的目的是实现快速精确的定位以及有效地消除负载摆动,在控制中,需要考虑x(t)与θx(t),θy(t)的耦合关系以及y(t)与θx(t),θy(t)的耦合关系;
引入广义信号ζx,ζy为:
其中,λ,r∈R+代表控制系数;f(θx)为与θx相关的待确定函数;g(θy)和w(θy)代表与θy相关的待确定函数;
根据负载在X、Y轴的位移表达式选择信号ζx,ζy,负载在X、Y方向的位移上的表达式为:
xm=x+lsinθx cosθy,
ym=y-lsinθy,
对式(8)关于时间进行求导,得:
在此,对式(8)关于时间积分,得:
其中,ex和ey表示X、Y轴方向上定位误差;pdx和pdy代表台车在X、Y方向的目标位置;
从而,构造的新的状态变量为:
将新的状态变量X(t)替代代入式(5),三维桥式吊车的动力学模型表示为:
三维吊车***的能量包括动能和势能,具有以下的形式:
基于能量E(t)的形式,定义一个新的类似能量的函数为:
对式(15)关于时间求导,并将式(6)和(13)代入,得:
基于式(16)的结构,本发明的带有状态约束的三维桥式吊车增强耦合非线性控制方法设计如下:
其中和P代表与的边界;引入式(17)、(18)第一项以及的目的是保证台车的精确定位;引入式(17)、(18)的最后一项mx和my的目的是保证负载位移始终在允许的范围内;kp,kd,kq,kξ,kex,key∈R+为待调整的控制增益;为了保证中如下项非负,
整理得:
令f(θx)=-sinθx,g(θy)=cosθy,可得:
满足式(20);
同理为保证非负,需保证的以下项非负,即:
其中,由假设1得到:
得
Cx>0,Cy>0, (24)
为保证w(θy)应满足
w'(θy)≥0, (25)
选择w(θy)的形式为:
从而,控制方法(17)、(18)的表达式为:
本发明对不同绳长、负载质量、目标位置以及外部扰动具有强鲁棒性;台车在X、Y轴方向上的位移被限定在合适的范围内,增强了***的暂态控制性能;在整个运输过程中由负载摆动产生的位移被限定在一个允许的范围内,从而直接限制了摆角的幅值。
附图说明
图1为三维桥式吊车***的示意图。
图2为本发明的性能仿真结果示意图。
图3(a)和图3(b)为PD控制器仿真结果示意图。
图4(a)和图4(b)为本发明针对不同绳长时的性能仿真结果示意图。
图5(a)和图5(b)为本发明针对不同负载质量的性能仿真结果示意图。
图6(a)和图6(b)为本发明针对不同目标位置的性能仿真结果示意图。
图7(a)和图7(b)为本发明针对外部扰动的性能仿真结果示意图。
具体实施方式
本发明的带有状态约束的增强耦合非线性的控制方法,用于图1所示的三维桥式吊车***。首先引入两个结合台车位移与负载摆角的广义信号,将台车精确定位与有效地消除负载摆动的双重目标转换为对广义信号的调节控制,基于此构造出一个新的类似能量函数;为使台车跟踪误差以及负载摆角始终在允许的范围内,将两个“势函数”与新的类似能量的函数结合起来,设计出一种新型的储能函数,在此基础上提出一种带有状态约束的增强耦合非线性的控制方法。采用Lyapunov定理以及LaSalle不变性原理证明了闭环***在平衡点处的稳定性。最后通过数值仿真验证了所提控制算法的正确性与有效性。具体描述为以下过程。
一.对实际的吊车***进行物理建模,可得图1所示的物理模型,负载通过缆绳与台车相连,台车在作用力Fx的作用下沿X轴方向移动,在作用力Fy的作用下沿Y轴方向移动,固定绳长的三维桥式吊车***动力学模型为:
其中,Mx、My、m分别代表台车质量、台车与轨道质量之和、负载质量;l和g分别为绳长及重力加速度;θx表示负载在XZ平面的投影与轴线所形成的夹角;θy表示负载与XZ平面的夹角;Fx和Fy为控制输入;frx与fry代表X、Y轴方向的摩擦力;Sx,Sy,Cx,Cy为sinθx,sinθy,cosθx,cosθy的缩写;
式(1)-(4)可以写为矢量形式:
其中,q=[x y θx θy]T∈R4代表状态向量;x(t)、y(t)为台车在X、Y轴方向上台车的位移;
M(q)∈R4*4为惯性矩阵;表示科里奥利-向心矩阵;G(q)为重力向量;U∈R4代表控制输入向量;这些矩阵/向量详细写为:
G(q)=[0 0 mglSxCy mglCxSy]T,
U=[Fx-frx Fy-fry 0 0]T,
M(q)与满足以下结论(参见文献17和18):
其中,表示M(q)关于时间的导数。
基于负载一直是在台车下方摆动的事实,可以进行以下合理假设:
假设1:在整个运输过程中,负载在X和Y轴方向的摆角一直在(–π/2, π/2)范围内,即
-π/2<θx<π/2
, (7)
-π/2<θy<π/2
二.带有状态约束的非线性耦合控制方法
固定绳长的三维吊车***中有两个控制输入(Fx和Fy)以及四个自由度(x、y、θx和θy),吊车控制的目的是实现快速精确的定位以及有效地消除负载摆动,在控制中,需要考虑x(t)与θx(t),θy(t)的耦合关系以及y(t)与θx(t),θy(t)的耦合关系;
引入广义信号ζx,ζy为:
其中,λ,r∈R+代表控制系数;f(θx)为与θx相关的待确定函数;g(θy)和w(θy)代表与θy相关的待确定函数;
备注1:根据负载在X和Y轴的位移表达形式(见式(41)-(42))选择信号ζx,ζy。
对式(8)关于时间进行求导,得:
在此,对式(8)关于时间积分,得:
其中,ex和ey表示X、Y轴方向上定位误差;pdx和pdy代表台车在X、Y方向的目标位置。
从而,可以构造的新的状态变量为:
将新的状态变量X(t)替代代入式(5),三维桥式吊车的动力学模型可以表示为:
三维吊车***的能量包括动能和势能,具有以下的形式:
基于能量E(t)的形式,定义一个新的类似能量的函数为:
对式(15)关于时间求导,并将式(6)和(13)代入,得:
基于式(16)的结构,非线性控制方法设计如下:
其中和P代表与的边界;引入式(17)、(18)第一项以及的目的是保证台车的精确定位;引入式(17)、(18)的最后一项mx和my的目的是保证负载位移始终在允许的范围内;kp,kd,kq,kξ,kex,key∈R+为待调整的控制增益;为了保证中如下项非负,
整理得:
令f(θx)=-sinθx,g(θy)=cosθy,可得:
满足式(20)。
同理为保证非负,需保证的以下项非负,即:
其中,由假设1得到:
得
Cx>0,Cy>0, (24)
为保证w(θy)应满足
w'(θy)≥0, (25)
选择w(θy)的形式为:
从而,控制方法(17)、(18)的表达式为:
三.稳定性分析
定理1:台车在控制器(27)、(28)的作用下可以精确的到达目标位置并且有效地消除负载摆角,即为:
证明:基于EX(t)和的结构形式,本发明选择一个新的候补Lyapunov函数为:
其中,Vp表示“势函数”;
对(30)式关于时间进行求导,可得:
根据Lyapunov稳定性定理,此闭环***在原点处是Lyapunov稳定的(换句话说,候选Lyapunov函数是非增的),即:
因此有,
V(t)∈L∞, (33)
由式(8),(10),(11),(27),(28),(30)以及(31)得:
为证明的有界性,考虑以下两种情况:
情况1)当时,由式(34)可知∈L∞。在这种情况下,有以及可得
情况2)当时。在这种情况下,
综上所述,可得:
由(34)、(35)的结果可得:
Fx∈L∞, (36)
同理可得:
将(10)、(21)、(11)、(26)式代入(37)、(38)式可得:
由图1可知,负载在X、Y方向的位移上的表达式为:
xm=x+lsinθx cosθy, (41)
ym=y-lsinθy, (42)
其中xm和ym分别表示负载在X、Y方向上的位移。式(41)、(42)的最后一项lsinθxcosθy以及lsinθy是由负载摆动引起的位移。由于负载相对台车做的是单摆运动,因此-lsinθxcosθy以及lsinθy分别代表由负载摆动引起的位移。当λ=r=l时,由式(39)、(40)可知台车位移以及在整个运输过程中负载摆动引起的位移均被限定在一个特定的范围内。换句话说,台车位移误差以及由负载摆动引起位移被限定在设定的范围内。即:
为便于接下来的证明,定义集合
设Q为S中的最大不变集。很明显在Q中有
表明
假设θy≠0,则有
这与(34)式结论中y∈L∞相矛盾,所以假设不成立。也就是说在Q中有
θy=0, (49)
将(46)以及(49)式代入(1)-(3)式可得:
由(46)、(49)和(50)式可得:
非线性摩擦力frx和fry的表达式为(参见文献19-23):
由式(52)式可知当台车停止时,非线性摩擦力frx=0以及fry=0。则由(50)式可得:
Fx=0,Fy=0, (53)
由(27)、(28)、(46)、(49)、(50)和(53)可得:
在实际运行中,负载摆角足够小,因此非线性***动态模型中的高次项可省略并且可做以下近似:
sinθx≈θx,sinθy≈θy,cosθx≈1,cosθy≈1, (56)
因此,(3)式可写为:
将(57)代入(54)式可得:
ex=0, (58)
由(55)、(58)式可得:
综上可知,在Q中仅有一个平衡点,即:
由LaSalle不变性原理可得,此闭环***是渐近稳定的。
四.仿真结果与分析
本发明采用matlab/simulink来验证所提控制方法的性能。桥式吊车***的参数设定如下:
m=3kg,Mx=7kg,My=22kg,l=0.7m
采样周期为0.001s,目标位置选择为:
[pdx pdy]T=[0.6 0.4]T m
为不失一般性设定初始状态为0,调整的控制增益如下:
P=0.405,λ=r=l=0.7,kd=15,
kp=7,kq=30,kξ=48,kex=key=0.01
这部分的目的是验证本发明所提控制方法的暂态性以及鲁棒性。图2(a)和图2(b)以及图3(a)和图3(b)仿真中将增强耦合非线性控制方法与PD控制方法对比,验证了所提控制方法的暂态性能;图4(a)和图4(b)以及图5(a)和图5(b)仿真实验中验证了所提控制器关于不同绳长和负载质量的鲁棒性;图5(a)和图5(b)以及图6(a)和图6(b)验证了本发明控制方法关于不同的目标位置的性能;图7(a)和图7(b)最后进一步验证了本发明控制方法关于外部扰动的鲁棒性。
与PD控制器相比,本发明的方法:
1)因引入了反馈信号(台车位移,负载摆角),对不同绳长/负载质量/目标位置以及外部扰动具有强鲁棒性;
2)台车在X、Y轴方向的位移被限定在合适的范围内,增强了***的暂态控制性能;
3)由仿真结果可知在整个运输过程中由负载摆动产生的位移被限定在一个允许的范围内,从而直接限制了摆角的幅值;
4)利用Lyapunov方法及LaSalle不变性原理对***的稳定性进行了严格的数学分析,为***优异的控制性能提供了理论支持。
Claims (1)
1.一种带有状态约束的三维桥式吊车增强耦合非线性控制方法,其特征是:
首先引入两个结合台车位移与负载摆角的广义信号,将台车精确定位与有效消除负载摆动的双重目标转换为对广义信号的调节控制,基于此构造出一个新的类似能量函数;为使台车跟踪误差以及负载摆角始终在允许的范围内,将两个“势函数”与新的类似能量的函数结合起来,设计出一种新型的储能函数;具体步骤如下:
步骤1:对实际的吊车***进行物理建模,得到物理模型,负载通过缆绳与台车相连,台车在作用力Fx的作用下沿X轴方向移动,在作用力Fy的作用下沿Y轴方向移动,固定绳长的三维桥式吊车***动力学模型为:
其中,Mx、My、m分别代表台车质量、台车与轨道质量之和、负载质量;l和g分别为绳长及重力加速度;θx表示负载在XZ平面的投影与轴线所形成的夹角;θy表示负载与XZ平面的夹角;Fx和Fy为控制输入;frx与fry代表X、Y轴方向的摩擦力;Sx,Sy,Cx,Cy为sinθx,sinθy,cosθx,cosθy的缩写;
式(1)-(4)写为矢量形式:
其中,q=[x y θx θy]T∈R4代表状态向量;x(t)、y(t)为台车在X、Y轴方向上台车的位移;
M(q)∈R4*4为惯性矩阵;表示科里奥利-向心矩阵;G(q)为重力向量;U∈R4代表控制输入向量;这些矩阵/向量详细写为:
G(q)=[0 0 mglSxCy mglCxSy]T,
U=[Fx-frx Fy-fry 0 0]T,
M(q)与满足以下结论:
其中,表示M(q)关于时间的导数;
基于负载一直是在台车下方摆动的事实,进行以下合理假设:
假设1:在整个运输过程中,负载在X和Y轴方向的摆角一直在(–π/2,π/2)范围内,即
-π/2<θx<π/2
, (7)
-π/2<θy<π/2
步骤2:固定绳长的三维吊车***中有两个控制输入Fx和Fy以及四个自由度x、y、θx和θy,吊车控制***的目的是实现快速精确的定位以及有效地消除负载摆动,在控制中,需要考虑x(t)与θx(t),θy(t)的耦合关系以及y(t)与θx(t),θy(t)的耦合关系;
引入广义信号ζx,ζy为:
其中,λ,r∈R+代表控制系数;f(θx)为与θx相关的待确定函数;g(θy)和w(θy)代表与θy相关的待确定函数;
根据负载在X、Y轴的位移表达式选择信号ζx,ζy,负载在X、Y方向的位移上的表达式为:
xm=x+lsinθxcosθy,
ym=y-lsinθy,
对式(8)关于时间进行求导,得:
在此,对式(8)关于时间积分,得:
其中,ex和ey表示X、Y轴方向上定位误差;pdx和pdy代表台车在X、Y方向的目标位置;
从而,构造的新的状态变量为:
将新的状态变量X(t)替代代入式(5),三维桥式吊车的动力学模型表示为:
三维吊车***的能量包括动能和势能,具有以下的形式:
基于能量E(t)的形式,定义一个新的类似能量的函数为:
对式(15)关于时间求导,并将式(6)和(13)代入,得:
基于式(16)的结构,本发明的带有状态约束的三维桥式吊车增强耦合非线性控制方法设计如下:
其中和P代表与的边界;引入式(17)、(18)第一项
以及的目的是保证台车的精确定位;引入式(17)、(18)的最后一项mx和my的目的是保证负载位移始终在允许的范围内;kp,kd,kq,kξ,kex,key∈R+为待调整的控制增益;为了保证中如下项非负,
整理得:
令f(θx)=-sinθx,g(θy)=cosθy,可得:
满足式(20);
同理为保证非负,需保证的以下项非负,即:
其中,由假设1得到:
得
Cx>0,Cy>0, (24)
为保证 w(θy)应满足
w'(θy)≥0, (25)
选择w(θy)的形式为:
从而,控制方法(17)、(18)的表达式为:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510169821.2A CN104876128B (zh) | 2015-04-10 | 2015-04-10 | 带有状态约束的三维桥式吊车增强耦合非线性控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510169821.2A CN104876128B (zh) | 2015-04-10 | 2015-04-10 | 带有状态约束的三维桥式吊车增强耦合非线性控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104876128A true CN104876128A (zh) | 2015-09-02 |
CN104876128B CN104876128B (zh) | 2017-01-18 |
Family
ID=53943857
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510169821.2A Active CN104876128B (zh) | 2015-04-10 | 2015-04-10 | 带有状态约束的三维桥式吊车增强耦合非线性控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104876128B (zh) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105329777A (zh) * | 2015-12-03 | 2016-02-17 | 山东大学 | 带有持续扰动的可升降桥式吊车***的模糊控制方法 |
CN106959610A (zh) * | 2017-04-05 | 2017-07-18 | 山东大学 | 桥式吊车***apd‑smc控制器、桥式吊车***及控制方法 |
CN110203831A (zh) * | 2019-05-24 | 2019-09-06 | 浙江理工大学 | 桥式吊车***的全局滑模控制方法 |
CN110342400A (zh) * | 2019-06-25 | 2019-10-18 | 河南科技大学 | 一种基于负载能量耦合的桥式起重机定位消摆控制方法 |
CN112506049A (zh) * | 2020-11-02 | 2021-03-16 | 江阴市智行工控科技有限公司 | 基于干扰观测器和广义负载位置追踪的防摇定位控制方法 |
CN112850495A (zh) * | 2021-03-26 | 2021-05-28 | 山东大学 | 考虑状态约束的双摆型回转起重机轨迹规划控制方法及*** |
CN113336092A (zh) * | 2021-05-19 | 2021-09-03 | 南京工业大学 | 一种双摆三维桥式起重机增强抗摆的自适应跟踪控制方法 |
CN113589692A (zh) * | 2021-07-16 | 2021-11-02 | 浙江理工大学 | 考虑桥式起重机双摆效应的增强阻尼型非线性控制方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE19920431A1 (de) * | 1999-05-04 | 2000-11-16 | Hofer Eberhard | Verfahren zur Lastpendeldämpfung an Kranen mit reduzierter Sensorik |
KR100960304B1 (ko) * | 2009-11-09 | 2010-06-04 | 동명대학교산학협력단 | 크레인 제어 장치 및 방법 |
CN102765665A (zh) * | 2012-07-13 | 2012-11-07 | 南开大学 | 基于负载广义运动的桥式吊车非线性耦合控制方法 |
CN102795544A (zh) * | 2012-08-16 | 2012-11-28 | 南开大学 | 基于轨迹在线规划的桥式吊车高效消摆控制方法 |
CN104129712A (zh) * | 2014-07-10 | 2014-11-05 | 浙江工业大学 | 一种增强抗摆的桥式吊车调节控制方法 |
-
2015
- 2015-04-10 CN CN201510169821.2A patent/CN104876128B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE19920431A1 (de) * | 1999-05-04 | 2000-11-16 | Hofer Eberhard | Verfahren zur Lastpendeldämpfung an Kranen mit reduzierter Sensorik |
KR100960304B1 (ko) * | 2009-11-09 | 2010-06-04 | 동명대학교산학협력단 | 크레인 제어 장치 및 방법 |
CN102765665A (zh) * | 2012-07-13 | 2012-11-07 | 南开大学 | 基于负载广义运动的桥式吊车非线性耦合控制方法 |
CN102795544A (zh) * | 2012-08-16 | 2012-11-28 | 南开大学 | 基于轨迹在线规划的桥式吊车高效消摆控制方法 |
CN104129712A (zh) * | 2014-07-10 | 2014-11-05 | 浙江工业大学 | 一种增强抗摆的桥式吊车调节控制方法 |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105329777A (zh) * | 2015-12-03 | 2016-02-17 | 山东大学 | 带有持续扰动的可升降桥式吊车***的模糊控制方法 |
CN105329777B (zh) * | 2015-12-03 | 2017-03-22 | 山东大学 | 带有持续扰动的可升降桥式吊车***的模糊控制方法 |
CN106959610A (zh) * | 2017-04-05 | 2017-07-18 | 山东大学 | 桥式吊车***apd‑smc控制器、桥式吊车***及控制方法 |
CN110203831A (zh) * | 2019-05-24 | 2019-09-06 | 浙江理工大学 | 桥式吊车***的全局滑模控制方法 |
CN110342400A (zh) * | 2019-06-25 | 2019-10-18 | 河南科技大学 | 一种基于负载能量耦合的桥式起重机定位消摆控制方法 |
CN112506049A (zh) * | 2020-11-02 | 2021-03-16 | 江阴市智行工控科技有限公司 | 基于干扰观测器和广义负载位置追踪的防摇定位控制方法 |
CN112850495A (zh) * | 2021-03-26 | 2021-05-28 | 山东大学 | 考虑状态约束的双摆型回转起重机轨迹规划控制方法及*** |
CN113336092A (zh) * | 2021-05-19 | 2021-09-03 | 南京工业大学 | 一种双摆三维桥式起重机增强抗摆的自适应跟踪控制方法 |
CN113589692A (zh) * | 2021-07-16 | 2021-11-02 | 浙江理工大学 | 考虑桥式起重机双摆效应的增强阻尼型非线性控制方法 |
CN113589692B (zh) * | 2021-07-16 | 2024-03-26 | 浙江理工大学 | 考虑桥式起重机双摆效应的增强阻尼型非线性控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN104876128B (zh) | 2017-01-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104876128A (zh) | 带有状态约束的三维桥式吊车增强耦合非线性控制方法 | |
Wu et al. | Nonlinear energy-based regulation control of three-dimensional overhead cranes | |
Sun et al. | Antiswing cargo transportation of underactuated tower crane systems by a nonlinear controller embedded with an integral term | |
CN105700536B (zh) | 基于绳系拖曳***的主动星姿态和系绳摆振联合控制方法 | |
Chen et al. | A swing constraint guaranteed MPC algorithm for underactuated overhead cranes | |
Qian et al. | Switching logic-based nonlinear feedback control of offshore ship-mounted tower cranes: A disturbance observer-based approach | |
CN104444817A (zh) | 欠驱动吊车自适应消摆定位控制方法 | |
CN107202584A (zh) | 一种行星精确着陆抗扰制导方法 | |
Sun et al. | Nonlinear stable transportation control for double-pendulum shipboard cranes with ship-motion-induced disturbances | |
CN106315414A (zh) | 基于滑模面的桥式吊车控制方法 | |
CN105549598A (zh) | 一种二维运动移动机器人的迭代学习轨迹跟踪控制及其鲁棒优化方法 | |
CN110376882A (zh) | 基于有限时间扩张状态观测器的预定性能控制方法 | |
CN108381553A (zh) | 一种用于空间非合作目标捕获的相对导航近距离跟踪方法及*** | |
CN106647792A (zh) | 用于无人机悬挂负载***的抗扰控制方法 | |
CN105600683A (zh) | 带初始负载摆角及台车位移的桥式吊车误差***及方法 | |
CN102765665A (zh) | 基于负载广义运动的桥式吊车非线性耦合控制方法 | |
CN108358062A (zh) | 欠驱动吊车全局稳定控制方法 | |
CN105329777A (zh) | 带有持续扰动的可升降桥式吊车***的模糊控制方法 | |
CN105182989A (zh) | 一种风场影响下的飞机姿态控制方法 | |
CN104528528A (zh) | 基于消摆信号的桥式起重机非线性控制方法 | |
Park et al. | Modeling and controlling the mobile harbour crane system with virtual prototyping technology | |
Wang et al. | A time-varying sliding mode control method for distributed-mass double pendulum bridge crane with variable parameters | |
Kim et al. | Neural network-based robust anti-sway control of an industrial crane subjected to hoisting dynamics and uncertain hydrodynamic forces | |
Qian et al. | An energy-based nonlinear coupling control for offshore ship-mounted cranes | |
CN106044567A (zh) | 桥式吊车局部饱和自适应控制器、控制***及控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
EXSB | Decision made by sipo to initiate substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |