CN114132838B - 一种无人天车运行过程中的防摇摆控制方法 - Google Patents
一种无人天车运行过程中的防摇摆控制方法 Download PDFInfo
- Publication number
- CN114132838B CN114132838B CN202111538212.1A CN202111538212A CN114132838B CN 114132838 B CN114132838 B CN 114132838B CN 202111538212 A CN202111538212 A CN 202111538212A CN 114132838 B CN114132838 B CN 114132838B
- Authority
- CN
- China
- Prior art keywords
- acceleration
- cart
- lifting appliance
- axis
- fuzzy
- 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
-
- 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
-
- 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/16—Applications of indicating, registering, or weighing devices
-
- 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/22—Control systems or devices for electric drives
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Control And Safety Of Cranes (AREA)
Abstract
本发明提供了一种无人天车运行过程中的防摇摆控制方法,涉及无人天车吊运钢材技术领域。本发明根据无人天车运行过程的吊具摇摆偏移量进行速度与加速度的自动调整,包括以下步骤:第一步,定义无人天车运行方向坐标系;第二步,设置防摇摆控制周期为T,即按照T间隔周期实施控制;第三步,根据大车、小车实时速度值计算当前加速度值;第四步,通过摆角检测仪实测角度信息,计算吊具相对于天车空间位置的相对偏移量;第五步,基于模糊控制方法,计算获得天车的大车与小车防摇摆加速度的调节增益系数;第六步,根据调节增益系数计算加速度调整量;第七步,通过计算获得的加速度调整量修正加速度。
Description
技术领域
本发明涉及无人天车吊运钢材的技术领域,尤其涉及针对无人行车运行过程防摇摆控制的技术领域。
背景技术
随着物联网、人工智能等信息技术的发展,钢铁企业正在向以智能工厂为载体、以关键制造环节智能化为核心、以端到端数据流为基础、以网通互联为支撑的智能制造模式转型。其中,起重机与库区的无人化与智能化建设,成为智能工厂建设极具代表性的一项技术。
无人天车在变速运动中吊具速度变化滞后于大车和小车速度变化,不可避免的会发生吊具晃动的情况,这给天车的安全运行带来了风险,为了消除这种速度变化的不同步,让天车在最短的时间内平稳的到达目标位置,无人天车控制***设计中需要开发自动防摇摆控制技术。
防摇摆控制***由摆动角度检测仪、红外标记和防摇摆控制模型组成。摆动角度检测仪安装在天车上部,红外标记安装在吊具上部,两两配合使用,可以测得吊具的晃动角度。根据实测的天车晃动角度、天车实际位置、速度信息,实时计算天车加速度调整量,并将该加速度调整量传递到传动变频器,即可控制天车大、小车速度,实现防摇摆控制。
现阶段的防摇摆控制模型,在由检测角度转化为加速度调整时,未充分考虑吊具相对天车的钢丝绳长度影响,并且未充分考虑偏移程度、天车运行速度方向、偏移方向等因素对调节增益的影响,容易导致参数设置合理所引起的调节效率低或者过调节问题。
发明内容
本发明是为了解决上述技术问题,提供一种模糊变增益防摇摆控制技术,充分考虑各种影响因素动态设置调节增益,充分保证了防摇摆控制的调节效率与控制稳定性。
本发明提供了一种无人天车运行过程中的防摇摆控制方法,根据无人天车运行过程的吊具摇摆偏移量进行速度与加速度的自动调整,包括以下步骤:
步骤1:定义无人天车运行方向坐标系,包括:
无人天车运行方向包括大车运动方向、小车运动方向、吊具运动方向以及吊具相对小车转动方向四个自由度,以无人天车HOME位为原点、大车前进方向为X轴正向、小车前进方向为Y轴正向建立平行于水平面的天车运行坐标系;
步骤2:设置防摇摆控制周期为T,即按照T间隔周期实施控制,包括:
实时测量获取无人天车Tn-1时刻的大车位置,小车位置,大车速度VXTn-1,小车速度VYTn-1,以及无人天车Tn时刻的大车位置,小车位置,大车速度VXTn,小车速度VYTn;
步骤3:根据大车速度从VXTn-1到VXTn的变化,根据公式(1)计算大车加速度aXTn,包括:
aXTn=(VXTn-VXTn-1)/T (1)
根据小车速度从VYTn-1到VYTn的变化,根据公式(2)计算小车加速度aYTn:
aYTn=(VYTn-VYTn-1)/T (2)
加速度计算完成的同时,也得到了加速度的方向;
步骤4:通过摆角检测仪实测角度信息,计算吊具相对于天车空间位置的相对偏移量,包括吊具X轴偏移程度XTn和吊具Y轴偏移程度YTn;
步骤5:基于模糊控制方法,根据吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向确定,建立模糊控制模型获得大车加速度调节增益系数PXTn;根据吊具Y轴偏离程度、小车加速度方向、吊具Y轴偏离方向确定,建立模糊控制模型获得小车加速度调节增益系数PYTn;
步骤6:将吊具X轴偏移程度XTn乘以大车加速度调节增益系数PXTn,根据公式(3)得到大车加速度调整量ΔaXTn:
ΔaXTn=XTn*PXTn (3)
将吊具Y轴偏移程度YTn乘以小车加速度调节增益系数PYTn,根据公式(4)得到小车加速度调整量ΔaYTn:
ΔaYTn=YTn*PYTn (4)
步骤7:通过大车、小车加速度调整量ΔaXTn与ΔaYTn修正Tn+1时刻的加速度,根据公式(5)以及公式(6)得到:
aXTn+1=aXTn+ΔaXTn (5)
aYTn+1=aYTn+ΔaYTn (6)
至此,完成了根据摇摆偏移量的天车加速度调整控制。
优选地,步骤4中,通过摆角检测仪实测角度信息,计算吊具X轴偏移程度XTn和吊具Y轴偏移程度YTn,包括:
将小车水平面按XY轴分为Ⅰ、Ⅱ、Ⅲ、Ⅳ四个象限,主钩钢丝绳长度为L,L在XZ平面投影为Lxz,Lxz在XZ平面与Z轴的夹角为α1,L在YZ平面上投影为Lyz,Lyz在YZ平面与Z轴的夹角为α2,夹角α1与α2即为摆角检测仪实测角度;
根据公式(7)以及公式(8),计算Tn时刻吊具X轴偏移程度XTn和吊具Y轴偏移程度YTn:
XTn=Lxz·sinα1 (7)
YTn=Lyz·sinα2 (8)
根据公式(9)以及公式(10),由空间中存在的几何关系得到:
联立所述公式(9)以及公式(10)解得吊具X轴偏移程度XTn和吊具Y轴偏移程度YTn分别与夹角α1、α2之间的关系式:
由此,根据摆角检测仪实测角度α1、α2计算出吊具X轴偏移程度XTn、吊具Y轴偏移程度YTn。
优选地,步骤5中,基于模糊控制方法,获得大车加速度调节增益系数PXTn,包括:
步骤5.1:确定输入、输出变量的模糊子集,包括:
包括吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向和大车加速度调节增益系数,模糊子集取值设定如下:
吊具X轴偏离程度XTn在模糊运算中记为S,设定其模糊子集mS为:{大,中,小};
大车加速度方向在模糊运算中记为D,设定其模糊子集mD为:{正,负};
吊具X轴偏离方向在模糊运算中记为W,设定其模糊子集mW为:{正,负};
大车加速度调节增益系数PXTn在模糊运算中记为Q,设定其模糊子集mQ为:{大大,中大,小大,大小,中小,小小};
步骤5.2:变量模糊化,包括:
吊具X轴偏离程度S的基本物理论域为设定的最小值到最大值取值区间[Svmin,Svmax],大车加速度方向D的基本物理论域为{-1,1},吊具X轴偏离方向W的基本物理论域为{-1,1},大车加速度调节增益系数Q的基本物理论域为[Qvmin,Qvmax];
将基本物理论域转化为以离散自然数方式描述的模糊值域,实现变量模糊化;吊具X轴偏离程度S的模糊值域为{1,…,ES},吊具X轴偏离程度S的模糊值eS的转化公式如下:
吊具X轴偏离程度S即为步骤4计算出的吊具X轴偏移程度XTn,模糊集最大值ES取为3,即吊具偏离程度S的模糊值eS∈{1,2,3};
大车加速度方向D的模糊值域为{-1,1},大车加速度方向D的模糊值eD等于大车加速度方向取值:
eD=D (14)
即大车加速度方向D的模糊值eD∈{-1,1};
吊具X轴偏离方向W的模糊值域为{-1,1},吊具X轴偏离方向W的模糊值eW等于吊具X轴偏离方向取值:
eW=W (15)
即吊具X轴偏离程度W的模糊值eW∈{-1,1};
大车加速度调节增益系数Q的模糊值域为{0,1,…,EQ},大车加速度调节增益系数Q的模糊值eQ的转化公式如下:
模糊集最大值EQ取为6,即大车加速度调节增益系数Q的模糊值eQ∈{0,1,2,3,4,5,6};
步骤5.3:设定模糊值域对模糊子集的隶属度,包括:
针对各变量设定模糊值域对模糊子集的隶属度,吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向、大车加速度调节增益系数的隶属度分别定义为μS、μD、μW、μQ;分别确定吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向、大车加速度调节增益系数的隶属度;
步骤5.4:建立大车加速度调节增益系数的模糊控制规则表;
步骤5.5:建立模糊关系矩阵,包括:
所述模糊控制规则表包括12条规则,形成模糊关系矩阵R,其为每一条规则对应子矩阵Ri的合成;子矩阵Ri为对应子规则i中吊具X轴偏离程度的隶属度矩阵μSi、大车加速度方向的隶属度矩阵μDi、吊具X轴偏离方向的隶属度矩阵μWi、大车加速度调节增益系数的隶属度矩阵μQi四者之间的直积运算:
Ri=μSi×μDi×μWi×μQi,i=1,2,…,12 (17)
对子矩阵Ri进行合并运算,得到模糊关系矩阵R,
即模糊关系矩阵R中任意位置元素,为所有12个子矩阵Ri中相同位置元素的最大值;
基于所述吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向、大车加速度调节增益系数的隶属度值,计算得到模糊关系矩阵R
步骤5.6:通过模糊关系矩阵R求解大车加速度调节增益系数Q,包括:
通过吊具X轴偏离程度,大车加速度方向,吊具X轴偏离方向,参照式(13)~式(16),分别转化模糊值eS、eD、eW,并分别按照所述吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向的隶属度值,转化为隶属度矩阵μS *、μD *、μW *;
在此基础上,计算出大车加速度调节增益系数的隶属度矩阵μQ,如公式(20)所示:
μQ为一个1*7的行向量,在该行向量中的7个元素中比较获取到数值最大的元素所在列数LQ,利用以下列数LQ与模糊值eQ的对应关系,求解eQ;
eQ=LQ-1 (21)
最后,将模糊值eQ通过公式(16)计算得到大车加速度调节增益系数Q,即大车加速度调节增益系数PXTn;
通过公式(22)利用模糊值eQ计算得到大车加速度调节增益Q,即PXTn:
优选地,步骤5中,采用与大车加速度调节增益系数PXTn相同的方式获得小车加速度调节增益系数PYTn。
附图说明
为了更清楚地说明本发明实施例中的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本发明实施例的一种无人天车运行过程中的防摇摆控制方法的方法流程图;
图2为本发明实施例的一种无人天车运行过程中的防摇摆控制方法的无人天车运动过程坐标系示意图。
图3为本发明实施例的一种无人天车运行过程中的防摇摆控制方法的摆动角度图形解析。
图4为本发明实施例的一种无人天车运行过程中的防摇摆控制方法的天车防摇摆加速度模糊控制器。
具体实施方式
为使本发明要解决的技术问题、技术方案和优点更加清楚,下面将结合附图及具体实施例进行详细描述。
如图1所示,本发明实施例提供一种无人天车运行过程中的防摇摆控制方法,即根据无人天车运行过程的吊具摇摆偏移量进行速度与加速度的自动调整,包括以下步骤:
步骤1:定义无人天车运行方向坐标系;
无人天车运行方向包括大车运动方向、小车运动方向、吊具运动方向以及吊具相对小车转动方向四个自由度,以无人天车HOME位为原点、大车前进方向为X轴正向、小车前进方向为Y轴正向建立平行于水平面的天车运行坐标系;如图2所示,为本发明实施例的无人天车运动过程坐标系示意图。
步骤2:设置防摇摆控制周期为T,即按照T间隔周期实施控制;
实时测量获取无人天车Tn-1时刻的大车位置,小车位置,大车速度VXTn-1,小车速度VYTn-1,以及无人天车Tn时刻的大车位置,小车位置,大车速度VXTn,小车速度VYTn;
步骤3:根据大车速度从VXTn-1到VXTn的变化,计算大车加速度aXTn:
aXTn=(VXTn-VXTn-1)/T (1)
根据小车速度从VYTn-1到VYTn的变化,计算小车加速度aYTn:
aYTn=(VYTn-VYTn-1)/T (2)
加速度计算完成的同时,也得到了加速度的方向;
步骤4:通过摆角检测仪实测角度信息,计算吊具相对于天车空间位置的相对偏移量,包括吊具X轴偏移程度XTn和吊具Y轴偏移程度YTn;
步骤5:基于模糊控制方法,根据吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向确定,建立模糊控制模型获得大车加速度调节增益系数PXTn;根据吊具Y轴偏离程度、小车加速度方向、吊具Y轴偏离方向确定,建立模糊控制模型获得小车加速度调节增益系数PYTn;
步骤6:将吊具X轴偏移程度XTn乘以大车加速度调节增益系数PXTn,得到大车加速度调整量ΔaXTn:
ΔaXTn=XTn*PXTn (3)
将吊具Y轴偏移程度YTn乘以小车加速度调节增益系数PYTn,得到小车加速度调整量ΔaYTn:
ΔaYTn=YTn*PYTn (4)
步骤7:通过大车、小车加速度调整量ΔaXTn与ΔaYTn修正Tn+1时刻的加速度:
aXTn+1=aXTn+ΔaXTn (5)
aYTn+1=aYTn+ΔaYTn (6)
至此,完成了根据摇摆偏移量的天车加速度调整控制。
优选地,如图3所示,为本发明实施例的摆动角度图形解析。步骤4中,通过摆角检测仪实测角度信息,计算吊具X轴偏移程度XTn和吊具Y轴偏移程度YTn,包括:
将小车水平面按XY轴分为Ⅰ、Ⅱ、Ⅲ、Ⅳ四个象限,主钩钢丝绳长度为L,L在XZ平面投影为Lxz,Lxz在XZ平面与Z轴的夹角为α1,L在YZ平面上投影为Lyz,Lyz在YZ平面与Z轴的夹角为α2,夹角α1与α2即为摆角检测仪实测角度;
首先计算Tn时刻吊具X轴偏移程度XTn和吊具Y轴偏移程度YTn:
XTn=Lxz·sinα1 (7)
YTn=Lyz·sinα2 (8)
由空间中存在的几何关系:
联立解得吊具X轴偏移程度XTn和吊具Y轴偏移程度YTn分别与夹角α1、α2之间的关系式:
由此,根据摆角检测仪实测角度α1、α2计算出吊具X轴偏移程度XTn、吊具Y轴偏移程度YTn。
优选地,如图4所示,为本发明实施例的天车防摇摆加速度模糊控制器。步骤5中,基于模糊控制方法,获得大车加速度调节增益系数PXTn,包括:
步骤5.1:确定输入、输出变量的模糊子集
包括吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向和大车加速度调节增益系数,模糊子集取值设定如下:
吊具X轴偏离程度XTn在模糊运算中记为S,设定其模糊子集mS为:{大,中,小};
大车加速度方向在模糊运算中记为D,设定其模糊子集mD为:{正,负};
吊具X轴偏离方向在模糊运算中记为W,设定其模糊子集mW为:{正,负};
大车加速度调节增益系数PXTn在模糊运算中记为Q,设定其模糊子集mQ为:{大大,中大,小大,大小,中小,小小};
步骤5.2:变量模糊化
吊具X轴偏离程度S的基本物理论域为设定的最小值到最大值取值区间[Svmin,Svmax],大车加速度方向D的基本物理论域为{-1,1},吊具X轴偏离方向W的基本物理论域为{-1,1},大车加速度调节增益系数Q的基本物理论域为[Qvmin,Qvmax];
将基本物理论域转化为以离散自然数方式描述的模糊值域,实现变量模糊化;吊具X轴偏离程度S的模糊值域为{1,…,ES},吊具X轴偏离程度S的模糊值eS的转化公式如下:
吊具X轴偏离程度S即为步骤4计算出的吊具X轴偏移程度XTn,模糊集最大值ES取为3,即吊具偏离程度S的模糊值eS∈{1,2,3};
大车加速度方向D的模糊值域为{-1,1},大车加速度方向D的模糊值eD等于大车加速度方向取值:
eD=D (14)
即大车加速度方向D的模糊值eD∈{-1,1};
吊具X轴偏离方向W的模糊值域为{-1,1},吊具X轴偏离方向W的模糊值eW等于吊具X轴偏离方向取值:
eW=W (15)
即吊具X轴偏离程度W的模糊值eW∈{-1,1};
大车加速度调节增益系数Q的模糊值域为{0,1,…,EQ},大车加速度调节增益系数Q的模糊值eQ的转化公式如下:
模糊集最大值EQ取为6,即大车加速度调节增益系数Q的模糊值eQ∈{0,1,2,3,4,5,6};
步骤5.3:设定模糊值域对模糊子集的隶属度
针对各变量设定模糊值域对模糊子集的隶属度,吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向、大车加速度调节增益系数的隶属度分别定义为μS、μD、μW、μQ,如表1~表4所示,表1~表4中的行表头分别代表吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向、大车加速度调节增益系数的模糊值,表1~表4中的列表头分别代表吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向、大车加速度调节增益系数的模糊子集取值,表1~表4中的元素分别为吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向、大车加速度调节增益系数的隶属度;
表1 吊具X轴偏离程度模糊隶属度μS表
表2 大车加速度方向模糊隶属度μD表
表3 吊具X轴偏离方向模糊隶属度μW表
表4 大车加速度调节增益系数模糊隶属度μQ表
步骤5.4:建立大车加速度调节增益系数的模糊控制规则表,如表5所示;
表5 大车加速度调节增益系数的模糊控制规则表
步骤5.5:建立模糊关系矩阵
上述模糊控制规则表共12条规则,形成模糊关系矩阵R,其为每一条规则对应子矩阵Ri的合成;子矩阵Ri为对应子规则i中吊具X轴偏离程度的隶属度矩阵μSi、大车加速度方向的隶属度矩阵μDi、吊具X轴偏离方向的隶属度矩阵μWi、大车加速度调节增益系数的隶属度矩阵μQi四者之间的直积运算:
Ri=μSi×μDi×μWi×μQi,i=1,2,…,12 (17)
对子矩阵Ri进行合并运算,得到模糊关系矩阵R,
即模糊关系矩阵R中任意位置元素,为所有12个子矩阵Ri中相同位置元素的最大值;
基于表1~表4设定的隶属度值,计算得到12×7维的模糊关系矩阵R如下:
步骤5.6:通过模糊关系矩阵R求解大车加速度调节增益系数Q
通过吊具X轴偏离程度,大车加速度方向,吊具X轴偏离方向,参照式(13)~式(16),分别转化模糊值eS、eD、eW,并分别按照表1~表3,转化为隶属度矩阵μS *、μD *、μW *;
在此基础上,计算出大车加速度调节增益系数的隶属度矩阵μQ,如下式所示:
μQ为一个1*7的行向量,在该行向量中的7个元素中比较获取到数值最大的元素所在列数LQ,利用以下列数LQ与模糊值eQ的对应关系,求解eQ;
eQ=LQ-1 (21)
最后,将模糊值eQ通过式(16)计算得到大车加速度调节增益系数Q,即大车加速度调节增益系数PXTn。
最后通过式(22)利用模糊值eQ计算得到大车加速度调节增益Q,即PXTn:
优选地,步骤5中,采用与大车加速度调节增益系数PXTn相同的方式获得小车加速度调节增益系数PYTn。
对大车加速度调节增益系数PXTn计算示例如下,不妨取S取值范围为[0,100],单位为cm,实际检测偏离程度S=50cm;天车加速度方向为负,记为D=-1;吊具偏离方向为正,记为W=1;加速度增益Q取值范围为[0,10],单位m/s2。
根据式(13),实际检测偏离程度S模糊化后得取值为:
据表1,当eS=2时,其最大隶属度对应模糊子集为“中”,其隶属度矩阵为:
μS *=[0.2 1 0.3]
同理,若D=-1,W=1,根据式(14)~式(15),可得其模糊化后取值分别为:
eD=-1,ew=1
其隶属度矩阵分别为:
μD *=[1 0]
μW *=[0 1]
据式(20)计算得到μQ:
在该计算结果中选择最大隶属度所在列,当隶属度为0.6时,其所在列为5,即:
LQ=5
故:eQ=LQ-1=4
最后通过式(22)利用模糊值eQ计算得到加速度调节增益Q:
即大车加速度调节增益系数PXTn=8.3。
本领域普通技术人员可以理解实现上述实施例的全部或部分步骤可以通过硬件来完成,也可以通过程序来指令相关的硬件完成,所述的程序可以存储于一种计算机可读存储介质中,上述提到的存储介质可以是只读存储器,磁盘或光盘等。
以上所述仅为本发明的较佳实施例,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (4)
1.一种无人天车运行过程中的防摇摆控制方法,其特征在于:根据无人天车运行过程的吊具摇摆偏移量进行速度与加速度的自动调整,包括以下步骤:
步骤1:定义无人天车运行方向坐标系,包括:
无人天车运行方向包括大车运动方向、小车运动方向、吊具运动方向以及吊具相对小车转动方向四个自由度,以无人天车HOME位为原点、大车前进方向为X轴正向、小车前进方向为Y轴正向建立平行于水平面的天车运行坐标系;
步骤2:设置防摇摆控制周期为T,即按照T间隔周期实施控制,包括:
实时测量获取无人天车Tn-1时刻的大车位置,小车位置,大车速度VXTn-1,小车速度VYTn-1,以及无人天车Tn时刻的大车位置,小车位置,大车速度VXTn,小车速度VYTn;其中,n表示任意指定的某一参考时刻;
步骤3:根据大车速度从VXTn-1到VXTn的变化,根据公式(1)计算大车加速度aXTn,包括:
aXTn=(VXTn-VXTn-1)/T (1)
根据小车速度从VYTn-1到VYTn的变化,根据公式(2)计算小车加速度aYTn:
aYTn=(VYTn-VYTn-1)/T (2)
加速度计算完成的同时,也得到了加速度的方向;
步骤4:通过摆角检测仪实测角度信息,计算吊具相对于天车空间位置的相对偏移量,包括吊具X轴偏移程度XTn和吊具Y轴偏移程度YTn;
步骤5:基于模糊控制方法,根据吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向确定,建立模糊控制模型获得大车加速度调节增益系数PXTn;根据吊具Y轴偏离程度、小车加速度方向、吊具Y轴偏离方向确定,建立模糊控制模型获得小车加速度调节增益系数PYTn;
步骤6:将吊具X轴偏移程度XTn乘以大车加速度调节增益系数PXTn,根据公式(3)得到大车加速度调整量ΔaXTn:
ΔaXTn=XTn×PXTn (3)
将吊具Y轴偏移程度YTn乘以小车加速度调节增益系数PYTn,根据公式(4)得到小车加速度调整量ΔaYTn:
ΔaYTn=YTn×PYTn (4)
步骤7:通过大车ΔaXTn与小车加速度调整量ΔaYTn修正Tn+1时刻的加速度,根据公式(5)以及公式(6)得到:
aXTn+1=aXTn+ΔaXTn (5)
aYTn+1=aYTn+ΔaYTn (6)
至此,完成了根据摇摆偏移量的天车加速度调整控制。
2.根据权利要求1所述的一种无人天车运行过程中的防摇摆控制方法,其特征在于:步骤4中,通过摆角检测仪实测角度信息,计算吊具X轴偏移程度XTn和吊具Y轴偏移程度YTn,包括:
将小车水平面按XY轴分为Ⅰ、Ⅱ、Ⅲ、Ⅳ四个象限,主钩钢丝绳长度为L,L在XZ平面投影为Lxz,Lxz在XZ平面与Z轴的夹角为α1,L在YZ平面上投影为Lyz,Lyz在YZ平面与Z轴的夹角为α2,夹角α1与α2即为摆角检测仪实测角度;
根据公式(7)以及公式(8),计算Tn时刻吊具X轴偏移程度XTn和吊具Y轴偏移程度YTn:
XTn=Lxz·sinα1 (7)
YTn=Lyz·sinα2 (8)
根据公式(9)以及公式(10),由空间中存在的几何关系得到:
联立所述公式(9)以及公式(10)解得吊具X轴偏移程度XTn和吊具Y轴偏移程度YTn分别与夹角α1、α2之间的关系式:
由此,根据摆角检测仪实测角度α1、α2计算出吊具X轴偏移程度XTn、吊具Y轴偏移程度YTn。
3.根据权利要求1或2所述的一种无人天车运行过程中的防摇摆控制方法,其特征在于:所述步骤5中,基于模糊控制方法,获得大车加速度调节增益系数PXTn,包括:
步骤5.1:确定输入、输出变量的模糊子集,包括:
包括吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向和大车加速度调节增益系数,模糊子集取值设定如下:
吊具X轴偏离程度XTn在模糊运算中记为S,设定其模糊子集mS为:{大,中,小};
大车加速度方向在模糊运算中记为D,设定其模糊子集mD为:{正,负};
吊具X轴偏离方向在模糊运算中记为W,设定其模糊子集mW为:{正,负};
大车加速度调节增益系数PXTn在模糊运算中记为Q,设定其模糊子集mQ为:{大大,中大,小大,大小,中小,小小};
步骤5.2:变量模糊化,包括:
吊具X轴偏离程度S的基本物理论域为设定的最小值到最大值取值区间[Svmin,Svmax],大车加速度方向D的基本物理论域为{-1,1},吊具X轴偏离方向W的基本物理论域为{-1,1},大车加速度调节增益系数Q的基本物理论域为[Qvmin,Qvmax];
将基本物理论域转化为以离散自然数方式描述的模糊值域,实现变量模糊化;吊具X轴偏离程度S的模糊值域为{1,…,ES},吊具X轴偏离程度S的模糊值eS的转化公式如下:
吊具X轴偏离程度S即为步骤4计算出的吊具X轴偏移程度XTn,模糊集最大值ES取为3,即吊具偏离程度S的模糊值eS∈{1,2,3};
大车加速度方向D的模糊值域为{-1,1},大车加速度方向D的模糊值eD等于大车加速度方向取值:
eD=D (14)
即大车加速度方向D的模糊值eD∈{-1,1};
吊具X轴偏离方向W的模糊值域为{-1,1},吊具X轴偏离方向W的模糊值eW等于吊具X轴偏离方向取值:
eW=W (15)
即吊具X轴偏离程度W的模糊值eW∈{-1,1};
大车加速度调节增益系数Q的模糊值域为{0,1,…,EQ},大车加速度调节增益系数Q的模糊值eQ的转化公式如下:
模糊集最大值EQ取为6,即大车加速度调节增益系数Q的模糊值eQ∈{0,1,2,3,4,5,6};
步骤5.3:设定模糊值域对模糊子集的隶属度,包括:
针对各变量设定模糊值域对模糊子集的隶属度,吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向、大车加速度调节增益系数的隶属度分别定义为μS、μD、μW、μQ;分别确定吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向、大车加速度调节增益系数的隶属度;
步骤5.4:建立大车加速度调节增益系数的模糊控制规则表;
步骤5.5:建立模糊关系矩阵,包括:
所述模糊控制规则表包括12条规则,形成模糊关系矩阵R,所述模糊关系矩阵R为每一条规则对应子矩阵Ri的合成;子矩阵Ri为对应子规则i中吊具X轴偏离程度的隶属度矩阵μSi、大车加速度方向的隶属度矩阵μDi、吊具X轴偏离方向的隶属度矩阵μWi、大车加速度调节增益系数的隶属度矩阵μQi四者之间的直积运算:
Ri=μSi×μDi×μWi×μQi,i=1,2,…,12 (17)
对子矩阵Ri进行合并运算,得到模糊关系矩阵R,
即模糊关系矩阵R中任意位置元素,为所有12个子矩阵Ri中相同位置元素的最大值;
基于所述吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向、大车加速度调节增益系数的隶属度值,计算得到模糊关系矩阵R;
步骤5.6:通过模糊关系矩阵R求解大车加速度调节增益系数Q,包括:
通过吊具X轴偏离程度,大车加速度方向,吊具X轴偏离方向,参照公式(13)~公式(16),分别转化模糊值eS、eD、eW,并分别按照所述吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向的隶属度值,转化为隶属度矩阵μS *、μD *、μW *;
在此基础上,计算出大车加速度调节增益系数的隶属度矩阵μQ,如公式(20)所示:
μQ为一个1*7的行向量,在该行向量中的7个元素中比较获取到数值最大的元素所在列数LQ,利用以下列数LQ与模糊值eQ的对应关系,求解eQ;
eQ=LQ-1 (21)
最后,将模糊值eQ通过公式(16)计算得到大车加速度调节增益系数Q,即大车加速度调节增益系数PXTn;
通过公式(22)利用模糊值eQ计算得到大车加速度调节增益Q,即PXTn:
4.根据权利要求3所述的一种无人天车运行过程中的防摇摆控制方法,其特征在于:步骤5中,采用与大车加速度调节增益系数PXTn相同的方式获得小车加速度调节增益系数PYTn。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111538212.1A CN114132838B (zh) | 2021-12-15 | 2021-12-15 | 一种无人天车运行过程中的防摇摆控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111538212.1A CN114132838B (zh) | 2021-12-15 | 2021-12-15 | 一种无人天车运行过程中的防摇摆控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114132838A CN114132838A (zh) | 2022-03-04 |
CN114132838B true CN114132838B (zh) | 2022-08-16 |
Family
ID=80382555
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111538212.1A Active CN114132838B (zh) | 2021-12-15 | 2021-12-15 | 一种无人天车运行过程中的防摇摆控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114132838B (zh) |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101723239B (zh) * | 2009-11-20 | 2012-05-02 | 三一汽车制造有限公司 | 吊钩姿态检测装置和起重机 |
CN106115484B (zh) * | 2016-06-23 | 2018-03-06 | 北京起重运输机械设计研究院 | 用于人工操作的桥式起重机吊钩防摇控制方法及*** |
CN107215777B (zh) * | 2017-07-14 | 2019-05-24 | 武汉理工大学 | 一种起重机智能防摇摆控制***及其精确定位方法 |
CN107487717B (zh) * | 2017-07-31 | 2019-05-24 | 武汉理工大学 | 基于模糊pid控制的起重机智能防摇控制***及方法 |
CN110436347B (zh) * | 2019-08-23 | 2020-08-04 | 武汉理工大学 | 一种桥式起重机双摆***优化防摇控制方法 |
CN112429640B (zh) * | 2020-06-29 | 2022-11-22 | 邯郸钢铁集团有限责任公司 | 一种控制天车防摇的方法 |
CN113200451B (zh) * | 2021-04-30 | 2022-12-13 | 法兰泰克重工股份有限公司 | 一种防摇摆控制方法及行车 |
-
2021
- 2021-12-15 CN CN202111538212.1A patent/CN114132838B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN114132838A (zh) | 2022-03-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Wang et al. | Direct adaptive fuzzy tracking control for a class of perturbed strict-feedback nonlinear systems | |
CN1328146C (zh) | 在操纵者指令下的起重机抗摇摆控制 | |
CN110407094B (zh) | 一种基于动态平滑轨迹的桥式起重机定位防摆控制方法 | |
CN108549229A (zh) | 一种桥式吊车神经网络自适应控制器及其设计方法 | |
CN111153328A (zh) | 一种基于lqr的吊装***的防摇控制方法及*** | |
CN114195009B (zh) | 基于自抗扰控制器的双摆塔式吊车的防摆控制方法及*** | |
CN108584700A (zh) | 起重机自适应pid闭环防摇控制方法 | |
CN114132838B (zh) | 一种无人天车运行过程中的防摇摆控制方法 | |
CN113110511B (zh) | 一种基于广义模糊双曲模型的智能船舶航向控制方法 | |
CN113311783A (zh) | 一种s型运动曲线规划方法及*** | |
Mohamed et al. | Fine tuning of a PID controller with inlet derivative filter using Pareto solution for gantry crane systems | |
CN108657014B (zh) | 一种磁浮列车悬浮***位置传感器信号处理方法和装置 | |
CN108584723A (zh) | 起重机开环优化防摇控制方法 | |
CN111880413A (zh) | 一种针对船舶航向保持的自适应动态面算法 | |
Ouyang et al. | An LMI‐based simple robust control for load sway rejection of rotary cranes with double‐pendulum effect | |
CN110950241A (zh) | 一种智能起重机的电子防摇方法 | |
CN109581874B (zh) | 用于生成信息的方法和装置 | |
CN114637301B (zh) | 基于最优仿射队形变换的多机器人动态避障装置及方法 | |
CN116239022A (zh) | 桥式吊车定位防摆无模型自适应控制方法 | |
CN114249238B (zh) | 一种桥式吊车的防摆控制方法 | |
Liu et al. | Adaptive Output Feedback Control for the Trajectory Tracking of High‐Speed Trains with Disturbance Uncertainties on the Basis of Neural Network Observers | |
CN109946959A (zh) | 一种脱硫塔***的智能建模及控制方法 | |
Scardua et al. | Optimal control of ship unloaders using reinforcement learning | |
JPH1121077A (ja) | クレーン制御装置 | |
CN112141888A (zh) | 一种用于桥式起重机的开环防摇控制装置和时滞滤波器 |
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 |