基于GNSS差分定位的轮胎吊纠偏控制方法、装置及可读介质制造方法及图纸

本发明专利技术公开了一种基于GNSS差分定位的轮胎吊纠偏控制方法、装置及可读介质，通过轮胎吊顶部的GNSS信号接收天线实时采集GNSS信号；根据车道线轨迹地图和GNSS信号获取轮胎吊的当前的车轮偏移距离和当前的偏移角度；响应于确定当前的车轮偏移距离的绝对值或者当前的偏移角度的绝对值大于零，设定第一纠偏量并开启控制周期，获取轮胎吊以第一纠偏量行驶的过程中车轮偏移距离的变化量以及偏移角度的变化量；根据偏移角度的变化量的平均值计算轮胎吊以第一纠偏量行驶的过程中从当前的偏移角度移动至0

【技术实现步骤摘要】
基于GNSS差分定位的轮胎吊纠偏控制方法、装置及可读介质


[0001]本专利技术涉及纠偏控制领域，具体涉及一种基于GNSS差分定位的轮胎吊纠偏控制方法、装置及可读介质。

技术介绍

[0002]轮胎吊是集装箱码头堆场重要的集装箱装卸设备，其行走时，可能出现RTG偏离车道中心线的情况，需要纠正行驶轨迹回归车道中心位置，这个过程被称为“纠偏”。当前RTG纠偏主要依靠轮胎吊司机人工操作，司机需时刻紧盯RTG在车道中的位置，当出现RTG偏离中心车道时手动打手柄进行纠偏，由此劳动强度较大，工作效率较低，且一旦出现误判或操作不当，极易造成撞箱或撞滑触线等安全事故。随着人工智能和自动化技术的发展，轮胎吊自动纠偏已成为趋势。
[0003]现有的轮胎吊自动纠偏技术方案如下：
[0004](1)地面划线和图像识别纠偏法，该方案在轮胎吊运行路线上划定标准线，用摄像机等摄像设备摄入图像，然后将识别后的图像作为纠偏依据。但是在雨雪天气时无法正常工作，线道缺损对识别影响干扰大。
[0005](2)地面埋设检测体纠偏法，该方案在地面埋设金属等检测体，通过磁感应等方式来感应检测体。但是检测体埋入的工程量较大，且受地面物体的干扰较大。
[0006](3)红外线或光电测距纠偏法，该方案对反射体的要求较高，需要很强的反射光才能工作，且受外部光线等干扰严重，难以正确反映设备的实际位置。

技术实现思路

[0007]针对上述提到的技术问题。本申请的实施例的目的在于提出了一种基于GNSS差分定位的轮胎吊纠偏控制方法、装置及可读介质，来解决以上
技术介绍
部分提到的技术问题，可用于轮胎吊在集装箱堆场作业时实现自动车道保持，有效降低司机劳动强度，提高作业效率和设备运行安全性，为智能化码头远程控制轮胎吊提供技术支撑。
[0008]第一方面，本专利技术提供了一种基于GNSS差分定位的轮胎吊纠偏控制方法，包括以下步骤：
[0009]S1，获取堆场的车道线轨迹地图，通过轮胎吊顶部的GNSS信号接收天线实时采集GNSS信号；
[0010]S2，根据车道线轨迹地图和GNSS信号获取轮胎吊的当前的车轮偏移距离和当前的偏移角度，车轮偏移距离为前轮的中点位置与对应车道中心线之间的距离，偏移角度为车轮中心线与车道中心线之间的夹角；
[0011]S3，响应于确定当前的车轮偏移距离的绝对值或者当前的偏移角度的绝对值大于零，设定第一纠偏量并开启控制周期，第一纠偏量为轮胎吊靠近海侧和陆侧两边的驱动器的速度之差，并且方向与车轮偏移距离的方向相反，获取轮胎吊以第一纠偏量行驶的过程中车轮偏移距离的变化量以及偏移角度的变化量，并计算车轮偏移距离的变化量的平均值
以及偏移角度的变化量的平均值；
[0012]S4，根据偏移角度的变化量的平均值计算轮胎吊以第一纠偏量行驶的过程中从当前的偏移角度移动至0
°
时所需要的时间，并计算在从当前的偏移角度移动至0
°
时所需要的时间内轮胎吊以第一纠偏量行驶的过程中的车轮偏移距离的预测值，根据预测值确定轮胎吊是否在经过从当前的偏移角度移动至0
°
时所需要的时间之后以第二纠偏量行驶，第二纠偏量与第一纠偏量大小相同、方向相反；
[0013]S5，重复步骤S2
‑
S4，直至当前的车轮偏移距离和当前的偏移角度均为0。
[0014]作为优选，步骤S2中根据车道线轨迹地图和GNSS信号获取轮胎吊的当前的车轮偏移距离和当前的偏移角度，具体包括：
[0015]根据GNSS信号以及车道线轨迹地图确定GNSS信号接收天线的投影点与轨迹中心线的距离L1，并标定出车轮的中心点与轨迹中心线的距离L2，计算出误差E：
[0016]E＝L2‑
L1；
[0017]根据标定出的误差E以及实时采集到的GNSS信号以及车道线轨迹地图确定GNSS信号接收天线的投影点与轨迹中心线的距离L1计算出当前的车轮偏移距离S：
[0018]S＝L1+E。
[0019]作为优选，步骤S4中根据偏移角度的变化量的平均值计算轮胎吊以第一纠偏量行驶的过程中从当前的偏移角度移动至0
°
时所需要的时间，并计算在从当前的偏移角度移动至0
°
时所需要的时间内轮胎吊以第一纠偏量行驶的过程中的车轮偏移距离的预测值，具体包括：
[0020]设第一纠偏量的值为常量R，根据下式计算轮胎吊以第一纠偏量行驶的过程中从当前的偏移角度移动至0
°
时所需要的时间T：
[0021][0022]其中，为偏移角度的变化量的平均值，θ为当前的偏移角度；
[0023]在从当前的偏移角度移动至0
°
时所需要的时间内轮胎吊以第一纠偏量行驶的过程中的车轮偏移距离的预测值S
p
为：
[0024][0025]V
横
＝V
瞬
*sinθ；
[0026]其中，V
横
为轮胎吊的横向速度，V
瞬
为轮胎吊的瞬时速度，θ为偏移角度，为车轮偏移距离的变化量的平均值。
[0027]作为优选，步骤S4中根据预测值确定轮胎吊是否在经过从当前的偏移角度移动至0
°
时所需要的时间之后以第二纠偏量行驶，具体包括：
[0028]响应于确定在从当前的偏移角度移动至0
°
时所需要的时间内轮胎吊以第一纠偏量行驶的过程中的车轮偏移距离的预测值大于或等于当前的车轮偏移距离，则轮胎吊以第二纠偏量行驶；
[0029]响应于确定在从当前的偏移角度移动至0
°
时所需要的时间内轮胎吊以纠偏量行驶的过程中的车轮偏移距离的预测值小于当前的车轮偏移距离，则轮胎吊继续以第一纠偏量行驶。
[0030]作为优选，当轮胎吊在前进过程中车轮朝向陆侧偏移时，车轮偏移距离为正，偏移角度为正；当轮胎吊在前进过程中车轮朝向海侧偏移时，车轮偏移距离为负，偏移角度为负。
[0031]作为优选，步骤S4和步骤S5之间还包括：
[0032]响应于确定轮胎吊以第一纠偏量或第二纠偏量继续行驶过程中当前的车轮偏移距离和当前的偏移角度中任意一个的方向变为相反的方向，则进入步骤S5。
[0033]作为优选，步骤S4和步骤S5之间还包括：
[0034]响应于确定轮胎吊以第一纠偏量或第二纠偏量继续行驶过程中当前的车轮偏移距离和当前的偏移角度其中一个为0，则进入步骤S5。
[0035]第一方面，本专利技术提供了一种基于GNSS差分定位的轮胎吊纠偏控制装置，包括：
[0036]信号获取模块，被配置为获取堆场的车道线轨迹地图，通过轮胎吊顶部的GNSS信号接收天线实时采集GNSS信号；
[0037]偏移计算模块，被配置为根据车道线轨迹地图和GNSS信号获取轮胎吊的当前的车轮偏移距离和当前的偏移角度，车轮偏移距离为前轮的中点位置与对应车道中心线之间的距离，偏移角度本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于GNSS差分定位的轮胎吊纠偏控制方法，其特征在于，包括以下步骤：S1，获取堆场的车道线轨迹地图，通过轮胎吊顶部的GNSS信号接收天线实时采集GNSS信号；S2，根据所述车道线轨迹地图和所述GNSS信号获取轮胎吊的当前的车轮偏移距离和当前的偏移角度，所述车轮偏移距离为前轮的中点位置与对应车道中心线之间的距离，所述偏移角度为车轮中心线与车道中心线之间的夹角；S3，响应于确定所述当前的车轮偏移距离的绝对值或者当前的偏移角度的绝对值大于零，设定第一纠偏量并开启控制周期，所述第一纠偏量为所述轮胎吊靠近海侧和陆侧两边的驱动器的速度之差，并且方向与所述车轮偏移距离的方向相反，获取所述轮胎吊以所述第一纠偏量行驶的过程中所述车轮偏移距离的变化量以及偏移角度的变化量，并计算所述车轮偏移距离的变化量的平均值以及偏移角度的变化量的平均值；S4，根据所述偏移角度的变化量的平均值计算所述轮胎吊以所述第一纠偏量行驶的过程中从当前的偏移角度移动至0
°
时所需要的时间，并计算在从当前的偏移角度移动至0
°
时所需要的时间内所述轮胎吊以所述第一纠偏量行驶的过程中的车轮偏移距离的预测值，根据所述预测值确定所述轮胎吊是否在经过从当前的偏移角度移动至0
°
时所需要的时间之后以第二纠偏量行驶，所述第二纠偏量与所述第一纠偏量大小相同、方向相反；S5，重复步骤S2
‑
S4，直至当前的车轮偏移距离和当前的偏移角度均为0。2.根据权利要求1所述的基于GNSS差分定位的轮胎吊纠偏控制方法，其特征在于，所述步骤S2中根据所述车道线轨迹地图和所述GNSS信号获取轮胎吊的当前的车轮偏移距离和当前的偏移角度，具体包括：根据所述GNSS信号以及车道线轨迹地图确定所述GNSS信号接收天线的投影点与轨迹中心线的距离L1，并标定出车轮的中心点与轨迹中心线的距离L2，计算出误差E：E＝L2‑
L1；根据标定出的误差E以及实时采集到的GNSS信号以及所述车道线轨迹地图确定所述GNSS信号接收天线的投影点与轨迹中心线的距离L1计算出当前的车轮偏移距离S：S＝L1+E。3.根据权利要求1所述的基于GNSS差分定位的轮胎吊纠偏控制方法，其特征在于，所述步骤S4中根据所述偏移角度的变化量的平均值计算所述轮胎吊以所述第一纠偏量行驶的过程中从当前的偏移角度移动至0
°
时所需要的时间，并计算在从当前的偏移角度移动至0
°
时所需要的时间内所述轮胎吊以所述第一纠偏量行驶的过程中的车轮偏移距离的预测值，具体包括：设所述第一纠偏量的值为常量R，根据下式计算所述轮胎吊以所述第一纠偏量行驶的过程中从当前的偏移角度移动至0
°
时所需要的时间T：其中，为所述偏移角度的变化量的平均值，θ为当前的偏移角度；在从当前的偏移角度移动至0
°
时所需要的时间内所述轮胎吊以所述第一纠偏量行驶的过程中的车轮偏移距离的预测值S
p
为：
V
横
＝V
瞬
*sinθ；其中，V
横
为轮胎吊的横向速度，V
瞬
为轮胎吊的瞬时速度，θ为偏移角度，为所述车轮偏移距离的变化量的平均值。4.根据权利要求1所述的基于GNSS差分定位的轮胎吊纠偏控制方法，其特征在于，所述步骤S4中根据所述预测值确定所述轮胎吊是否...

【专利技术属性】
技术研发人员：胡雨，张强，刘键涛，魏秋新，
申请(专利权)人：福建电子口岸股份有限公司，
类型：发明
国别省市：