CN114955856A - 一种基于轨迹规划的桥式起重机吊具防摇方法 - Google Patents
一种基于轨迹规划的桥式起重机吊具防摇方法 Download PDFInfo
- Publication number
- CN114955856A CN114955856A CN202210592475.9A CN202210592475A CN114955856A CN 114955856 A CN114955856 A CN 114955856A CN 202210592475 A CN202210592475 A CN 202210592475A CN 114955856 A CN114955856 A CN 114955856A
- Authority
- CN
- China
- Prior art keywords
- constructing
- speed
- swing angle
- bridge crane
- lifting appliance
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 21
- 238000013016 damping Methods 0.000 claims abstract description 27
- 238000005457 optimization Methods 0.000 claims abstract description 17
- 238000005070 sampling Methods 0.000 claims abstract description 12
- 238000004088 simulation Methods 0.000 claims abstract description 12
- 230000001133 acceleration Effects 0.000 claims description 33
- 239000013598 vector Substances 0.000 claims description 12
- 238000010276 construction Methods 0.000 claims description 4
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 238000004134 energy conservation Methods 0.000 claims description 3
- 150000001875 compounds Chemical class 0.000 claims description 2
- 239000000126 substance Substances 0.000 claims description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000012795 verification Methods 0.000 description 2
- 230000004075 alteration Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- HOWHQWFXSLOJEF-MGZLOUMQSA-N systemin Chemical compound NCCCC[C@H](N)C(=O)N[C@@H](CCSC)C(=O)N[C@@H](CCC(N)=O)C(=O)N[C@@H]([C@@H](C)O)C(=O)N[C@@H](CC(O)=O)C(=O)OC(=O)[C@@H]1CCCN1C(=O)[C@H]1N(C(=O)[C@H](CC(O)=O)NC(=O)[C@H](CCCN=C(N)N)NC(=O)[C@H](CCCCN)NC(=O)[C@H](CO)NC(=O)[C@H]2N(CCC2)C(=O)[C@H]2N(CCC2)C(=O)[C@H](CCCCN)NC(=O)[C@H](CO)NC(=O)[C@H](CCC(N)=O)NC(=O)[C@@H](NC(=O)[C@H](C)N)C(C)C)CCC1 HOWHQWFXSLOJEF-MGZLOUMQSA-N 0.000 description 1
- 108010050014 systemin Proteins 0.000 description 1
- 238000010200 validation analysis Methods 0.000 description 1
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
- 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
-
- 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
- G05B11/00—Automatic controllers
- G05B11/01—Automatic controllers electric
- G05B11/36—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential
- G05B11/42—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential for obtaining a characteristic which is both proportional and time-dependent, e.g. P. I., P. I. D.
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control And Safety Of Cranes (AREA)
Abstract
本发明公开了一种基于轨迹规划的桥式起重机吊具防摇方法,通过建立桥式起重机近似线性化的运动学模型、离散化采样、构建插值多项式、计算等效物理绳长l和吊具摆动时的阻尼系数B,进而在岸桥运动学模型外构建PID速度环控制器,并搭建仿真系统,最后进行轨迹设计,通过将小车速度轨迹设计成分段函数,并按照现有选定的优化求解策略可以使得最终的摆角小于设定的阈值,进而实现防摇的目的,相比于现有的防摇算法,减小了系统误差,提高了求解的实时性,防摇效果更好。
Description
技术领域
本发明涉及起重机技术领域,具体为一种基于轨迹规划的桥式起重机吊具防摇方法。
背景技术
起重机在工厂、矿山、港口、水电站、建筑、桥梁等领域广泛使用,一些大质量、高精度吊物需要平稳的进行搬运、装卸,为保证关键零件的安全性以及提高作业效率,对搬运过程中的防摇摆控制就显得尤为重要。目前已经出现了一些控制系统,通过控制算法及程序可以实现对起重机搬运速度及加速度的控制,减小吊物在运行中的摆动,但是目前这些方法具有很大的局限性。
发明内容
本发明的目的在于提供一种基于轨迹规划的桥式起重机吊具防摇方法,以解决上述背景技术中提出的目前在桥式起重机防摇算法中存在的精度较差、实时性较差等局限性问题。
为实现上述目的,本发明提供如下技术方案:一种基于轨迹规划的桥式起重机吊具防摇方法,包括以下步骤:
步骤一、建立桥式起重机近似线性化的运动学模型;所述桥式起重机运动学模型可以表达成如下状态空间形式:
式中,状态向量为:
式中,系统输入向量为:
步骤二、离散化采样;在实机环境下取n个观测绳长离散化采样点{l1,l2,...,ln},辨识系统对应不同观测绳长时的固有频率{ω1,ω2,...,ωn}和阻尼比{ζ1,ζ2,...,ζn},所述的观测绳长是指通过传感器获得的绳长值;
步骤三、构建插值多项式;根据n个观测绳长采样点和其对应的实际固有频率{ω1,ω2,...,ωn}和阻尼比{ζ1,ζ2,...,ζn},构建n个拉格朗日插值多项式Li(lm):
式中,lm表示观测绳长值;
构建绳长-固有频率拉格朗日插值函数ω(lm)和绳长-阻尼比的拉格朗日插值函数ζ(lm):
步骤四、根据绳长-固有频率插值函数ω(lm)和绳长-阻尼比插值函数ζ(lm)得到(1)式中的等效物理绳长l和吊具摆动时的阻尼系数B:
定义第一段加速时长为dt1,第二段加速时长为dt2,第三段减速时长为dt3,第四段减速时长为dt4,定义轨迹规划总距离为s,分别得到小车速度规划函数每个分段速度对应的距离值{s1,s2,s3,s4,s5,s6,s7},如下式所示:
根据系统加速度饱和上限值amax,系统速度饱和上限值vmax,第四段速度区间对应距离值s4以及待优化求解变量{dt1,dt2,dt3,dt4},可以得到分段函数的时间区间{t1,t2,t3,t4,t5,t6,t7},具体表达式如下:
步骤七:构建优化问题,求解四段关键加减速时长{dt1,dt2,dt3,dt4};具体包括以下步骤:
1)构建优化变量即四段关键加减速时长:
τ=[τ1,τ2,τ3,τ4]=[dt1,dt2,dt3,dt4] (14)
2)构建优化目标函数:
fmin=τ2+τ3 (15)
3)构建边界约束条件:
4)构建不等式约束条件:
|θeq|≤θmin (17)
其中θmin是设定的最大摆角上限;θeq是最后轨迹停止时刻的等效摆角,所述的等效摆角是指吊具摆动的最大摆角,由于有时存在角速度,采用能量守恒方法推导出角速度为0时的摆角值,称为等效摆角。具体换算表达式如下:
其中,θf是最后轨迹停止时刻的吊具摆角值,是最后轨迹停止时刻吊具摆角速度值,所述θf和通过在系统输入向量已知的情况下,采用数值法求解所述的桥式起重机运动学模型,所述的系统输入向量是根据规划的小车速度规划函数和绳索速度规划函数通过所述的PID速度环控制器实时求解获得。
优选的,步骤七中的优化问题通过maltab工具箱中采用对应的求解器进行求解。
优选的步骤一中桥式起重机运动学模型的简化形式为:
其中:
式中,P,Q是辅助函数,表达式为:
式中,g为标准重力加速度9.81m/s2,B为吊具摆动时的阻尼系数,实际系统中的等效物理绳长l和吊具摆动时的阻尼系数B通过系统辨识获得。
与现有技术相比,本发明的有益效果是:
该种基于轨迹规划的桥式起重机吊具防摇方法,通过建立桥式起重机近似线性化的运动学模型、离散化采样、构建插值多项式、计算等效物理绳长l和吊具摆动时的阻尼系数B,进而在岸桥运动学模型外构建PID速度环控制器,并搭建仿真系统,最后进行轨迹设计,通过将小车速度轨迹设计成分段函数,并按照现有选定的优化求解策略可以使得最终的摆角小于设定的阈值,进而实现防摇的目的,相比于现有的防摇算法,本方法在系统运动学模型外构建PID速度控制环,避免了系统误差的产生;其次,在实机环境下对绳长做离散化采样来辨识系统不同绳长对应的固有频率和阻尼比,进一步的减少了系统误差;最后还将速度轨迹加速段和减速段简化设计成中间带水平段的速度轨迹,提高了求解的实时性。
附图说明
图1为本发明的基于轨迹规划的桥式起重机吊具防摇方法的流程图;
图2为桥式起重机结构示意图;
图3为本发明构建的PID速度换控制器示意图;
图4为小车速度轨迹多段函数示意图;
图5为实施例验证方案中小车速度曲线;
图6为实施例验证方案中摆角曲线。
图中:1、小车;2、绳索;3、吊具。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
请参阅图1,本发明提供一种技术方案:一种基于轨迹规划的桥式起重机吊具防摇方法,包括(1)建立桥式起重机近似线性化的运动学模型、(2)离散化采样、(3)构建插值多项式、(4)计算等效物理绳长l和吊具摆动时的阻尼系数B,(5)在岸桥运动学模型外构建PID速度环控制器,并搭建仿真系统,(6)轨迹设计等主要步骤。
第一步,建立桥式起重机近似线性化运动学模型;请参阅图2,桥式起重机可以简化成小车(1)、绳索(2)和吊具(3)三部分,则桥式起重机运动学模型可以表达成如下状态空间形式:
式中,状态向量为:
式中,系统输入向量为:
对(1)式整理可得简化形式的桥式起重机运动学模型:
其中:
其中,P,Q是辅助函数,表达式为:
另外,式中,g为标准重力加速度9.81m/s2,B为吊具摆动时的阻尼系数。需要注意的是,实际系统中的等效物理绳长l和吊具摆动时的阻尼系数B无法直接获得,需要进行系统辨识。
第二步、真机环境下取n个观测绳长离散化采样点{l1,l2,...,ln},辨识系统对应不同观测绳长时的固有频率和阻尼比。得到对应的固有频率和阻尼比分别为{ω1,ω2,...,ωn},{ζ1,ζ2,...,ζn}。所述的观测绳长指的是通过传感器获得的绳长值,可能又存在测量误差,有别与所述的等效物理绳长。
第三步、根据n个观测绳长采样点和对应的实际固有频率和阻尼比,构建n个拉格朗日插值多项式Li(lm):
式中,lm表示观测绳长值。
构建绳长-固有频率拉格朗日插值函数ω(lm)和绳长-阻尼比的拉格朗日插值函数ζ(lm):
第四步、根据绳长-固有频率插值函数ω(lm)和绳长-阻尼比插值函数ζ(lm)得到(1)式中的等效物理绳长l和吊具摆动时的阻尼系数B:
式中是的一阶导数,是的二阶导数,是仿真系统的速度反馈值,kp是PID控制器参数。
第六步、轨迹设计。所述的轨迹指的是桥式起重机小车速度规划函数,通过将小车速度轨迹设计成分段函数,并按照一定的优化求解策略可以使得最终的摆角小于我们要求的上限值,实现防摇的目的。所述的小车速度规划函数具体形式如图4所示。
具体表达式如下:
我们定义第一段加速时长为dt1,第二段加速时长为dt2,第三段减速时长为dt3,第四段减速时长为dt4。轨迹规划总距离我们定义为s。分别得到小车速度规划函数每个分段速度对应的距离值{s1,s2,s3,s4,s5,s6,s7},如下式所示:
s2=amaxdt1dt2 (17.2)
s6=amaxdt3dt4 (17.5)
根据系统加速度饱和上限值amax,系统速度饱和上限值vmax,第四段速度区间对应距离值s4以及待优化求解变量{dt1,dt2,dt3,dt4},可以得到分段函数的时间区间{t1,t2,t3,t4,t5,t6,t7},具体表达式如下:
t1=dt1 (18.1)
t2=dt1+dt2 (18.2)
t3=vmax/amax+dt2 (18.3)
t4=s4/vmax+t3 (18.4)
t5=vmax/amax+t4-dt4 (18.5)
t6=t5+dt3 (18.6)
t7=t6+dt4 (18.7)
1)构建优化问题,求解四段关键加减速时长{dt1,dt2,dt3,dt4}。
2)构建优化变量即四段关键加减速时长:
τ=[τ1,τ2,τ3,τ4]=[dt1,dt2,dt3,dt4] (19)
3)构建优化目标函数:
fmin=τ2+τ3 (20)
4)构建边界约束条件:
0<dt1<vmax/amax (21.1)
0<dt2<vmax/amax (21.2)
0<dt3<vmax/amax (21.3)
0<dt4<vmax/amax (21.4)
构建不等式约束条件:
|θeq|≤θmin (22)
其中θmin是设定的最大摆角上限;θeq是最后轨迹停止时刻的等效摆角,所述的等效摆角是指吊具摆动的最大摆角,由于有时存在角速度,采用能量守恒方法推导出角速度为0时的摆角值,称为等效摆角。具体换算表达式如下:
其中,θf是最后轨迹停止时刻的吊具摆角值,是最后轨迹停止时刻吊具摆角速度值。所述θf和通过在系统输入向量已知的情况下,采用数值法求解所述的桥式起重机运动学模型(微分方程)。所述的系统输入向量是根据规划的小车速度规划函数和绳索速度规划函数i(t)通过所述的PID速度环控制器实时求解获得。可以看到该优化问题是一个带非线性约束的最优化问题。求解该优化问题可以在maltab工具箱中采用对应的求解器即可。
结合实际数据对上述方法进行防摇效果验证:
验证方案:我们取小车最大速度值为4.0m/s,小车最大加速度值为0.7m/s2,轨迹规划总距离s为40m,设定的最大摆角上限为0.01rad,在已辨识完成桥式起重机等效物理绳长和吊具摆动时的阻尼系数B,并且已知桥式起重机绳长速度规划函数。实际中我们令起重机从0初始摆角启动,小车运行40m,绳长从18m下放到25m。图5为通过优化求解器求得的最优小车速度轨迹曲线。图6为摆角曲线。可以看到,吊具摆角被很好的抑制。
尽管已经示出和描述了本发明的实施例,对于本领域的普通技术人员而言,可以理解在不脱离本发明的原理和精神的情况下可以对这些实施例进行多种变化、修改、替换和变型,本发明的范围由所附权利要求及其等同物限定。
Claims (3)
1.一种基于轨迹规划的桥式起重机吊具防摇方法,其特征在于,包括以下步骤:
步骤一、建立桥式起重机近似线性化的运动学模型;所述桥式起重机运动学模型可以表达成如下状态空间形式:
式中,状态向量为:
式中,系统输入向量为:
步骤二、离散化采样;在实机环境下取n个观测绳长离散化采样点{l1,l2,...,ln},辨识系统对应不同观测绳长时的固有频率{ω1,ω2,...,ωn}和阻尼比{ζ1,ζ2,...,ζn},所述的观测绳长是指通过传感器获得的绳长值;
步骤三、构建插值多项式;根据n个观测绳长采样点和其对应的实际固有频率{ω1,ω2,...,ωn}和阻尼比{ζ1,ζ2,...,ζn},构建n个拉格朗日插值多项式Li(lm):
式中,lm表示观测绳长值;
构建绳长-固有频率拉格朗日插值函数ω(lm)和绳长-阻尼比的拉格朗日插值函数ζ(lm):
步骤四、根据绳长-固有频率插值函数ω(lm)和绳长-阻尼比插值函数ζ(lm)得到(1)式中的等效物理绳长l和吊具摆动时的阻尼系数B:
定义第一段加速时长为dt1,第二段加速时长为dt2,第三段减速时长为dt3,第四段减速时长为dt4,定义轨迹规划总距离为s,分别得到小车速度规划函数每个分段速度对应的距离值{s1,s2,s3,s4,s5,s6,s7},如下式所示:
根据系统加速度饱和上限值amax,系统速度饱和上限值vmax,第四段速度区间对应距离值s4以及待优化求解变量{dt1,dt2,dt3,dt4},可以得到分段函数的时间区间{t1,t2,t3,t4,t5,t6,t7},具体表达式如下:
步骤七:构建优化问题,求解四段关键加减速时长{dt1,dt2,dt3,dt4};具体包括以下步骤:
1)构建优化变量即四段关键加减速时长:
τ=[τ1,τ2,τ3,τ4]=[dt1,dt2,dt3,dt4] (14)
2)构建优化目标函数:
fmin=τ2+τ3 (15)
3)构建边界约束条件:
4)构建不等式约束条件:
|θeq|≤θmin (17)
其中θmin是设定的最大摆角上限;θeq是最后轨迹停止时刻的等效摆角,所述的等效摆角是指吊具摆动的最大摆角,由于有时存在角速度,采用能量守恒方法推导出角速度为0时的摆角值,称为等效摆角。具体换算表达式如下:
2.根据权利要求1所述的一种基于轨迹规划的桥式起重机吊具防摇方法,其特征在于,所述步骤七中的优化问题通过maltab工具箱中采用对应的求解器进行求解。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210592475.9A CN114955856A (zh) | 2022-05-27 | 2022-05-27 | 一种基于轨迹规划的桥式起重机吊具防摇方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210592475.9A CN114955856A (zh) | 2022-05-27 | 2022-05-27 | 一种基于轨迹规划的桥式起重机吊具防摇方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114955856A true CN114955856A (zh) | 2022-08-30 |
Family
ID=82957145
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210592475.9A Pending CN114955856A (zh) | 2022-05-27 | 2022-05-27 | 一种基于轨迹规划的桥式起重机吊具防摇方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114955856A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115402933A (zh) * | 2022-11-01 | 2022-11-29 | 河南豫中起重集团有限公司 | 基于工业大数据及工业物联网的防摇起重机 |
-
2022
- 2022-05-27 CN CN202210592475.9A patent/CN114955856A/zh active Pending
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115402933A (zh) * | 2022-11-01 | 2022-11-29 | 河南豫中起重集团有限公司 | 基于工业大数据及工业物联网的防摇起重机 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106959610B (zh) | 桥式吊车系统apd-smc控制器、桥式吊车系统及控制方法 | |
CN106115484B (zh) | 用于人工操作的桥式起重机吊钩防摇控制方法及系统 | |
CN105152020B (zh) | 带有跟踪误差约束的桥式吊车自适应跟踪控制器及方法 | |
CN106315414B (zh) | 基于滑模面的桥式吊车控制方法 | |
CN108358062B (zh) | 欠驱动桥式吊车全局稳定控制方法 | |
CN105858481B (zh) | 基于相平面分析的桥式起重机精准定位在线轨迹规划方法 | |
CN108557664A (zh) | 桥式吊车系统增强耦合非线性pd型滑模控制器及方法 | |
CN105152016B (zh) | 带有初始输入约束的桥式吊车能量耦合控制器及控制方法 | |
CN109911773B (zh) | 一种单参数调整的欠驱动吊车作业全过程自抗扰控制方法 | |
CN110980521A (zh) | 一种基于系统无源性的欠驱动桥式吊车抗干扰防摆方法 | |
CN110407094B (zh) | 一种基于动态平滑轨迹的桥式起重机定位防摆控制方法 | |
CN114955856A (zh) | 一种基于轨迹规划的桥式起重机吊具防摇方法 | |
CN110989603A (zh) | 一种起重机搬运作业路径规划方法 | |
Ouyang et al. | Enhanced-coupling nonlinear controller design for load swing suppression in three-dimensional overhead cranes with double-pendulum effect | |
CN110407095A (zh) | 一种基于在线轨迹规划的桥式起重机定位消摆控制方法 | |
Li et al. | Time-polynomial-based optimal trajectory planning for double-pendulum tower crane with full-state constraints and obstacle avoidance | |
CN108673502A (zh) | 一种基于未知模型动态观测器的机械臂运动控制方法 | |
Zhu et al. | Neural network-based time optimal trajectory planning method for rotary cranes with obstacle avoidance | |
CN110673471A (zh) | 用于吊车系统的自适应控制器的设计方法、控制器及系统 | |
Li et al. | Kinematic coupling‐based trajectory planning for rotary crane system with double‐pendulum effects and output constraints | |
CN117466145A (zh) | 基于深度强化学习的桥门式起重机防摇控制方法及装置 | |
Ouyang et al. | An LMI‐based simple robust control for load sway rejection of rotary cranes with double‐pendulum effect | |
CN117389134A (zh) | 一种汽车场地测试移动平台pid参数标定方法及装置 | |
CN107290960A (zh) | 一种大型智能割草机器人的复合智能控制系统 | |
He et al. | Pseudospectral method based time optimal trajectory planning for double pendulum cranes |
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 |