CN111025900A - 一种基于视觉导引的轮胎吊自动纠偏控制模型确定方法 - Google Patents
一种基于视觉导引的轮胎吊自动纠偏控制模型确定方法 Download PDFInfo
- Publication number
- CN111025900A CN111025900A CN201911204269.0A CN201911204269A CN111025900A CN 111025900 A CN111025900 A CN 111025900A CN 201911204269 A CN201911204269 A CN 201911204269A CN 111025900 A CN111025900 A CN 111025900A
- Authority
- CN
- China
- Prior art keywords
- deviation
- time
- crane
- differential
- acceleration
- 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
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
-
- 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)
- 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)
- Automation & Control Theory (AREA)
- Control And Safety Of Cranes (AREA)
Abstract
本发明涉及一种基于视觉导引的轮胎吊自动纠偏控制模型确定方法,通过下述方式实现:根据给定的轮胎吊的位置偏差确定轮胎吊自动纠偏策略;所述的策略采用差速控制方法改变位置偏差,即先加速单侧轮组,再反向加速另侧轮组使退出差速纠偏的时刻的位置偏差和角度偏差为0;根据轮胎吊行驶时纵向动力学数学模型,推导出轮胎吊差速控制期间加速度及转向角速度;根据上述差速控制期间加速度及转向角速度结合给定的位置偏差、角度偏差,推导出轮胎吊差速控制期间轮胎吊运动轨迹的解析表达式;并根据所述的运动轨迹的解析表达式,推导出轮胎吊差速控制期间轮胎吊差速纠偏最大位置偏差表达式。
Description
技术领域
本发明提供一种基于视觉导引的轮胎吊自动纠偏控制模型设计,该发明利用机器视觉技术获取轮胎吊与路径标识线的相对偏差,并以解析方法直接得到轮胎吊运动轨迹,由于考虑了差速控制加速度的影响,可以准确给出速度最优控制量来控制轮胎吊行进。
背景技术
港口作业中,需要经常使用轮胎吊来实现集装箱在不同堆场间的转运。目前,国内外各港口主要通过在不同堆场间标示轮胎吊行进线,轮胎吊行驶过程中,司机通过目测轮胎吊与行进线的位置偏差进行手动纠偏处理。由于港口作业区中轮胎吊行进区域紧邻堆场区域且轮胎吊行进允许偏差区域很小,因此,在轮胎吊行驶过程中,司机劳动强度极大也极易疲劳,稍有疏忽,就可能使轮胎吊与堆场区域中的集装箱发生碰触,从而产生堆场坍塌或者轮胎吊损坏事故。所以急需一种轮胎吊行进自动纠偏系统来实现轮胎吊的行进自动控制,而自动纠偏控制模型设计则是自动纠偏系统的关键环节。目前常用的纠偏控制方法有PID控制最优控制、模糊控制等,由于这些方法均没有给出轮胎吊运动的解析表达,也没有考虑差速控制时加速度的影响,因此,这些方法在解决轮胎吊的路径规划问题时都不可避免的存在控制参数整定困难的问题。
发明内容
本发明解决的技术问题是:克服现有技术的不足,提供了一种基于视觉导引的轮胎吊自动纠偏控制模型设计方法。
本发明解决技术的方案是:一种基于视觉导引的轮胎吊自动纠偏控制模型确定方法,通过下述方式实现:
根据给定的轮胎吊的位置偏差确定轮胎吊自动纠偏策略;所述的策略采用差速控制方法改变位置偏差,即先加速单侧轮组,再反向加速另侧轮组使退出差速纠偏的时刻的位置偏差和角度偏差为0;
根据轮胎吊行驶时纵向动力学数学模型,推导出轮胎吊差速控制期间加速度及转向角速度;
根据上述差速控制期间加速度及转向角速度结合给定的位置偏差、角度偏差,推导出轮胎吊差速控制期间轮胎吊运动轨迹的解析表达式;并根据所述的运动轨迹的解析表达式,推导出轮胎吊差速控制期间轮胎吊差速纠偏最大位置偏差表达式。
优选的,所述的轮胎吊自动纠偏策略具体为:
当位置偏差Δd>0时,先左侧轮组加速,加速时长T1;右侧轮组速度不变,利用正差速纠偏,直到位置偏差满足预设条件,该阶段时长T2;左右侧轮组差速为零;再右侧轮组加速,结束时刻记t1,左侧轮组速度不变,利用负差速纠偏,使位置偏差和角度偏差同时满足要求;
当位置偏差Δd<0时,先右侧轮组加速,加速时长T1;左侧轮组速度不变,利用正差速纠偏,直到位置偏差满足预设条件,该阶段时长T2;左右侧轮组差速为零;再左侧轮组加速,结束时刻记t1,右侧轮组速度不变,利用负差速纠偏,使位置偏差和角度偏差同时满足要求。
优选的,正差速为Δv=(0.05~0.5)V0,V0为加速轮组未纠偏前的速度;
负差速Δv(t1)根据负差速开始加速时刻t0的位置偏差Δd(t0)和角度偏差Δα(t0)计算,计算公式如下:
L为轮胎吊左右轮组之间的间距;
Δd(t1)、Δα(t1)为负差速由0变为Δv”(t1)时的位置偏差和角度偏差。
优选的,所述的轮胎吊差速控制期间轮胎吊运动轨迹的解析表达式如下:
其中,t0为时间起点,T′为时间终点;Δd(t0)为t0时刻轮胎吊位置偏差,Sy为t0+T′时刻轮胎吊位置偏差,Sx为t0至t0+T′期间轮胎吊在行进线方向行驶距离,Δα(t)为t时刻的角度偏差,w(t)为t时刻的转向角速度、V(t)为t时刻的轮胎吊的速度。
优选的,采用数值逼近的方法来求解加速T1期间解析表达式的近似解析解;将T1加速结束时刻记为t0,以t0为时间起点,通过积分确定t0+T2时刻所述解析表达式的解析解;利用两部分解析解确定轮胎吊差速控制期间轮胎吊差速纠偏最大位置偏差Symax表达式以及确定T2。
优选的,所述的近似解析解表达方式如下:
其中,T为采样周期,Δc(t0)为轮胎吊轮组在t0时刻前进方向的位置。
优选的,所述解析解的表达方式如下:
本发明与现有技术相比的有益效果是:
(1)本发明利用机器视觉技术实现轮胎吊的行进自动控制,提高了作业效率。
(2)本发明虑了差速控制加速度的影响、使用虚拟计算的方法准确计算反向差速控制值,可以准确给出速度最优控制量来控制轮胎吊行进。
(3)本发明利用机器视觉技术获取轮胎吊与路径标识线的相对偏差,并以解析方法直接得到轮胎吊运动轨迹,解决了轮胎吊的路径规划时存在的控制参数整定困难的问题。
附图说明
图1本发明纠偏策略流程图;
图2具体实施方式一自动纠偏仿真。
具体实施方式
下面结合实施例对本发明作进一步阐述。
一种基于视觉导引的轮胎吊自动纠偏控制模型确定方法,如图1所示,通过下述方式实现:
一、根据给定的轮胎吊的位置偏差确定轮胎吊自动纠偏策略;
定义:轮胎吊左右轮组速度分别为VL和VR,车体中心速度VL>VR则轮胎吊差速控制Δv为正;VL增加,轮胎吊加速度an为正,VL减小,加速度an为负;VR增加,加速度an为负,VR减小,加速度an为正。
(1)假定位置偏差Δd大于0,则该状态的处理步骤如下
A.先按照Δd的符号左侧轮组加速,加速时长T1;正差速为Δv=0.1V0
B.然后正差速纠偏,直到位置偏差满足一定条件,该阶段时长T2。
C.左侧轮组减速到差速为零
D.右侧轮组加速,加速结束时刻记t1;按照当时的位置偏差和角度偏差计算负差速
E.按照负差速纠偏,直到位置偏差或角度偏差满足一定条件
F.右侧轮组减速到差速为零
(2)假定Δd小于0,则该状态的处理步骤如下
A.先按照Δd的符号右侧轮组加速,加速时长T1;负差速为Δv=-0.1V0
B.然后负差速纠偏,直到位置偏差满足一定条件,该阶段时长T2。
C.右侧轮组减速到差速为零
D.左侧轮组加速,加速结束时刻记t1;按照当时的位置偏差和角度偏差计算正差速
E.按照正差速纠偏,直到位置偏差或角度偏差满足一定条件
F.左侧轮组减速到差速为零
二、根据轮胎吊行驶时纵向动力学数学模型,推导出轮胎吊差速控制期间加速度及转向角速度;根据上述差速控制期间加速度及转向角速度结合给定的位置偏差、角度偏差,推导出轮胎吊差速控制期间轮胎吊运动轨迹的解析表达式;并根据所述的运动轨迹的解析表达式,推导出轮胎吊差速控制期间轮胎吊差速纠偏最大位置偏差表达式。
位置偏差Δd大于0,按照上述处理步骤,先进行A操作,这期间首先需考虑差速控制时轮胎吊加速度变化情况。
差速控制前轮胎吊速度为V0,给出控制差速Δv后,不考虑道路坡度,轮胎吊行驶时纵向动力学数学模型如下
anJ=A(TeR-Tb-Ty)-BV2
a为轮胎吊加速度,m为轮胎吊整车质量(kg),Jwf、Jwr为轮胎吊前后轮转动惯量(kg.m2),re为车轮有效半径,Te为发动机输出扭矩(N.m),Rg为变速箱速比,Rf为主减速箱速比,Tb为制动力矩(N.m),Ty为轮胎吊运动时轮胎转动变形产生的滚动力矩(N.m),ρ为空气密度(kg/m3),Cd为空气阻力系数,AF为轮胎吊迎风面积(m2),V为车辆速度。
例如,给出控制差速Δv后,以t0为时间起点(此时轮胎吊速度为V0),在t0+T1时,左轮由VL变为VL'=V0+Δv、右轮VR在这期间不变,轮胎吊速度由V0变为以t0为时间起点,t0+T1轮胎吊左轮组加速期间,Te、R、Tb、Ty及空气阻力均不变,因此,轮胎吊左轮组加速期间为匀加速运动,Δv(t)匀速变化;同时转向角速度w(t)由0变为因此,在t0至t0+T1时间段,w(t)匀速变化。
另外,以t0至T′期间轮胎吊运动轨迹可表示为
式中,Δd(t0)为t0时刻轮胎吊位置偏差,Sy为T′时刻轮胎吊位置偏差,Sx为t0至T′期间轮胎吊在行进线方向行驶距离,t0为时间起点,T′为时间终点。
该式为超越积分,只能采用数值逼近的方法来求解近似解析解。
T为采样时间,该过程为左侧轮组加速过程,控制差速为Δv,加速时间的采样点数
式中,当前差速Δv(t0)=Δv(t0-T)+an×T,当前时刻轮胎吊速度V(t0)=V0+0.5×abs(Δv(t0)),当前时刻转向角速度下一采样时刻角度偏差Δα(t0+T)=Δα(t0)-w(t0)×T,t0-T为上个采样点时刻,t0为当前采样点时刻。
2)位置偏差Δd大于0,按照上述处理步骤,进行B操作
将上步操作结束时刻T1记为t0,以t0为时间起点,t0+T2时刻运动轨迹可表示为
Δd(t0)和Δα(t0)为轮胎吊t0时刻位置偏差和角度偏差,V(t0)为t0时刻轮胎吊速度,w(t0)为t0时刻转向角速度。
3)位置偏差Δd大于0,按照上述处理步骤,进行C操作
左侧轮组减速到差速为零,该过程与A操作相同,加速度an为负。
4)位置偏差Δd大于0,按照上述处理步骤,进行D操作
加速开始时刻为t0,加速结束时刻为t1。
右侧轮组加速,首先应给出右侧轮组加速应达到的负差速值。根据t0时刻的Δd(t0)、V(t0)、Δα(t0)计算右侧轮组加速应达到的负差速值,此时,由于第三步操作,左侧轮组减速到差速为零,此时V(t0)为V0。
差速及轮胎吊速度为
V”(t1)=V0+0.5×abs(Δv”(t1))
另外,由于右侧轮组由0加速到负差速值Δv”(t1)时,在t1时刻位置偏差Δd(t1)和角度偏差Δα(t1)与t0时刻位置偏差Δd(t0)和角度偏差Δα(t0)有较大差异,因此,使用A操作中记载的虚拟计算当负差速由0变为Δv”(t1)时的位置偏差Δd(t1)和角度偏差Δα(t1)。
计算最终实际右侧轮组加速应达到的负差速值
则,t1=t0+NT
使用A操作中记载的虚拟计算当负差速由0变为Δv(t1)时的轮胎吊轨迹。
5)位置偏差Δd大于0,按照上述处理步骤,进行E操作
按照负差速纠偏,直到位置偏差或角度偏差满足一定条件,该过程与B操作类似,当满足abs(位置偏差)<0.005或者abs(角度偏差)<0.0005时,退出负差速纠偏。
6)位置偏差Δd大于0,按照上述处理步骤,进行F操作
具体步骤参见操作C中描述。
当位置偏差Δd小于0时,按照上述介绍的策略步骤,替换相应的轮组即可,此处不进行过多说明。
图2为本发明仿真结果,仿真条件:初始位置偏差0.12m,角度测量误差2度,位置角度测量误差0.05m;横轴为采样点数、纵轴为数值,三条线分别为位置偏差、角度偏差、差速,从图中可以看出本发明纠偏取得了非常好的效果。
本发明未详细说明部分属于本领域技术人员的公知常识。
Claims (10)
1.一种基于视觉导引的轮胎吊自动纠偏控制模型确定方法,其特征在于通过下述方式实现:
根据给定的轮胎吊的位置偏差确定轮胎吊自动纠偏策略;所述的策略采用差速控制方法改变位置偏差,即先加速单侧轮组,再反向加速另侧轮组使退出差速纠偏的时刻的位置偏差和角度偏差为0;
根据轮胎吊行驶时纵向动力学数学模型,推导出轮胎吊差速控制期间加速度及转向角速度;
根据上述差速控制期间加速度及转向角速度结合给定的位置偏差、角度偏差,推导出轮胎吊差速控制期间轮胎吊运动轨迹的解析表达式;并根据所述的运动轨迹的解析表达式,推导出轮胎吊差速控制期间轮胎吊差速纠偏最大位置偏差表达式。
2.根据权利要求1所述的方法,其特征在于所述的轮胎吊自动纠偏策略具体为:
当位置偏差Δd>0时,先左侧轮组加速,加速时长T1;右侧轮组速度不变,利用正差速纠偏,直到位置偏差满足预设条件,该阶段时长T2;左右侧轮组差速为零;再右侧轮组加速,结束时刻记t1,左侧轮组速度不变,利用负差速纠偏,使位置偏差和角度偏差同时满足要求;
当位置偏差Δd<0时,先右侧轮组加速,加速时长T1;左侧轮组速度不变,利用正差速纠偏,直到位置偏差满足预设条件,该阶段时长T2;左右侧轮组差速为零;再左侧轮组加速,结束时刻记t1,右侧轮组速度不变,利用负差速纠偏,使位置偏差和角度偏差同时满足要求。
6.根据权利要求5所述的方法,其特征在于:
采用数值逼近的方法来求解加速T1期间解析表达式的近似解析解;
将T1加速结束时刻记为t0,以t0为时间起点,通过积分确定t0+T2时刻所述解析表达式的解析解;
利用两部分解析解确定轮胎吊差速控制期间轮胎吊差速纠偏最大位置偏差Symax表达式以及确定T2。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911204269.0A CN111025900B (zh) | 2019-11-29 | 2019-11-29 | 一种基于视觉导引的轮胎吊自动纠偏控制模型确定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911204269.0A CN111025900B (zh) | 2019-11-29 | 2019-11-29 | 一种基于视觉导引的轮胎吊自动纠偏控制模型确定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111025900A true CN111025900A (zh) | 2020-04-17 |
CN111025900B CN111025900B (zh) | 2022-08-12 |
Family
ID=70207366
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911204269.0A Active CN111025900B (zh) | 2019-11-29 | 2019-11-29 | 一种基于视觉导引的轮胎吊自动纠偏控制模型确定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111025900B (zh) |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002003155A (ja) * | 2000-06-21 | 2002-01-09 | Mitsui Eng & Shipbuild Co Ltd | タイヤ式クレーン |
CN1570796A (zh) * | 2004-05-14 | 2005-01-26 | 李俊 | 基于差分gps技术轮胎吊自动驾驶及箱位管理系统 |
CN201229497Y (zh) * | 2008-07-08 | 2009-04-29 | 高旭 | 基于图像处理的集装箱轮胎吊自动驾驶系统 |
CN106774339A (zh) * | 2017-01-18 | 2017-05-31 | 上海振华重工电气有限公司 | 基于图像处理的轮胎吊自动过街系统及方法 |
CN107943020A (zh) * | 2017-10-17 | 2018-04-20 | 上海辛格林纳新时达电机有限公司 | 一种轮胎吊大车自动纠偏方法 |
CN109993788A (zh) * | 2017-12-29 | 2019-07-09 | 西门子(中国)有限公司 | 一种轮胎吊的纠偏方法、装置及系统 |
CN110054089A (zh) * | 2019-04-29 | 2019-07-26 | 北京航天自动控制研究所 | 一种轮胎吊机器视觉自动纠偏系统及纠偏方法 |
-
2019
- 2019-11-29 CN CN201911204269.0A patent/CN111025900B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002003155A (ja) * | 2000-06-21 | 2002-01-09 | Mitsui Eng & Shipbuild Co Ltd | タイヤ式クレーン |
CN1570796A (zh) * | 2004-05-14 | 2005-01-26 | 李俊 | 基于差分gps技术轮胎吊自动驾驶及箱位管理系统 |
CN201229497Y (zh) * | 2008-07-08 | 2009-04-29 | 高旭 | 基于图像处理的集装箱轮胎吊自动驾驶系统 |
CN106774339A (zh) * | 2017-01-18 | 2017-05-31 | 上海振华重工电气有限公司 | 基于图像处理的轮胎吊自动过街系统及方法 |
CN107943020A (zh) * | 2017-10-17 | 2018-04-20 | 上海辛格林纳新时达电机有限公司 | 一种轮胎吊大车自动纠偏方法 |
CN109993788A (zh) * | 2017-12-29 | 2019-07-09 | 西门子(中国)有限公司 | 一种轮胎吊的纠偏方法、装置及系统 |
CN110054089A (zh) * | 2019-04-29 | 2019-07-26 | 北京航天自动控制研究所 | 一种轮胎吊机器视觉自动纠偏系统及纠偏方法 |
Non-Patent Citations (1)
Title |
---|
徐耀 等: ""基于单GPS的轮胎吊自动驾驶控制技术的研究"", 《计算机应用与软件》 * |
Also Published As
Publication number | Publication date |
---|---|
CN111025900B (zh) | 2022-08-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108437978B (zh) | 四轮毂电驱车辆行驶路面自动识别与稳定性集成控制方法 | |
CN109144076B (zh) | 一种多车辆横纵向耦合协同控制系统及控制方法 | |
CN103121447B (zh) | 一种弯道防侧滑侧翻自动控制系统及方法 | |
CN107963126B (zh) | 一种多轴转向车辆大曲率自动驾驶转向控制方法 | |
CN107792062B (zh) | 一种自动泊车控制系统 | |
CN111890951A (zh) | 智能电动汽车轨迹跟踪与运动控制方法 | |
CN107856737B (zh) | 一种基于危险程度变权重的人机协同转向控制方法 | |
CN110667402B (zh) | 四轮驱动电动汽车电子差速控制方法及系统 | |
CN109291932B (zh) | 基于反馈的电动汽车横摆稳定性实时控制装置及方法 | |
CN111610780A (zh) | 一种自动驾驶车路径跟踪控制方法及其装置 | |
CN109991974B (zh) | 自动驾驶路径跟随方法、装置及控制设备 | |
CN110040147B (zh) | 一种自动驾驶汽车侧向饱和约束下的行驶速度优化的方法 | |
CN108717268A (zh) | 基于最优控制与安全距离的自动驾驶最速操纵控制系统及其控制方法 | |
CN108819951A (zh) | 一种考虑驾驶员驾驶技能的人机共驾横向驾驶权分配方法 | |
CN107697065B (zh) | 一种面向一般停车场景的自动泊车控制方法 | |
CN108177692A (zh) | 一种电动轮驱动汽车差动助力转向与稳定性协调控制方法 | |
CN103057436A (zh) | 一种基于多智能体的独立驱动电动汽车横摆力矩控制方法 | |
CN105857304A (zh) | 基于四轮驱动汽车力矩分配控制系统 | |
CN108860149A (zh) | 一种用于智能车辆时间最短自由变道的运动轨迹设计方法 | |
CN106232438A (zh) | 车辆控制装置 | |
CN111930126A (zh) | 一种基于差速轮组agv的导航纠偏方法 | |
CN112124295A (zh) | 无人驾驶车辆及其终点横向稳态控制方法、电子设备 | |
CN111025900B (zh) | 一种基于视觉导引的轮胎吊自动纠偏控制模型确定方法 | |
CN113335376B (zh) | 分布式独立驱动电动汽车转向时轮间差速防拖拽控制方法 | |
CN112744293A (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 |