CN113093541B - 一种欠驱动吊车微分平坦跟踪控制方法 - Google Patents
一种欠驱动吊车微分平坦跟踪控制方法 Download PDFInfo
- Publication number
- CN113093541B CN113093541B CN202110344838.2A CN202110344838A CN113093541B CN 113093541 B CN113093541 B CN 113093541B CN 202110344838 A CN202110344838 A CN 202110344838A CN 113093541 B CN113093541 B CN 113093541B
- Authority
- CN
- China
- Prior art keywords
- load
- formula
- motion
- transverse
- vertical motion
- 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.)
- Active
Links
Images
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
-
- 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/04—Auxiliary devices for controlling movements of suspended loads, or preventing cable slack
- B66C13/06—Auxiliary devices for controlling movements of suspended loads, or preventing cable slack for minimising or preventing longitudinal or transverse swinging of loads
- B66C13/063—Auxiliary devices for controlling movements of suspended loads, or preventing cable slack for minimising or preventing longitudinal or transverse swinging of loads electrical
-
- 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/04—Auxiliary devices for controlling movements of suspended loads, or preventing cable slack
- B66C13/08—Auxiliary devices for controlling movements of suspended loads, or preventing cable slack for depositing loads in desired attitudes or positions
- B66C13/085—Auxiliary devices for controlling movements of suspended loads, or preventing cable slack for depositing loads in desired attitudes or positions electrical
-
- 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
- B66C13/48—Automatic control of crane drives for producing a single or repeated working cycle; Programme control
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (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)
- Control And Safety Of Cranes (AREA)
Abstract
本发明公布了一种欠驱动吊车微分平坦跟踪控制方法,其特征在于:利用sigmoid函数,构造包含加速、匀速、减速全过程、光滑连续且能满足实际物理约束的新型加速度轨迹;将含负载升降的吊车动力学模型进行变换,得到负载横向运动和竖向运动的微分平坦输出方程,将微分平坦输出方程化成积分串联形式,设计线性扩张状态观测器估计负载横向与竖向运动的各阶状态及总和扰动;将各时刻负载横向和竖向运动各阶状态的理想值与实际值或估计值进行比较,得到状态误差,并对总和扰动进行补偿,进而构建负载横向和竖向运动的误差反馈控制律,使伴有负载升降的吊车在外界干扰下,能沿着期望轨迹将负载平稳快速地搬运到目标位置,并有效抑制负载运输过程中的摆动。
Description
技术领域
本发明涉及一种欠驱动吊车微分平坦跟踪控制方法,属于自动控制领域。
背景技术
桥式吊车广泛应用于工厂车间、自动化码头、仓库等场所,其主要功能是实现货物快速安全的转运。在作业过程中,吊车系统存在参数摄动、风扰等不确定因素的干扰,严重影响了其防摇定位的控制效果。将货物高效、安全、准确地输运到目标位置,并抑制货物运输过程中的摆动,是目前国内外学者研究的热门问题。
轨迹规划对台车精准定位和负载摆动抑制起着重要作用。由于台车的起点位置默认为零,因此目标点的距离为初始位置偏差,当作业距离很长时,若不能对目标值进行平滑处理,将导致初始控制量很大,甚至难以控制。解决的方法为根据台车电机最大速度/加速度/加加速度等实际物理约束,事先规划一条先加速、再匀速、后减速的运动轨迹。因此如何设计结构简单且光滑连续,并有利于台车高效平稳运行且满足实际物理约束的参考轨迹是问题的关键。根据事先规划的平滑S型轨迹引导台车运动,并和闭环控制相结合,可以使台车运动更加平稳。对此,许多学者设计众多的闭环控制器,如滑模控制、模糊控制、模型预测、自适应控制控制等。但现有的大多数研究都是基于定绳长的基础上进行的,忽略了负载升降运动所引起的绳长变化对负载摆动的影响。在实际作业中,为提高吊车工作效率,负载升降和横向运输运动常同时进行,此时吊绳长度从定绳长转化为状态变量,绳长的变化极易引起负载的大幅摇摆,导致原有定绳长的控制方法难以取得理想的控制效果,同时绳长时变大大增强了吊车系统的欠驱动特性、非线性,增加了控制难度。
为解决上述所提问题,近年来国内外学者针对负载升降工况下的吊车防摆定位控制提出了许多方法。这些方法虽在一定程度上解决了变绳长桥式吊车系统的控制问题,但大都没有充分考虑摆角和位移之间的耦合关系,使其控制律中往往包含众多参数,整定困难,难以调到最优状态。由于吊车的欠驱动特性,其控制量要能实现台车准确定位及负载消摆双重目标,因此应尽可能对位移和摆角控制回路进行一体化设计,从整体上协调发挥控制系统的最大潜力。此外控制系统设计还要综合考虑系统负载质量、摩擦力、负载重心等不确定因素和环境风等外部随机扰动的影响。
发明内容
针对上述问题和不足,本发明公布了一种欠驱动吊车微分平坦跟踪控制方法。该方法设计了包含加速、匀速、减速全过程、满足实际物理约束且光滑连续的新型加速度轨迹;将含负载升降的吊车动力学模型进行变换,得到负载横向运动和竖向运动的微分平坦输出方程,将微分平坦输出方程化成积分串联形式,设计线性扩张状态观测器估计负载横向与竖向运动的各阶状态及总和扰动;将各时刻负载横向和竖向运动各阶状态的理想值与实际值或估计值进行比较,得到状态误差,并对总和扰动进行补偿,进而构建负载横向和竖向运动的误差反馈控制律。该方法具体按以下步骤实施:
步骤A,对桥式吊车的动力学模型进行变换,得到负载负载横向运动和竖向运动的微分平坦输出方程:
包含负载升降的吊车动力学模型可描述为:
式中,M、m分别为台车和负载质量,x为台车位移,θ为负载摆角,l为绳长,g为重力加速度,Fx为台车驱动力,Fl为负载竖直方向驱动力,Frx,Frl分别表示横向和竖向运动的阻力, frx、μx、kr、dl为与摩擦力相关的系数。
对原系统数学模型进行处理之后,得到近似模型:
式中,fi,i=1,2,3分别代表各个回路的未建模部分及外界扰动组成的总和扰动。
对摩擦力和重力项进行前馈补偿,则总控制量可表示为:
考虑负载摆角θ通常在10°以内,负载重心坐标(xm,ym)可近似为:
式(9)对时间求二阶导数,得:
将式(10)代入式(4)并整理,得:
将式(11)代入式(9),得:
由式(11)(12)可知,系统中所有状态变量及控制输入均可表示为(xm,ym)及其不同阶导数的代数组合形式,故吊车系统的负载运动具有平坦属性。采用xm的前四阶微分将负载横向运动的微分平坦输出方程表示为:
采用ym的前二阶微分将负载竖向运动的微分平坦输出方程表示为:
步骤B,将负载横向运动的外界干扰,系统简化而带来的模型偏差视为“总扰动”,设计五阶扩张状态观测器LESO1观测负载横向运动的各阶状态及总和扰动;
根据式(15),设计估计包含平坦输出xm各阶状态及总和扰动的五阶扩张状态观测器LESO1:
式中,zxi(i=1,…,5)分别为状态ξi(i=1,…,5)的观测值,βxi(i=1,2,…,5)为LESO1的观测器增益。
为减少参数调整工作量,采用带宽法,将LESO1增益配置在带宽ωx上。
求解方程(17)可得:
[βx1,βx2,βx3,βx4,βx5]T=[5ωx,10ωx 2,10ωx 3,5ωx 4,ωx 5]T (18)
步骤C,将负载竖向运动的外界干扰,系统简化而带来的模型偏差视为“总扰动”,设计三阶扩张状态观测器LESO2观测负载竖向运动的各阶状态及扰动。
根据式(19),设计平坦输出ym各阶状态及总和扰动的扩张状态观测器LESO2:
步骤D,根据点对点输运过程中先加速、后匀速、再减速的特点,及速度、加速度、加加速度约束条件,设计高阶光滑连续的加速度轨迹,作为台车运行和负载升降的参考轨迹;
采用sigmoid函数,构造衔接点光滑连续的新型加速度轨迹,作为台车/负载的定位参考轨迹:
式中,c∈R+,为初始加速度调节参数,n1,n2,n3,n4∈R+为辅助变量,
假定负载目标位置设定为xd,速度不超过vm,加速度不超过am,加加速度不超过jm,确定辅助变量n1,n2,n3,n4的值:
该曲线全阶段连续、高阶可微,有利于台车平稳运行,同时速度、加速度、加加速度始终不超过给定的最大值,并能在最大值附近运行尽可能长的时间,有利于提高负载搬运效率。
步骤E,根据台车和负载升降的参考加速度轨迹及负载无摆动的理想情况,确定各时刻负载横向和竖向运动的理想值,将其与负载横向和竖向运动的状态估计值进行比较,得出台车和负载各时刻的状态误差,根据状态误差设计反馈控制律;
根据式(16),定义负载横向运动的误差信号
式中,xr为负载横向运动参考轨迹表达式,根据式(21)构造。
根据式(15)、(16)和(23),设计负载横向运动的误差反馈控制律:
式中,kx1,kx2,kx3,kx4∈R+,为控制增益。
根据式(20),定义负载竖向运动的误差信号:
其中lr为负载竖向运动参考轨迹表达式,参考式(21)构造。
根据式(19)、(20)和(25),设计负载竖向运动的误差反馈控制律:
式中,kl1,kl2∈R+,为控制增益。
根据式(8)、(24)和(26),可得吊车系统总控制律为:
在集总大干扰下,采用式(27)所示的Fx控制律就可使吊车在横向将吊重平稳且基本无摆地搬运到目标位置,采用式(27)所示的Fl控制律就可在竖向将吊重平稳且基本无摆地升降到目标高度。
本发明有益效果是:采用sigmoid函数,构造了包含加速、匀速、减速全过程且高阶光滑连续的新型加速度轨迹,该轨迹简洁、紧凑,速度、加速度、加加速度限定值明确体现在表达式中,设计方便、直观,并能使其在限定值附近运行尽可能长的时间,有利于提高运行效率。将台车运动与负载摆动进行复合,构建了负载横向和竖向运动的微分平坦输出方程,为保证平坦输出变量沿着期望参考轨迹平稳运行,设计了轨迹跟踪控制器,实现了台车位移、负载升降及摆动的一体化控制,并引入ESO补偿器对总和扰动进行估计补偿,提高了系统抵抗参数摄动、外部干扰的能力。在台车运动和负载升降的联动工况下,吊车微分平坦跟踪控制能在外界干扰情况下,使负载沿着期望轨迹快速到达目标位置,并有效抑制负载运输过程中的摆动。
附图说明
图1为伴随负载升降的桥式吊车示意图;
图2为新型加速度轨迹构造示意图;
图3为存在初始摆角情况下FETC、NLTC、CBC三个控制器的仿真对比,图中自上至下的5个子图分别为三个控制器控制下台车位移x(t)、负载升降l(t)、负载摆角θ(t)、台车驱动力Fx(t)、负载升降驱动力Fl(t)。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚明了,下面结合附图与具体实施方式,对本发明进行详细描述。
本发明的一种欠驱动吊车微分平坦跟踪控制方法,其基本思路是:首先为使吊车系统平稳安全高效运行,选用四段具有饱和特性的sigmoid函数,设计适用于各阶段光滑连续且能满足实际物理约束的梯型加速度参考轨迹。在得到负载横向和竖向运动微分平坦输出方程的基础上,通过微分同胚变换将两方向运动方程转化为积分串联形式,进而设计微分平坦轨迹跟踪器引导台车/负载沿着期望轨迹运动,实现摆角和位移回路的一体化控制,并引入基于ESO的补偿器对模型不确定性因素和外界干扰进行估计补偿,以提高其抗内/外干扰的能力,所提方法在模型参数不精确及外界干扰下都能精确定位,并抑制负载摆动,鲁棒性强。
本发明的一种欠驱动吊车微分平坦跟踪控制方法,按照以下步骤实施:
步骤A,对桥式吊车的动力学模型进行变换,得到负载运动状态的微分平坦输出方程
伴随负载升降的吊车动力学模型如图1所示,其动力学方程可描述如下:
式中,M、m分别为台车和负载质量,x为台车位移,θ为负载摆角,l为绳长,g为重力加速度,Fx为台车驱动力,Fl为负载竖直方向驱动力,Frx,Frl分别表示横向和竖向运动的阻力, frx、μx、kr、dl为与摩擦力相关的系数。
对原系统数学模型进行处理之后,得到近似模型:
式中,fi,i=1,2,3分别代表各个回路的未建模部分及外界扰动组成的总和扰动。
对摩擦力和重力项进行前馈补偿,则总控制量可表示为:
考虑负载摆角θ通常在10°以内,负载重心坐标(xm,ym)可近似为:
式(9)对时间求二阶导数,得:
将式(10)代入式(4)并整理,得:
将式(11)代入式(9),得:
由式(11)(12)可知,系统中所有状态变量及控制输入均可表示为(xm,ym)及其不同阶导数的代数组合形式,故吊车系统的负载运动具有平坦属性。采用xm的前四阶微分将负载横向运动的微分平坦输出方程表示为:
采用ym的前二阶微分将负载竖向运动的微分平坦输出方程表示为:
步骤B,将负载横向运动的外界干扰,系统简化而带来的模型偏差视为“总扰动”,设计五阶扩张状态观测器LESO1观测负载横向运动的各阶状态及总和扰动;
根据式(15),设计估计包含平坦输出xm各阶状态及总和扰动的五阶扩张状态观测器LESO1:
式中,zxi(i=1,…,5)分别为状态ξi(i=1,…,5)的观测值,βxi(i=1,2,…,5)为观测器LESO1的增益。
为减少参数调整工作量,采用带宽法,将LESO1增益配置在带宽ωx上。
求解方程(17)可得:
[βx1,βx2,βx3,βx4,βx5]T=[5ωx,10ωx 2,10ωx 3,5ωx 4,ωx 5]T (18)
步骤C,将负载竖向运动的外界干扰,系统简化而带来的模型偏差视为“总扰动”,设计三阶扩张状态观测器LESO2观测负载竖向运动的各阶状态及扰动;
根据式(19),设计平坦输出ym各阶状态及总和扰动的扩张状态观测器LESO2:
式中,zli(i=1,2,3)分别为状态δi(i=1,2,3)的观测值,βl1,βl2,βl3是LESO2的增益。
这样LESO1和LESO2所有参数都变成了带宽的函数,理论上,ESO带宽越大,观测器跟踪速度也越快,但同时也越容易引入噪声信号。在实际选择时,要综合考虑系统控制性能和干扰抑制等指标。
步骤D,根据点对点输运过程中先加速、后匀速、再减速的特点,及速度、加速度、加加速度约束条件,设计高阶光滑连续的加速度轨迹,作为台车运行和负载升降的参考轨迹;
根据吊车先加速、后匀速、再减速的点对点输运特点,采用sigmoid函数,根据图2构造衔接点光滑连续的新型加速度轨迹,作为台车/负载的定位参考轨迹:。
式中,c∈R+,为初始加速度调节参数,n1,n2,n3,n4∈R+为辅助变量,
假定负载目标位置设定为xd,速度不超过vm,加速度不超过am,加加速度不超过jm,根据图2对称的几何关系及sigmoid函数性质,确定辅助变量n1,n2,n3,n4的值:
该曲线全阶段连续、高阶可微,有利于台车平稳运行,同时速度、加速度、加加速度指标始终限定在给定的约束范围内,并在最大值附近运行尽可能长的时间,有利于提高负载搬运效率。
步骤E,根据台车和负载升降的参考加速度轨迹及负载无摆动的理想情况,确定各时刻负载横向和竖向运动的理想值,将其与负载横向和竖向运动的状态估计值进行比较,得出台车和负载各时刻的状态误差,根据状态误差设计反馈控制律;
根据式(16),定义负载横向运动的误差信号:
其中,xr为负载横向运动参考轨迹表达式。
根据式(15)、(16)和(23),设计负载横向运动的误差反馈控制律:
式中,kx1,kx2,kx3,kx4∈R+,为控制增益。
根据式(20),定义负载竖向运动的误差信号:
式中,lr为负载竖向运动参考轨迹表达式。
根据式(19)、(20)和(25),设计负载竖向运动的误差反馈控制律:
式中,kl1,kl2∈R+,为控制增益。
根据式(8)、(24)和(26),得吊车系统的总控制律:
将式(24)和(26)的闭环极点分别配置在ω1,ω2,使下列特征方程λ1,λ2是Hurwitz稳定的。
λ1(s)=s4+kx4s3+kx3s2+kx2s+kx1=(s+ω1)4 (28)
λ2(s)=s2+kl2s+kl1=(s+ω2)2 (29)
计算可得控制增益的值为:
将观测器和误差反馈控制律的参数配置在带宽上,可极大减少控制器参数整定的难度。至此,基于ESO补偿的微分平坦轨迹跟踪控制器已设计完毕,主要包含四个参数,通过调节两观测器带宽ωx,ωl及控制器带宽ω1,ω2,即可调节控制器性能。
在集总大干扰下,采用式(27)所示的控制律Fx就可使吊车在横向将吊重平稳且基本无摆地搬运到目标位置,采用式(27)所示的控制律Fl就可在竖向将吊重平稳且基本无摆地升降到目标高度。
式中,
闭环系统控制误差可表示为:
式中:
由于两个LESO的带宽分别配置在ωx、ωl上,两个控制器带宽分别配置在ω1、ω2上,因此矩阵A1、A2、E1、E2均为Hurwitz稳定矩阵,在这种情况下Ф矩阵也是Hurwitz稳定矩阵,因此闭环系统稳定。
步骤F、通过实验说明欠驱动吊车微分平坦跟踪控制器有效;
为验证所提吊车微分平坦跟踪控制器(Flatness Based ESO Tracking Control,FETC)的有效性,设计一仿真实验平台,吊车系统的参数设置为:M=19.8kg,m=1kg,g=9.81m/s2,摩擦力参数为:frx=8.1、kr=-0.5、μx=0.01、dl=0.7。台车初始位置x(0)=0,目标位置xd=20m,吊绳初始位置l(0)=2m,目标位置ld=10m。经参数整定,所提控制器参数选取如下:ωx=15、ωl=15、ω1=5、ω2=5。为体现所提方法的性能,将其与Coupling-BasedController(CBC)方法和Nonlinear Tracking Control(NLTC)控制器进行对比,CBC法控制律表达式如式(34)所示,其控制参数选取为kpx=5、kdx=7.5、kpl=2、kdl=2、k1=-6、N=6,NLTC法控制律表达式如式(35)所示,其控制参数选取为kpx=3、kdx=3、kpl=5、kdl=5、λωx=0.1、λωl=0.1。考虑到落吊操作时台车定位精度和负载摆动直接影响了作业效率和操作安全性,因此仅比较落吊过程。设定台车横向运动速度、加速度、加加速度的上限分别为1m/s、0.2m/s2、0.2m/s3,负载竖直方向速度、加速度、加加速度的上限分别为0.5m/s、0.1m/s2、0.1m/s3,初始加速度调节因子均为3.5,根据所提新型加速度轨迹NAT构造台车横向运动的参考轨迹Tx、负载竖直运动的参考轨迹Tl,利用上述三种算法对台车横向运动、负载竖向运动进行轨迹跟踪控制,所得仿真结果如图3所示。图中从上到下曲线依次为台车位移、吊绳位置、负载摆角、台车位移方向和负载升降方向的控制量。
从图3中可见,三种方法均能够较好地跟踪两条目标轨迹,且用时接近,FETC和NLTC法可实现几乎无超调跟踪,而CBC法在竖向出现了跟踪超调。在消摆性能上,整个运送过程中,FETC法都可将摆角控制在2°以内,为三者最低,台车到达目标位置后,几乎无残摆,CBC和NLTC法都难以在台车到达目标点后及时消除残余摆动,消摆时间长。FETC的控制量对时间的积分为三者最低,因此最节能。综合定位性能、消摆性能和控制力方面,本方法对吊车作业的控制效果最好。
Claims (1)
1.一种欠驱动吊车微分平坦跟踪控制方法,其特征在于,按照以下步骤实施:
步骤A,对桥式吊车的动力学模型进行变换,得到负载横向运动和竖向运动的微分平坦输出方程;
伴有负载升降的吊车动力学模型可描述如下:
式中,M、m分别为台车和负载质量,x为台车位移,θ为负载摆角,l为绳长,g为重力加速度,Fx为台车驱动力,Fl为负载竖向驱动力,Frx,Frl分别为横向和竖向运动的阻力, frx、μx、kr、dl为与摩擦力相关的系数;
对伴有负载升降的吊车动力学模型进行处理,得到近似模型:
式中,fi,i=1,2,3分别代表各个回路的未建模部分及外界扰动组成的总和扰动;
对摩擦力和重力项进行前馈补偿,则总控制量可表示为:
考虑负载摆角θ通常在10°以内,负载重心坐标(xm,ym)可近似为:
针对式(8)对时间求二阶导数,得:
将式(10)代入式(8),得:
由式(10)(11)可知,系统中所有状态变量及控制输入均可表示为(xm,ym)及其不同阶导数的代数组合形式,故吊车系统的负载运动具有平坦属性;采用xm的前四阶微分将负载横向运动的微分平坦输出方程表示为:
采用ym的前二阶微分将负载竖向运动的微分平坦输出方程表示为:
步骤B,将负载横向运动的外界干扰,系统简化而带来的模型偏差视为“总扰动”,设计五阶扩张状态观测器LESO1观测负载横向运动的各阶状态及总和扰动;
根据式(14),设计估计包含平坦输出xm各阶状态及总和扰动的五阶扩张状态观测器LESO1:
式中,zxi,i=1,…,5为状态ξi,i=1,…,5的观测值,βxi,i=1,2,…,5为LESO1的观测器增益;
步骤C,将负载竖向运动的外界干扰,系统简化而带来的模型偏差视为“总扰动”,设计三阶扩张状态观测器LESO2观测负载竖向运动的各阶状态及扰动;
根据式(16),设计平坦输出ym各阶状态及总和扰动的扩张状态观测器LESO2:
步骤D,根据点对点输运过程中先加速、后匀速、再减速的特点,及速度、加速度、加加速度约束条件,设计高阶光滑连续的加速度轨迹,作为台车运行和负载升降的参考轨迹;
采用4段sigmoid函数,构造衔接点光滑连续的新型加速度轨迹,作为负载横向和竖向运动的定位参考轨迹:
式中,c∈R+,为初始加速度调节参数,n1,n2,n3,n4∈R+为辅助变量,
假定负载目标位置设定为xd,速度不超过vm,加速度不超过am,加加速度不超过jm,确定辅助变量n1,n2,n3,n4的值:
该曲线全阶段连续、高阶可微,有利于台车平稳运行,同时速度、加速度、加加速度指标始终限定在给定的约束范围内,并能在最大值附近运行尽可能长的时间,有利于提高负载搬运效率;
步骤E,根据台车和负载升降的参考加速度轨迹及负载无摆动的理想情况,确定各时刻负载横向和竖向运动的理想值,将其与负载横向和竖向运动的状态估计值进行比较,得出各时刻负载横向和竖向运动的状态误差,根据状态误差设计负载横向和竖向运动的反馈控制律;
根据式(15),定义负载横向运动的误差信号
式中,xr为负载横向运动参考轨迹表达式;
根据式(14)、(15)和(20),设计负载横向运动的误差反馈控制律:
式中,kx1,kx2,kx3,kx4∈R+,为控制增益;
根据式(17),定义负载竖向运动的误差信号:
式中,lr为负载竖向运动参考轨迹表达式;
根据式(16)、(17)和(25),设计负载竖向运动的误差反馈控制律:
式中,kl1,kl2∈R+,为控制增益;
根据式(7)、(21)和(23),可得吊车系统总控制律为:
在集总大干扰下,采用式(24)所示的Fx控制律就可使吊车在横向将吊重平稳且基本无摆地搬运到目标位置,采用式(24)所示的Fl控制律就可在竖向将吊重平稳且基本无摆地升降到目标高度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110344838.2A CN113093541B (zh) | 2021-03-31 | 2021-03-31 | 一种欠驱动吊车微分平坦跟踪控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110344838.2A CN113093541B (zh) | 2021-03-31 | 2021-03-31 | 一种欠驱动吊车微分平坦跟踪控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113093541A CN113093541A (zh) | 2021-07-09 |
CN113093541B true CN113093541B (zh) | 2022-05-10 |
Family
ID=76672001
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110344838.2A Active CN113093541B (zh) | 2021-03-31 | 2021-03-31 | 一种欠驱动吊车微分平坦跟踪控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113093541B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115046620B (zh) * | 2021-12-22 | 2023-08-18 | 中南大学 | 基于fbg应变传感器阵列的结构振动感知方法 |
CN114803866B (zh) * | 2022-06-27 | 2022-12-16 | 杭州未名信科科技有限公司 | 面向智能塔吊起升运动状态的分阶段优化控制方法及装置 |
CN115057355B (zh) * | 2022-07-15 | 2024-05-24 | 河北工业大学 | 变绳长双摆桥式吊车自抗扰控制方法及系统 |
CN115657472B (zh) * | 2022-09-22 | 2024-05-24 | 济南大学 | 一种塔式吊车系统反馈控制方法及系统 |
CN117826607A (zh) * | 2024-01-05 | 2024-04-05 | 上海驭矩信息科技有限公司 | 一种欠驱动桥式吊车的严格安全模型预测控制方法及系统 |
CN117886226B (zh) * | 2024-01-17 | 2024-06-14 | 南开大学 | 基于平坦输出的吊车系统非线性控制方法及系统 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106647267A (zh) * | 2016-12-15 | 2017-05-10 | 山东大学 | 带有不确定动力学的吊车有限时间轨迹跟踪控制器及方法 |
CN107272692A (zh) * | 2017-07-18 | 2017-10-20 | 北京理工大学 | 基于微分平坦和自抗扰的无人车路径规划与跟踪控制方法 |
CN109460043A (zh) * | 2018-12-29 | 2019-03-12 | 上海海事大学 | 一种基于多模态非奇异终端滑模船舶航迹自抗扰控制方法 |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102006048988A1 (de) * | 2006-10-17 | 2008-04-24 | Liebherr-Werk Nenzing Gmbh, Nenzing | Steuerungssystem für einen Auslegerkran |
CN104192713A (zh) * | 2014-09-10 | 2014-12-10 | 南开大学 | 基于微分平坦与b样条的时间最优桥式吊车轨迹规划方法 |
US10665115B2 (en) * | 2016-01-05 | 2020-05-26 | California Institute Of Technology | Controlling unmanned aerial vehicles to avoid obstacle collision |
CN106249602B (zh) * | 2016-09-30 | 2018-11-30 | 山东大学 | 桥式吊车有限时间轨迹跟踪控制器及其设计方法 |
CN108557664B (zh) * | 2018-01-05 | 2019-12-17 | 山东大学 | 桥式吊车系统增强耦合非线性pd型滑模控制器及方法 |
CN109132860B (zh) * | 2018-10-22 | 2019-12-13 | 济南大学 | 带负载摆动抑制的三维桥式吊车系统pd-smc控制方法及系统 |
CN109911773B (zh) * | 2019-04-17 | 2020-09-01 | 中南大学 | 一种单参数调整的欠驱动吊车作业全过程自抗扰控制方法 |
CN112327623B (zh) * | 2020-11-04 | 2022-03-08 | 中南大学 | 一种基于负载摆动状态观测的双摆型吊车滑模控制方法 |
-
2021
- 2021-03-31 CN CN202110344838.2A patent/CN113093541B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106647267A (zh) * | 2016-12-15 | 2017-05-10 | 山东大学 | 带有不确定动力学的吊车有限时间轨迹跟踪控制器及方法 |
CN107272692A (zh) * | 2017-07-18 | 2017-10-20 | 北京理工大学 | 基于微分平坦和自抗扰的无人车路径规划与跟踪控制方法 |
CN109460043A (zh) * | 2018-12-29 | 2019-03-12 | 上海海事大学 | 一种基于多模态非奇异终端滑模船舶航迹自抗扰控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN113093541A (zh) | 2021-07-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113093541B (zh) | 一种欠驱动吊车微分平坦跟踪控制方法 | |
CN107487717B (zh) | 基于模糊pid控制的起重机智能防摇控制系统及方法 | |
CN112327623B (zh) | 一种基于负载摆动状态观测的双摆型吊车滑模控制方法 | |
CN111153328B (zh) | 一种基于lqr的吊装系统的防摇控制方法及系统 | |
CN108190751B (zh) | 一种基于神经网络pid的桥式起重机防摇控制方法 | |
CN109911771B (zh) | 变系数自抗扰控制器设计方法、及吊车自抗扰控制器 | |
CN113086844B (zh) | 基于二阶滑模干扰观测器的变绳长桥式吊车防摇定位控制方法 | |
CN109911773B (zh) | 一种单参数调整的欠驱动吊车作业全过程自抗扰控制方法 | |
KR20110004776A (ko) | 로드 케이블에 매달린 하물을 취급하기 위한 크레인 | |
CN110467111B (zh) | 桥式起重机的控制 | |
Dwivedi et al. | Stabilization of unstable equilibrium point of rotary inverted pendulum using fractional controller | |
CN108928739B (zh) | 用于缓冲负载接纳元件的旋转振动的方法以及缓冲设备 | |
CN108584700B (zh) | 起重机自适应pid闭环防摇控制方法 | |
CN110342400B (zh) | 一种基于负载能量耦合的桥式起重机定位消摆控制方法 | |
CN110589684A (zh) | 起重机防摇摆驱动控制方法 | |
CN113942934B (zh) | 基于速度控制的集装箱桥式起重机精准定位及防摇控制方法 | |
Zhai et al. | Observer-based adaptive fuzzy control of underactuated offshore cranes for cargo stabilization with respect to ship decks | |
CN114594683A (zh) | 基于Hurwitz稳定的动基座桥式起重机防摆滑模控制方法 | |
Lobe et al. | Flatness-based nonlinear control of a three-dimensional gantry crane | |
CN113321122A (zh) | 起重机双摆系统分层非奇异终端滑模控制方法 | |
CN116239022A (zh) | 桥式吊车定位防摆无模型自适应控制方法 | |
CN111824958B (zh) | 桥式吊车卷扬控制器生成方法、控制方法及控制器生成系统 | |
CN113325715B (zh) | 一种基于前馈控制的桥式起重机的全局连续滑模控制方法 | |
Chen et al. | A time optimal trajectory planning method for overhead cranes with obstacle avoidance | |
Chai et al. | Design of crane anti-swing controller based on differential flat and linear active disturbance rejection control |
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 |