本发明涉及桥吊防摇运动控制的技术领域,尤其涉及一种分布质量负载的桥吊防摇定位控制方法。
背景技术:
作为一种应用广泛的的运输工具,桥是起重机被广泛使用与码头,工厂等工业现场,然而由于它固有存在的欠驱动特性,即输入量少于被控制量,它的控制也尤其复杂。
以往人们在针对桥式起重机设计控制器时,通常把桥式起重机模型的动态特性看作是单摆特性,即将吊钩与负载看作一个质点,另外,由于桥式起重机的驱动器均为类线性力,因此,设计出的控制器往往结构简单,易于实现。但随着社会工业化程度的提高,工业现场的运输要求也越来越严格,具体来说,某些桥式起重机运输环境需要运送化工相关货物,为了安全考虑,这就对于运输过程中负载角度抑制的要求就会大大提高;当需要运输一些具有分布式质量的货物时,负载就会不可避免的产生传动惯量,这将对起重机包括定位与消摆上的控制产生不利影响,甚至会导致系统不稳定;在工业现场中,很大一部分起重机的动态特性呈现出双摆特性,因此它的动态特性更加复杂,控制难度也很大。对于传统控制器,大多数是针对二维桥式起重机模型,即只考虑小车或者导轨单独作用的情况,因此在需要小车和导轨同时运动的工业场合,此类控制器便不再适用,另外,传统控制器很少有针对具有分布式质量负载的桥式起重机双摆模型的设计。一般自适应控制率仅仅考虑估计系统位置参数,即当驱动器操控下的小车或者导轨停止运动时,控制器中的估计律项便为零,这就导致了无法准确消除由于外部扰动因素而产生的定位误差,而且一般自适应控制器通常需要反馈多通道的数据,甚至需要全状态反馈,这就导致了实际应用中成本的大幅提高。
技术实现要素:
本部分的目的在于概述本发明的实施例的一些方面以及简要介绍一些较佳实施例。在本部分以及本申请的说明书摘要和发明名称中可能会做些简化或省略以避免使本部分、说明书摘要和发明名称的目的模糊,而这种简化或省略不能用于限制本发明的范围。
鉴于上述现有存在的问题,提出了本发明。
因此,本发明解决的技术问题是:在起重机系统中,当吊钩与负载间存在不可忽略的绳长且吊钩的质量足够大时,桥式起重机呈现会呈现出双摆特性,而且当运输分布式质量负载时,现有的基于质点模型的控制器难以完成精确以及消摆的任务。
为解决上述技术问题,本发明提供如下技术方案:根据拉格朗日方程以及桥吊模型,构建具有分布式质量负载的桥吊三维动态模型;根据所述三维动态模型,结合定位误差,构建自适应更新律;根据所述自适应更新律,构建增强定位的鲁棒自适应控制器,实现桥吊定位与消摆。
作为本发明所述的分布质量负载的桥吊防摇定位控制方法的一种优选方案,其中:所述构建桥吊三维动态模型包括,结合应用过程中的摩擦力以及风阻,利用拉格朗日建模方程构建具有分布式质量负载桥吊三维动态模型,所述三维动态模型表示为:
m=[mij]∈r6×6,c=[cij]∈r6×6,i=1,...,6,j=1,...,6,
g=[00gl1m1cosθ2sinθ1+gl1m2cosθ2sinθ1gl1m1cosθ1sinθ2+gl1m2cosθ1sinθ2glhm2cosθ4sinθ3glhm2cosθ3sinθ4]t
u=[fxfy0000]t,fs=[frxfry0000]t
其中:l1为小车与吊钩间的绳长,l2为吊钩与分布质量负载固定间的绳长,lh为吊钩与分布质量负载质心间的垂直距离,m1和m2分别为吊钩与分布质量负载的质量,g为重力加速度,θi,
作为本发明所述的分布质量负载的桥吊防摇定位控制方法的一种优选方案,其中:所述构建自适应更新律包括,在所述动态模型中,结合摩擦力模型、分析系统的动能和势能以及系统总能量变化率,构建一种包含定位误差的自适应更新律并规划自适应更新律参数的选取。
作为本发明所述的分布质量负载的桥吊防摇定位控制方法的一种优选方案,其中:所述结合摩擦力模型包括,由于桥吊起重机应用中可驱动力部分存在不可避免的摩擦力,所述摩擦力表示为:
其中:f11和f21为静摩擦力相关系数,f12和f22为滑动摩擦力相关系数,εx和εy为摩擦力模型的陡峭程度,一般取0.01。
作为本发明所述的分布质量负载的桥吊防摇定位控制方法的一种优选方案,其中:所述一种包含定位误差的自适应更新律包括,根据所述系统总能量变化率,构造定位误差的自适应更新律,所述自适应更新律包括x方向和y方向的更新律,所述更新律分别用
ωyt=[m1+m2+myf21f22d2]
ωxt=[m1+m2+mxf11f12d1]
其中:πx和πy分别为x方向和y方向更新律的可变权重矩阵,且均为对角正定矩阵,γx和γy均为自适应更新律的相关矩阵,并且为一维向量,ωx与ωy为待估计向量,ex和ey为跟踪轨迹的误差,
作为本发明所述的分布质量负载的桥吊防摇定位控制方法的一种优选方案,其中:所述规划自适应更新律参数的选取包括,所述自适应更新律参数的选取应满足以下要求:πx=diag(kx1,kx2,kx3,kx4),πy=diag(ky1,ky2,ky3,ky4),其中所述自适应更新律参数中的各项根据实际操作环境进行选取,结合所述系统总能量变化率,对所述自适应控制器的参数进行限制。
作为本发明所述的分布质量负载的桥吊防摇定位控制方法的一种优选方案,其中:所述对自适应控制器的参数进行限制包括,在所述自适应更新律中增强定位项α的选取需要满足以下约束条件:
其中:
作为本发明所述的分布质量负载的桥吊防摇定位控制方法的一种优选方案,其中:所述构建增强定位的鲁棒自适应控制器包括,将所述包含定位误差的自适应更新律以及更新律相关矩阵,构建增强定位的鲁棒自适应控制器,其详细表达式为:
其中:k1p和k2p误差相关控制系数,k1d和k2d为误差微分相关控制系数。
作为本发明所述的分布质量负载的桥吊防摇定位控制方法的一种优选方案,其中:所述构建增强定位的鲁棒自适应控制器还包括,根据分析系统能量函数,对控制器相关参数进行限制,所述误差相关控制系数以及误差微分相关控制系数需要满足以下约束条件:
本发明的有益效果:本发明提出了包含定位误差的自适应更新律,所述自适应更新律可以保证系统精确跟踪目标轨迹,可以在误差非零时实时估计系统包括小车质量,吊绳长度等系统参数,因此也提高了所述控制器的鲁棒性能,并且最终可以实现小车和导轨的定位以及分布式质量负载的消摆目的。
附图说明
为了更清楚地说明本发明实施例的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其它的附图。其中:
图1为本发明第一个实施例所述的分布质量负载的桥吊防摇定位控制方法的流程示意图;
图2为本发明第一个实施例所述的分布质量负载的桥吊防摇定位控制方法的具有分布式质量负载的桥式起重机结构原理图;
图3为本发明第二个实施例所述的分布质量负载的桥吊防摇定位控制方法的实验平台结构图;
图4为本发明第二个实施例所述的分布质量负载的桥吊防摇定位控制方法的控制器的实验结果图;
图5为本发明第二个实施例所述的分布质量负载的桥吊防摇定位控制方法的控制器lqr的实验结果图。
具体实施方式
为使本发明的上述目的、特征和优点能够更加明显易懂,下面结合说明书附图对本发明的具体实施方式做详细的说明,显然所描述的实施例是本发明的一部分实施例,而不是全部实施例。基于本发明中的实施例,本领域普通人员在没有做出创造性劳动前提下所获得的所有其他实施例,都应当属于本发明的保护的范围。
在下面的描述中阐述了很多具体细节以便于充分理解本发明,但是本发明还可以采用其他不同于在此描述的其它方式来实施,本领域技术人员可以在不违背本发明内涵的情况下做类似推广,因此本发明不受下面公开的具体实施例的限制。
其次,此处所称的“一个实施例”或“实施例”是指可包含于本发明至少一个实现方式中的特定特征、结构或特性。在本说明书中不同地方出现的“在一个实施例中”并非均指同一个实施例,也不是单独的或选择性的与其他实施例互相排斥的实施例。
本发明结合示意图进行详细描述,在详述本发明实施例时,为便于说明,表示器件结构的剖面图会不依一般比例作局部放大,而且所述示意图只是示例,其在此不应限制本发明保护的范围。此外,在实际制作中应包含长度、宽度及深度的三维空间尺寸。
同时在本发明的描述中,需要说明的是,术语中的“上、下、内和外”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。此外,术语“第一、第二或第三”仅用于描述目的,而不能理解为指示或暗示相对重要性。
本发明中除非另有明确的规定和限定,术语“安装、相连、连接”应做广义理解,例如:可以是固定连接、可拆卸连接或一体式连接;同样可以是机械连接、电连接或直接连接,也可以通过中间媒介间接相连,也可以是两个元件内部的连通。对于本领域的普通技术人员而言,可以具体情况理解上述术语在本发明中的具体含义。
实施例1
参照图1~2,为本发明的一个实施例,提供了一种分布质量负载的桥吊防摇定位控制方法,包括:
s1:根据拉格朗日方程以及桥吊模型,构建具有分布式质量负载的桥吊三维动态模型。其中需要说明的是,
构建桥吊三维动态模型包括,结合应用过程中的摩擦力以及风阻,利用拉格朗日建模方程构建具有分布式质量负载桥吊三维动态模型,三维动态模型表示为:
m=[mij]∈r6×6,c=[cij]∈r6×6,i=1,...,6,j=1,...,6,
m11=m1+m2+mx,m12=0,m13=l1m1cosθ1cosθ2+l1m2cosθ1cosθ2
m14=-l1m1sinθ1sinθ2-l1m2sinθ1sinθ2,m15=lhm2cosθ3cosθ4
m16=-lhm2sinθ3sinθ4,m21=0,m22=m1+m2+my,m23=0
m24=-l1m1cosθ2-l1m2cosθ2,m25=0,m26=-lhm2cosθ4
m31=l1m1cosθ1cosθ2+l1m2cosθ1cosθ2,m32=0
m33=l12m1cosθ12cosθ22+l12m2cosθ12cosθ22+l12m1cosθ22sinθ12+l12m2cosθ22sinθ12
m34=0
m35=l1lhm2cosθ1cosθ2cosθ3cosθ4+l1lhm2cosθ2cosθ4sinθ1sinθ3
m36=-l1lhm2cosθ1cosθ2sinθ3sinθ4+l1lhm2cosθ2cosθ3sinθ1sinθ4
m41=-l1m1sinθ1sinθ2-l1m2sinθ1sinθ2,m42
m43=0
m44=l12m1cosθ12sinθ22+l12m2cosθ12sinθ22+l12m1sinθ12sinθ22+l12m2sinθ12sinθ22+l12m1cosθ22+l12m2cosθ22
m45=l1lhm2cosθ1cosθ4sinθ2sinθ3-l1lhm2cosθ3cosθ4sinθ1sinθ2
m46=l1lhm2cosθ1cosθ3sinθ2sinθ4+l1lhm2sinθ1sinθ2sinθ3sinθ4+l1lhm2cosθ2cosθ4
m51=lhm2cosθ3cosθ4,m52=0,m53=l1lhm2cosθ1cosθ2cosθ3cosθ4+l1lhm2cosθ2cosθ4sinθ1sinθ3
m54=l1lhm2cosθ1cosθ4sinθ2sinθ3-l1lhm2cosθ3cosθ4sinθ1sinθ2
m55=lh2m2cosθ32cosθ42+lh2m2cosθ42sinθ32+im2
m56=0,m61=-lhm2sinθ3sinθ4,m62=-lhm2cosθ4
m63=-l1lhm2cosθ1cosθ2sinθ3sinθ4+l1lhm2cosθ2cosθ3sinθ1sinθ4
m64=l1lhm2cosθ1cosθ3sinθ2sinθ4+l1lhm2sinθ1sinθ2sinθ3sinθ4+l1lhm2cosθ2cosθ4
m65=0,m66=lh2m2cosθ32sinθ42+lh2m2sinθ32sinθ42+lh2m2cosθ42
c11=0
c12=0
c21=0
c22=0
c23=0
c25=0
c31=0
c32=0
g=[00gl1m1cosθ2sinθ1+gl1m2cosθ2sinθ1gl1m1cosθ1sinθ2+gl1m2cosθ1sinθ2glhm2cosθ4sinθ3glhm2cosθ3sinθ4]t
c41=0
c42=0
c51=0
c52=0
c61=0
c62=0
u=[fxfy0000]t,fs=[frxfry0000]t
其中:l1为小车与吊钩间的绳长,l2为吊钩与分布质量负载固定间的绳长,lh为吊钩与分布质量负载质心间的垂直距离,m1和m2分别为吊钩与分布质量负载的质量,g为重力加速度,θi,
建立的三维动态模型充分考虑了分布式质量负载的转动惯量,并且非线性模型贴切实际起重机系统。
s2:根据三维动态模型,结合定位误差,构建自适应更新律。其中需要说明的是,
构建自适应更新律包括,在动态模型中,结合摩擦力模型、分析系统的动能和势能以及系统总能量变化率,构建一种包含定位误差的自适应更新律并规划自适应更新律参数的选取。
进一步的是,结合摩擦力模型包括,由于桥吊起重机应用中可驱动力部分存在不可避免的摩擦力,摩擦力表示为:
其中:f11和f21为静摩擦力相关系数,f12和f22为滑动摩擦力相关系数,四项摩擦系数将通过自适应更新率来实时估计,εx和εy为摩擦力模型的陡峭程度,一般取0.01。
s3:根据自适应更新律,构建增强定位的鲁棒自适应控制器,实现桥吊定位与消摆。其中需要说明的是,
一种包含定位误差的自适应更新律包括,根据系统总能量变化率,构造定位误差的自适应更新律,自适应更新律包括x方向和y方向的更新律,更新律分别用
ωyt=[m1+m2+myf21f22d2]
ωxt=[m1+m2+mxf11f12d1]
其中:πx和πy分别为x方向和y方向更新律的可变权重矩阵,且均为对角正定矩阵,γx和γy均为自适应更新律的相关矩阵,并且为一维向量,ωx与ωy为待估计向量,ex和ey为跟踪轨迹的误差,
进一步的是,进一步构建增强定位的鲁棒自适应控制器时,自适应更新律参数的选取应满足以下要求:πx=diag(kx1,kx2,kx3,kx4),πy=diag(ky1,ky2,ky3,ky4),其中自适应更新律参数中的各项根据实际操作环境进行选取,描述了自适应更新律中对于不同估计项的权重值,结合系统总能量变化率,对自适应控制器的参数进行限制。
更进一步的是,对参数的限制包括,在自适应更新律中增强定位项α的选取需要满足以下约束条件:
其中:
将包含定位误差的自适应更新律以及更新律相关矩阵,构建增强定位的鲁棒自适应控制器,其详细表达式为:
其中:k1p和k2p误差相关控制系数,k1d和k2d为误差微分相关控制系数,根据分析系统能量函数,对控制器相关参数进行限制,误差相关控制系数以及误差微分相关控制系数需要满足以下约束条件:
可以看出,本发明控制器没有用到角度信息,这从一定程度上减少了控制成本,另外,所采用的考虑误差的自适应控制率可保证小车以及导轨实时到达指定位置,这也提升了控制的精确性。
对于控制器中有一些待确定的参数,πx以及πy分别表示增强自适应更新律中对于不同估计参数的权重值,一般来说,它们的取值是相近的,在实际操作过程中只需要保证对它们的取值相差不是很大即可,另外的一些控制器相关参数的设计主要是为了使系统稳定,只需要按照取值限制条件进行取值即可。
在实际工程应用中,桥式起重机的双摆特性极其明显,此时吊钩和负载不可统一看作一个支点,它们各自有不同的运动趋势,尤其对于负载来说,更复杂的动态特性将会导致更难控制的负载摆角,因此对于此类系统的控制具有显而易见的工程意义以及经济价值;因此,本发明为了精确控制起重机以及节约成本,建立了精确的具有分布式质量负载的桥式起重机精确非线性模型,分析了模型整体能量函数并为了增强定位性能,构建了新型自适应估计率,并耦合了一种饱和函数,最后利用最终控制器跟踪一条具有消摆效果的轨迹,增强了控制器的暂态性能,一方面通过增强自适应控制增强了定位精度,满足工业现场对于定位精准度的要求,另一方面通过轨迹跟踪控制,不需要反馈角度信息,大幅度降低了控制器的设计成本。
实施例2
参照图3~5,为本发明另一个实施例,为对本方法中采用的技术效果加以验证说明,本实施例采用传统lqr控制器与本发明方法进行对比测试,以科学论证的手段对比试验结果,以验证本方法所具有的真实效果。
参照图3,为了对本发明的有益效果进行验证,搭建了一个桥式起重机硬件平台,该平台依据实际起重机进行类似模拟,测量元件部分由六个绝对编码器组成,其中两个用来读取驱动器作用下的小车和导轨的位移,另外四个用来实时读取吊钩与负载的角度信息,数据采集频率设置为0.05秒,且所有采集的信息都通过有线传输的方法输入到运动控制卡中,执行机构部分由两个驱动器组成,它们分别控制着小车和导轨的运动,软件部分采用工控机中加入运动控制卡的方式完成数据的交换与处理,具体来说,利用matlab/simulink模块读取工控机中运动控制卡的信息,并利用现有算法进行驱动力的计算,最终将数值反馈到驱动器当中。
平台搭建完成后,对传统lqr控制器和本发明控制方法进行测试,其中传统的控制器lqr的控制公式为:
对于lqr控制器,状态向量设置为
表1:振幅实验对比结果。
同时参照图4与图5可见,显而易见的是,时间误差几乎可以忽略不计,本方法下的小车以及导轨的定位的距离要优于传统lqr控制器,且本方法下的角度幅值也远远小于lqr方法,具体来说,本方法的四个角度幅值相较于lqr方法分别提升了42%,43%,59%,68%,本方法下的吊钩与负载在震荡一个周期后几乎完成角度抑制,且在震荡过程中,角度幅值最大不超过1.66,而传统lqr方法的消摆效果特别差,角度幅值最大达到2.54,这对实际应用的影响是极其不利的,因此本方法的控制效率很高,可以完成无误差定位以及角度抑制。
应说明的是,以上实施例仅用以说明本发明的技术方案而非限制,尽管参照较佳实施例对本发明进行了详细说明,本领域的普通技术人员应当理解,可以对本发明的技术方案进行修改或者等同替换,而不脱离本发明技术方案的精神和范围,其均应涵盖在本发明的权利要求范围当中。