CN112148018B - 一种对位控制方法、装置和自动驾驶集装箱卡车 - Google Patents
一种对位控制方法、装置和自动驾驶集装箱卡车 Download PDFInfo
- Publication number
- CN112148018B CN112148018B CN202011064528.7A CN202011064528A CN112148018B CN 112148018 B CN112148018 B CN 112148018B CN 202011064528 A CN202011064528 A CN 202011064528A CN 112148018 B CN112148018 B CN 112148018B
- Authority
- CN
- China
- Prior art keywords
- distance
- automatic driving
- container truck
- target
- crane
- 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
- 238000000034 method Methods 0.000 title claims abstract description 42
- 235000015170 shellfish Nutrition 0.000 claims abstract description 12
- 238000004364 calculation method Methods 0.000 claims description 11
- 230000003068 static effect Effects 0.000 claims description 6
- 238000010586 diagram Methods 0.000 description 11
- 238000004891 communication Methods 0.000 description 7
- 238000004590 computer program Methods 0.000 description 7
- 230000008569 process Effects 0.000 description 7
- 230000006870 function Effects 0.000 description 4
- 238000012545 processing Methods 0.000 description 4
- 230000009471 action Effects 0.000 description 3
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000004075 alteration Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 238000000605 extraction Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000000750 progressive effect Effects 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
-
- 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
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
- G05D1/0278—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using satellite positioning signals, e.g. GPS
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Aviation & Aerospace Engineering (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Mechanical Engineering (AREA)
- Control And Safety Of Cranes (AREA)
Abstract
本申请公开了一种对位控制方法、装置和自动驾驶集装箱卡车，该方法和装置具体为控制自动驾驶集装箱卡车行驶至目标贝位；根据目标起重机的状态计算剩余距离；根据剩余距离控制自动驾驶集装箱卡车制动；向目标起重机发送装卸作业指令，以使目标起重机从自动驾驶集装箱起吊集装箱，或者使目标起重机向自动驾驶集装箱卡车装载集装箱。通过本技术方案，可以使自动驾驶集装箱卡车与龙门起重机实现对正，从而为集装箱装卸创造了必要条件。
Description
技术领域
本申请涉及车辆技术领域，更具体地说，涉及一种对位控制方法、装置和自动驾驶集装箱卡车。
背景技术
自动驾驶集装箱卡车是在集装箱卡车的基础上装配激光雷达、相机、毫米波雷达等传感器用于感知周围环境，利用GNSS-RTK、INS等传感器获取位置信息，并通过控制系统控制发动机、变速箱、制动器、转向器等执行机构实现自主驾驶来完成集装箱转运任务的载重车辆。
自动驾驶集装箱卡车的转运任务的起点或终点通常是集装箱集疏区域的集装箱龙门起重机，而其只能在与龙门起重机对正后才能成功进行集装箱的装卸。
发明内容
有鉴于此，本申请提供一种对位控制方法、装置和自动驾驶集装箱卡车，用于控制自动驾驶集装箱卡车与龙门起重机对正，以便为集装箱装卸创造必要条件。
为了实现上述目的，现提出的方案如下：
一种对位控制方法，应用于自动驾驶集装箱卡车，所述对位控制方法包括步骤：
控制所述自动驾驶集装箱卡车行驶至目标贝位；
根据目标起重机的状态获取剩余距离；
根据所述剩余距离控制所述自动驾驶集装箱卡车制动；
向所述目标起重机发送装卸作业指令，以使所述目标起重机从所述自动驾驶集装箱起吊集装箱，或者使所述目标起重机向所述自动驾驶集装箱卡车装载集装箱。
可选的，所述根据目标起重机的状态获取剩余距离，包括步骤：
如果所述目标起重机已经停到位，获取超带宽定位系统计算的所述剩余距离；
如果所述目标起重机没有停到位，获取载波相位差分系统计算的所述剩余距离。
可选的，在控制所述自动驾驶集装箱卡车行驶至目标贝位步骤之前，还包括步骤：
计算所述自动驾驶集装箱卡车精准停车后与所述目标起重机相对位置所容许的最大误差。
可选的，在所述向所述目标起重机发送装卸作业指令步骤之前，还包括步骤：
当所述自动驾驶集装箱卡车停车后，如果当前剩余距离大于第一长度，则控制所述自动驾驶集装箱卡车进行微调操作；
当所述当前剩余距离小于第二长度时，控制所述自动驾驶集装箱卡车停止微调，所述第二长度小于所述第一长度。
一种对位控制装置，应用于自动驾驶集装箱卡车，所述对位控制装置包括：
第一控制模块，被配置为控制所述自动驾驶集装箱卡车行驶至目标贝位；
距离获取模块，被配置为根据目标起重机的状态获取剩余距离；
第二控制模块，被配置为根据所述剩余距离控制所述自动驾驶集装箱卡车制动；
指令发送模块，被配置为向所述目标起重机发送装卸作业指令，以使所述目标起重机从所述自动驾驶集装箱起吊集装箱，或者使所述目标起重机向所述自动驾驶集装箱卡车装载集装箱。
可选的，所述距离计算模块包括：
第一获取单元，用于如果所述目标起重机已经停到位，获取超带宽定位系统计算的剩余距离；
第二获取单元，用于如果所述目标起重机没有停到位，获取载波相位差分系统计算的剩余距离。
可选的，还包括：
误差计算模块，被配置为在所述第一控制模块控制所述自动驾驶集装箱卡车行驶至目标贝位之前，计算所述自动驾驶集装箱卡车精准停车后与所述目标起重机相对位置所容许的最大误差。
可选的，还包括：
微调控制模块，被配置为在所述指令发送模块向所述目标起重机发送装卸作业指令之前，当所述自动驾驶集装箱卡车停车后，如果当前剩余距离大于第一长度，则控制所述自动驾驶集装箱卡车进行微调操作；并且，当所述当前剩余距离小于第二长度时，控制所述自动驾驶集装箱卡车停止微调，所述第二长度小于所述第一长度。
一种自动驾驶集装箱卡车，还包括如上所述的对位控制装置。
从上述的技术方案可以看出，本申请公开了一种对位控制方法、装置和自动驾驶集装箱卡车，该方法和装置具体为控制自动驾驶集装箱卡车行驶至目标贝位；根据目标起重机的状态计算剩余距离；根据剩余距离控制自动驾驶集装箱卡车制动；向目标起重机发送装卸作业指令，以使目标起重机从自动驾驶集装箱起吊集装箱，或者使目标起重机向自动驾驶集装箱卡车装载集装箱。通过本技术方案，可以使自动驾驶集装箱卡车与龙门起重机实现对正，从而为集装箱装卸创造了必要条件。
附图说明
为了更清楚地说明本申请实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本申请的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
图1为本申请实施例的一种对位控制方法的流程图；
图2为本申请实施例的起重机与自动驾驶集装箱卡车之间的对位示意图；
图3为自动驾驶集装箱卡车的自动驾驶系统的示意图；
图4为本申请实施例的另一种对位控制方法的流程图；
图5为本申请实施例的起重机的吊具锁钮与集装箱孔位的示意；
图6为本申请实施例的又一种对位控制方法的流程图；
图7为本申请实施例的一种对位控制装置的框图；
图8为本申请实施例的另一种对位控制装置的框图；
图9为本申请实施例的又一种对位控制装置的框图。
具体实施方式
下面将结合本申请实施例中的附图，对本申请实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本申请一部分实施例，而不是全部的实施例。基于本申请中的实施例，本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例，都属于本申请保护的范围。
实施例一
图1为本申请实施例的一种对位控制方法的流程图。
本实施例提供的对位控制方法应用于自动驾驶集装箱卡车，该自动驾驶集装箱卡车应用于港口、堆场等有集装箱装卸需求的场所，该自动驾驶集装箱卡车需要行驶至用于起吊集装箱的起重机处，在对位正确后起重机将集装箱从自动驾驶集装箱卡车上吊起或者将集装箱装载在自动驾驶集装箱卡车上。
如图2所示，龙门起重机100由龙门架101和吊具102组成，自动驾驶集装箱卡车200装卸箱的本质是起重机吊具的四个锁钮和集装箱四个孔位的对准，所以可基本等同于自动驾驶集装箱卡车的挂车与龙门架对位。所以本申请中在起重机上设置路端通信系统RSU103和超宽带定位系统UWB的场端设备104。RSU用于起重机与自动驾驶集装箱卡车通信发送当前起重机的工作状态。
如图3所示，自动驾驶集装箱卡车的自动驾驶系统由基于卫星定位的载波相位差分系统GNSS-RTK201、车载通信系统OBU0202、超宽带定位系统的UWB的标签设备203和主控制器204组成。
GNSS-RTK的接收机用于接收卫星定位信号并利用载波相位差分获取高精度绝对定位信息；OBU用于自动驾驶集装箱卡车与起重机RSU通信获取起重机状态；自动驾驶集装箱卡车的主控制器用于处理传感器数据、自动驾驶算法和停车控制逻辑。
因自动驾驶集装箱卡车挂车需对位起重机，所以将UWB的标签设备直接安装在自动驾驶集装箱卡车的挂车，其再通过有线或无线通信方式将数据发送给自动驾驶集装箱卡车的主控制器。
如图1所示，该对位控制方法具体包括如下步骤:
S101、控制自动驾驶集装箱卡车行驶至目标贝位。
即在自动驾驶集装箱卡车处于远离目标起重机的位置时候，控制该自动驾驶集装箱卡车行驶至堆场的目标贝位，这里的目标贝位是指该目标起重机所需的作业位置。由于此时该自动驾驶集装箱卡车并没有行驶至精确对位位置，所以此时并不对该自动驾驶集装箱卡车进行制动操作，但需根据GNSS-RTK给出的剩余距离dRTK逐渐降速。
S102、根据目标起重机的状态获取剩余距离。
当自动驾驶集装箱卡车距离最终的作业距离达到一定距离、如20米时根据该目标起重机的状态计算剩余距离。该剩余距离是指自动驾驶集装箱卡车当前位置距离该起重机的作业位置所处位置的距离，具体是指自动驾驶集装箱卡车上某一点距离起重机上某一点的距离。此时，自动驾驶集装箱卡车通过OBU与目标起重机上的RSU建立通信并获取起重机的到位状态，目标起重机的到位状态包括两种，一种是指已经到达该作业位置，另一种是指正在向作业位置行驶。
如果此时目标起重机已经停到位、即停靠在该作业位置时，因UWB的相对定位精度较高，所以自动驾驶集装箱卡车在目标起重机下获取根据UWB给出的剩余距离dUWB；当目标起重机未停到位时，自动驾驶集装箱卡车获取根据GNSS-RTK给出的剩余距离dRTK。
S103、根据剩余距离控制自动驾驶集装箱卡车制动。
在得到任意一种剩余距离dUWB或dRTK后，根据该剩余距离并基于本身的制动距离控制该自动驾驶集装箱卡车进行制动，以使其停靠于目标起重机作业所需的作业位置。
理想情况下，如果自动驾驶集装箱卡车的制动距离s始终不变，则标定dUWB＝dRTK即可提高对位的成功率。但自动驾驶集装箱卡车的制动距离s受地面与轮胎的摩擦系数，载重，制动器机械状态等多种因素影响。
S104、向目标起重机发送装卸作业指令
当自动驾驶集装箱卡车根据剩余距离以及自身的制动距离实现制动后，向其对正的目标起重机的控制系统发送装卸作业指令，该装卸作业指令用于使目标起重机开始装车或携程操作。
从上述技术方案可以看出，本实施例提供了一种对位控制方法，该方法应用于自动驾驶集装箱卡车，具体为控制自动驾驶集装箱卡车行驶至目标贝位；根据目标起重机的状态计算剩余距离；根据剩余距离控制自动驾驶集装箱卡车制动；向目标起重机发送装卸作业指令，以使目标起重机从自动驾驶集装箱起吊集装箱，或者使目标起重机向自动驾驶集装箱卡车装载集装箱。通过本技术方案，可以使自动驾驶集装箱卡车与龙门起重机实现对正，从而为集装箱装卸创造了必要条件。
实施例二
图4为本申请实施例的另一种对位控制方法的流程图。
如图4所示，该对位控制方法具体包括如下步骤:
S201、计算自动驾驶集装箱卡车与起重机之间允许的最大误差。
起重机的吊具锁钮1021与集装箱孔位300的示意如图5所示，在计算时，根据吊具、集装箱孔位和挂车锁钮规格计算自动驾驶集装箱卡车与起重机的对位精度要求，集装箱孔径和吊具的锁钮的尺寸共同决定自动驾驶集装箱卡车与起重机对位的精度要求。设集装箱孔径在y轴向的直径为a，吊具锁钮在y轴向的宽度为b，则对位容许的最大误差为：
α＝(a+b)/2。
S202、控制自动驾驶集装箱卡车行驶至目标贝位。
即在自动驾驶集装箱卡车处于远离目标起重机的位置时候，控制该自动驾驶集装箱卡车行驶至堆场的目标贝位，这里的目标贝位是指该目标起重机所需的作业位置。由于此时该自动驾驶集装箱卡车并没有行驶至精确对位位置，所以此时并不对该自动驾驶集装箱卡车进行制动操作，但需根据GNSS-RTK给出的剩余距离dRTK逐渐降速。
S203、根据目标起重机的状态获取剩余距离。
当自动驾驶集装箱卡车距离最终的作业距离达到一定距离、如20米时根据该目标起重机的状态计算剩余距离。该剩余距离是指自动驾驶集装箱卡车当前位置距离该起重机的作业位置所处位置的距离，具体是指自动驾驶集装箱卡车上某一点距离起重机上某一点的距离。此时，自动驾驶集装箱卡车通过OBU与目标起重机上的RSU建立通信并获取起重机的到位状态，目标起重机的到位状态包括两种，一种是指已经到达该作业位置，另一种是指正在向作业位置行驶。
如果此时目标起重机已经停到位、即停靠在该作业位置时，因UWB的相对定位精度较高，所以自动驾驶集装箱卡车在目标起重机下获取根据UWB给出的剩余距离dUWB；当目标起重机未停到位时，自动驾驶集装箱卡车获取根据GNSS-RTK给出的剩余距离dRTK。
S204、根据剩余距离控制自动驾驶集装箱卡车制动。
在得到任意一种剩余距离dUWB或dRTK后，根据该剩余距离并基于本身的制动距离控制该自动驾驶集装箱卡车进行制动，以使其停靠于目标起重机作业所需的作业位置。
理想情况下，如果自动驾驶集装箱卡车的制动距离s始终不变，则标定dUWB＝dRTK即可提高对位的成功率。但自动驾驶集装箱卡车的制动距离s受地面与轮胎的摩擦系数，载重，制动器机械状态等多种因素影响。
S205、向目标起重机发送装卸作业指令
当自动驾驶集装箱卡车根据剩余距离以及自身的制动距离实现制动后，向其对正的目标起重机的控制系统发送装卸作业指令，该装卸作业指令用于使目标起重机开始装车或携程操作。
从上述技术方案可以看出，本实施例提供了一种对位控制方法，该方法应用于自动驾驶集装箱卡车，具体为控制自动驾驶集装箱卡车行驶至目标贝位；根据目标起重机的状态计算剩余距离；根据剩余距离控制自动驾驶集装箱卡车制动；向目标起重机发送装卸作业指令，以使目标起重机从自动驾驶集装箱起吊集装箱，或者使目标起重机向自动驾驶集装箱卡车装载集装箱。通过本技术方案，可以使自动驾驶集装箱卡车与龙门起重机实现对正，从而为集装箱装卸创造了必要条件。且通过增加对最大误差的计算，可以免去提取计算的麻烦，提高了作业效率。
实施例三
图6为本申请实施例的另一种对位控制方法的流程图。
如图6所示，该对位控制方法具体包括如下步骤:
S301、控制自动驾驶集装箱卡车行驶至目标贝位。
即在自动驾驶集装箱卡车处于远离目标起重机的位置时候，控制该自动驾驶集装箱卡车行驶至堆场的目标贝位，这里的目标贝位是指该目标起重机所需的作业位置。由于此时该自动驾驶集装箱卡车并没有行驶至精确对位位置，所以此时并不对该自动驾驶集装箱卡车进行制动操作，但需根据GNSS-RTK给出的剩余距离dRTK逐渐降速。
S302、根据目标起重机的状态计算剩余距离。
当自动驾驶集装箱卡车距离最终的作业距离达到一定距离、如20米时根据该目标起重机的状态计算剩余距离。该剩余距离是指自动驾驶集装箱卡车当前位置距离该起重机的作业位置所处位置的距离，具体是指自动驾驶集装箱卡车上某一点距离起重机上某一点的距离。此时，自动驾驶集装箱卡车通过OBU与目标起重机上的RSU建立通信并获取起重机的到位状态，目标起重机的到位状态包括两种，一种是指已经到达该作业位置，另一种是指正在向作业位置行驶。
如果此时目标起重机已经停到位、即停靠在该作业位置时，因UWB的相对定位精度较高，所以自动驾驶集装箱卡车在目标起重机下获取根据UWB给出的剩余距离dUWB；当目标起重机未停到位时，自动驾驶集装箱卡车获取根据GNSS-RTK给出的剩余距离dRTK。
S303、根据剩余距离控制自动驾驶集装箱卡车制动。
在得到任意一种剩余距离dUWB或dRTK后，根据该剩余距离并基于本身的制动距离控制该自动驾驶集装箱卡车进行制动，以使其停靠于目标起重机作业所需的作业位置。
理想情况下，如果自动驾驶集装箱卡车的制动距离s始终不变，则标定dUWB＝dRTK即可提高对位的成功率。但自动驾驶集装箱卡车的制动距离s受地面与轮胎的摩擦系数，载重，制动器机械状态等多种因素影响。
S304、对自动驾驶集装箱卡车进行微调操作。
自动驾驶集装箱卡车停车后如果UWB给出的当前剩余距离大于±d、即第一距离，则控制动力系统和制动系统对自动驾驶集装箱卡车的位置进行微调操作，即对自动驾驶集装箱卡车的位置进行短距离调整；在微调过程中，当UWB给出的当前剩余距离小于±(α-β)、即第二距离时，控制自动驾驶集装箱卡车停止微调操作。
这里的α为对位容许的最大误差，β为UWB的静态精度。
S305、向目标起重机发送装卸作业指令
当自动驾驶集装箱卡车根据剩余距离以及自身的制动距离实现制动后，向其对正的目标起重机的控制系统发送装卸作业指令，该装卸作业指令用于使目标起重机开始装车或携程操作。
从上述技术方案可以看出，本实施例提供了一种对位控制方法，该方法应用于自动驾驶集装箱卡车，具体为控制自动驾驶集装箱卡车行驶至目标贝位；根据目标起重机的状态计算剩余距离；根据剩余距离控制自动驾驶集装箱卡车制动；向目标起重机发送装卸作业指令，以使目标起重机从自动驾驶集装箱起吊集装箱，或者使目标起重机向自动驾驶集装箱卡车装载集装箱。通过本技术方案，可以使自动驾驶集装箱卡车与龙门起重机实现对正，从而为集装箱装卸创造了必要条件。且通过对自动驾驶集装箱卡车的微调操作，可以使自动驾驶集装箱卡车对位更为准确。
实施例四
图7为本申请实施例的一种对位控制装置的框图。
本实施例提供的对位控制装置应用于自动驾驶集装箱卡车，具体可以看做自动驾驶集装箱卡车的自动驾驶系统的一个功能单元或者与自动驾驶系统相互独立的控制设备。
如图7所示，该对位控制装置具体包括第一控制模块10、距离获取模块20、第二控制模块30和指令发送模块40。
第一控制模块用于控制自动驾驶集装箱卡车行驶至目标贝位。
即在自动驾驶集装箱卡车处于远离目标起重机的位置时候，控制该自动驾驶集装箱卡车行驶至堆场的目标贝位，这里的目标贝位是指该目标起重机所需的作业位置。由于此时该自动驾驶集装箱卡车并没有行驶至精确对位位置，所以此时并不对该自动驾驶集装箱卡车进行制动操作，但需根据GNSS-RTK给出的剩余距离dRTK逐渐降速。
距离获取模块用于根据目标起重机的状态获取剩余距离。
当自动驾驶集装箱卡车距离最终的作业距离达到一定距离、如20米时根据该目标起重机的状态计算剩余距离。该剩余距离是指自动驾驶集装箱卡车当前位置距离该起重机的作业位置所处位置的距离，具体是指自动驾驶集装箱卡车上某一点距离起重机上某一点的距离。此时，自动驾驶集装箱卡车通过OBU与目标起重机上的RSU建立通信并获取起重机的到位状态，目标起重机的到位状态包括两种，一种是指已经到达该作业位置，另一种是指正在向作业位置行驶。基于此，该模块包括第一获取单元和第二获取单元。
第一获取单元用于如果此时目标起重机已经停到位、即停靠在该作业位置时，因UWB的相对定位精度较高，此时获取根据UWB给出的剩余距离dUWB；第二获取单元用于当目标起重机未停到位时，获取根据GNSS-RTK给出的剩余距离dRTK。
第二控制模块用于根据剩余距离控制自动驾驶集装箱卡车制动。
在得到任意一种剩余距离dUWB或dRTK后，根据该剩余距离并基于本身的制动距离控制该自动驾驶集装箱卡车进行制动，以使其停靠于目标起重机作业所需的作业位置。
理想情况下，如果自动驾驶集装箱卡车的制动距离s始终不变，则标定dUWB＝dRTK即可提高对位的成功率。但自动驾驶集装箱卡车的制动距离s受地面与轮胎的摩擦系数，载重，制动器机械状态等多种因素影响。
指令发送模块向目标起重机发送装卸作业指令
当自动驾驶集装箱卡车根据剩余距离以及自身的制动距离实现制动后，向其对正的目标起重机的控制系统发送装卸作业指令，该装卸作业指令用于使目标起重机开始装车或携程操作。
从上述技术方案可以看出，本实施例提供了一种对位控制装置，该装置应用于自动驾驶集装箱卡车，具体为控制自动驾驶集装箱卡车行驶至目标贝位；根据目标起重机的状态计算剩余距离；根据剩余距离控制自动驾驶集装箱卡车制动；向目标起重机发送装卸作业指令，以使目标起重机从自动驾驶集装箱起吊集装箱，或者使目标起重机向自动驾驶集装箱卡车装载集装箱。通过本技术方案，可以使自动驾驶集装箱卡车与龙门起重机实现对正，从而为集装箱装卸创造了必要条件。
在本申请的另一个具体实施方式中，还包括误差计算模块50，具体如图8所示。
误差计算模块用于在事前或当时计算自动驾驶集装箱卡车与起重机之间允许的最大误差。
起重机的吊具与集装箱孔位的示意如图5所示，在计算时，根据吊具、集装箱孔位和挂车锁钮规格计算自动驾驶集装箱卡车与起重机的对位精度要求，集装箱孔径和吊具的锁钮的尺寸共同决定自动驾驶集装箱卡车与起重机对位的精度要求。设集装箱孔径在y轴向的直径为a，吊具锁钮在y轴向的宽度为b，则对位容许的最大误差为：
α＝(a+b)/2。
通过误差计算模块对最大误差的计算，可以免去人工计算的麻烦，提高了作业效率。
在本申请的又一个具体实施方式中，还包括微调控制模块60，具体如图9所示。
微调控制模块用于在自动驾驶集装箱卡车停止后、向目标起重机发送装卸作业指令之前，对自动驾驶集装箱卡车进行微调操作。
自动驾驶集装箱卡车停车后如果UWB给出的当前剩余距离大于±d、即第一距离，则控制动力系统和制动系统对自动驾驶集装箱卡车的位置进行微调操作，即对自动驾驶集装箱卡车的位置进行短距离调整；在微调过程中，当UWB给出的当前剩余距离小于±(α-β)、即第二距离时，控制自动驾驶集装箱卡车停止微调操作。
这里的α为对位容许的最大误差，β为UWB的静态精度。
通过对自动驾驶集装箱卡车的微调操作，可以使自动驾驶集装箱卡车对位更为准确。
实施例五
本实施例提供了一种自动驾驶集装箱卡车。该自动驾驶集装箱卡车设置有如上一实施例提供的对位控制装置。该装置具体用于控制自动驾驶集装箱卡车行驶至目标贝位；根据目标起重机的状态计算剩余距离；根据剩余距离控制自动驾驶集装箱卡车制动；向目标起重机发送装卸作业指令，以使目标起重机从自动驾驶集装箱起吊集装箱，或者使目标起重机向自动驾驶集装箱卡车装载集装箱。通过本技术方案，可以使自动驾驶集装箱卡车与龙门起重机实现对正，从而为集装箱装卸创造了必要条件。
本说明书中的各个实施例均采用递进的方式描述，每个实施例重点说明的都是与其他实施例的不同之处，各个实施例之间相同相似的部分互相参见即可。
本领域内的技术人员应明白，本发明实施例的实施例可提供为方法、装置、或计算机程序产品。因此，本发明实施例可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且，本发明实施例可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。
本发明实施例是参照根据本发明实施例的方法、终端设备(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理终端设备的处理器以产生一个机器，使得通过计算机或其他可编程数据处理终端设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。
这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理终端设备以特定方式工作的计算机可读存储器中，使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品，该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。
这些计算机程序指令也可装载到计算机或其他可编程数据处理终端设备上，使得在计算机或其他可编程终端设备上执行一系列操作步骤以产生计算机实现的处理，从而在计算机或其他可编程终端设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。
尽管已描述了本发明实施例的优选实施例，但本领域内的技术人员一旦得知了基本创造性概念，则可对这些实施例做出另外的变更和修改。所以，所附权利要求意欲解释为包括优选实施例以及落入本发明实施例范围的所有变更和修改。
最后，还需要说明的是，在本文中，诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来，而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且，术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含，从而使得包括一系列要素的过程、方法、物品或者终端设备不仅包括那些要素，而且还包括没有明确列出的其他要素，或者是还包括为这种过程、方法、物品或者终端设备所固有的要素。在没有更多限制的情况下，由语句“包括一个……”限定的要素，并不排除在包括所述要素的过程、方法、物品或者终端设备中还存在另外的相同要素。
以上对本发明所提供的技术方案进行了详细介绍，本文中应用了具体个例对本发明的原理及实施方式进行了阐述，以上实施例的说明只是用于帮助理解本发明的方法及其核心思想；同时，对于本领域的一般技术人员，依据本发明的思想，在具体实施方式及应用范围上均会有改变之处，综上所述，本说明书内容不应理解为对本发明的限制。
Claims (7)
1.一种对位控制方法，应用于自动驾驶集装箱卡车，其特征在于，所述对位控制方法包括步骤：
控制所述自动驾驶集装箱卡车行驶至目标贝位；所述目标贝位是指目标起重机的作业位置；
当自动驾驶集装箱卡车距离最终的作业距离达到一定距离时，根据目标起重机的状态获取剩余距离；所述剩余距离是指自动驾驶集装箱卡车上某一点距离目标起重机上某一点的距离；
根据所述剩余距离控制所述自动驾驶集装箱卡车制动，以使其停靠于目标起重机作业所需的作业位置；
向所述目标起重机发送装卸作业指令，以使所述目标起重机从所述自动驾驶集装箱起吊集装箱，或者使所述目标起重机向所述自动驾驶集装箱卡车装载集装箱；
所述根据目标起重机的状态获取剩余距离，包括步骤：
如果所述目标起重机已经停到位，获取超带宽定位系统计算的所述剩余距离；
如果所述目标起重机没有停到位，获取载波相位差分系统计算的所述剩余距离。
2.如权利要求1所述的对位控制方法，其特征在于，在控制所述自动驾驶集装箱卡车行驶至目标贝位步骤之前，还包括步骤：
计算所述自动驾驶集装箱卡车精准停车后与所述目标起重机相对位置所容许的最大误差；所述最大误差为同一轴向上所述自动驾驶集装箱卡车的集装箱孔径和所述目标起重机的锁钮尺寸之和的均值。
3.如权利要求1所述的对位控制方法，其特征在于，在所述向所述目标起重机发送装卸作业指令步骤之前，还包括步骤：
当所述自动驾驶集装箱卡车停车后，如果当前剩余距离为第一距离时，则控制所述自动驾驶集装箱卡车进行短距离调整；所述第一距离大于对位容许的最大误差和超带宽定位系统的静态精度差值；
当所述当前剩余距离为第二距离时，控制所述自动驾驶集装箱卡车停止短距离调整；所述第二距离小于对位容许的最大误差和超带宽定位系统的静态精度差值，所述第二距离小于第一距离。
4.一种对位控制装置，应用于自动驾驶集装箱卡车，其特征在于，所述对位控制装置包括：
第一控制模块，被配置为控制所述自动驾驶集装箱卡车行驶至目标贝位；所述目标贝位是指目标起重机的作业位置；
距离获取模块，被配置为当自动驾驶集装箱卡车距离最终的作业距离达到一定距离时，根据目标起重机的状态获取剩余距离；所述剩余距离是指自动驾驶集装箱卡车上某一点距离目标起重机上某一点的距离；
第二控制模块，被配置为根据所述剩余距离控制所述自动驾驶集装箱卡车制动，以使其停靠于目标起重机作业所需的作业位置；
指令发送模块，被配置为向所述目标起重机发送装卸作业指令，以使所述目标起重机从所述自动驾驶集装箱起吊集装箱，或者使所述目标起重机向所述自动驾驶集装箱卡车装载集装箱；
所述距离计算模块包括：
第一获取单元，用于如果所述目标起重机已经停到位，获取超带宽定位系统计算的剩余距离；
第二获取单元，用于如果所述目标起重机没有停到位，获取载波相位差分系统计算的剩余距离。
5.如权利要求4所述的对位控制装置，其特征在于，还包括：
误差计算模块，被配置为在所述第一控制模块控制所述自动驾驶集装箱卡车行驶至目标贝位之前，计算所述自动驾驶集装箱卡车精准停车后与所述目标起重机相对位置所容许的最大误差；所述最大误差为同一轴向上所述自动驾驶集装箱卡车的集装箱孔径和所述目标起重机的锁钮尺寸之和的均值。
6.如权利要求4所述的对位控制装置，其特征在于，还包括：
微调控制模块，被配置为在所述指令发送模块向所述目标起重机发送装卸作业指令之前，当所述自动驾驶集装箱卡车停车后，如果当前剩余距离为第一距离时，则控制所述自动驾驶集装箱卡车进行短距离调整；所述第一距离大于对位容许的最大误差和超带宽定位系统的静态精度差值；并且，当所述当前剩余距离为第二距离时，控制所述自动驾驶集装箱卡车停止短距离调整；所述第二距离小于对位容许的最大误差和超带宽定位系统的静态精度差值，所述第二距离小于第一距离。
7.一种自动驾驶集装箱卡车，其特征在于，还包括如权利要求4～6任一项所述的对位控制装置。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202011064528.7A CN112148018B (zh) | 2020-09-30 | 2020-09-30 | 一种对位控制方法、装置和自动驾驶集装箱卡车 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202011064528.7A CN112148018B (zh) | 2020-09-30 | 2020-09-30 | 一种对位控制方法、装置和自动驾驶集装箱卡车 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN112148018A CN112148018A (zh) | 2020-12-29 |
| CN112148018B true CN112148018B (zh) | 2024-05-14 |
Family
ID=73952010
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202011064528.7A Active CN112148018B (zh) | 2020-09-30 | 2020-09-30 | 一种对位控制方法、装置和自动驾驶集装箱卡车 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN112148018B (zh) |
Families Citing this family (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN112874512B (zh) * | 2021-02-25 | 2022-09-20 | 北京经纬恒润科技股份有限公司 | 一种港口无人集卡的停车方法及系统 |
| CN113443387A (zh) * | 2021-06-30 | 2021-09-28 | 上海西井信息科技有限公司 | 港口无人集装箱卡车对位方法、装置、设备、存储介质 |
| CN113387274B (zh) * | 2021-07-09 | 2023-09-22 | 三一海洋重工有限公司 | 集卡车对位方法、系统及集装箱起重机 |
| CN113428064B (zh) * | 2021-07-16 | 2022-10-21 | 北京经纬恒润科技股份有限公司 | 停车控制方法及运输车 |
| CN115662151B (zh) * | 2022-12-13 | 2023-05-12 | 宜宾职业技术学院 | 一种重载车辆定位控制方法、装置及系统 |
Citations (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH04120605A (ja) * | 1990-09-12 | 1992-04-21 | Hitachi Ltd | 搬送車の走行制御方法及び装置 |
| KR200370933Y1 (ko) * | 2004-09-15 | 2004-12-23 | 서호전기주식회사 | 정지위치 유도 장치 및 그를 갖는 크레인 시스템 |
| CN1958428A (zh) * | 2006-09-26 | 2007-05-09 | 上海海事大学 | 港口运动集装箱卡车定位方法及装置 |
| DE102010052034A1 (de) * | 2010-11-23 | 2012-05-24 | Identec Solutions Ag | Verfahren und Vorrichtung zur georeferenzierten Ortsbestimmung von Containern im Ladebereich von Container-Kränen |
| CN203284078U (zh) * | 2013-05-08 | 2013-11-13 | 北京国泰星云科技有限公司 | 集装箱码头rtg/rmg吊具防碰箱自动控制系统 |
| CN109828577A (zh) * | 2019-02-25 | 2019-05-31 | 北京主线科技有限公司 | 无人驾驶集装箱卡车相对自动化场桥高精度定位停车方法 |
| CN110824515A (zh) * | 2019-10-25 | 2020-02-21 | 中铁武汉勘察设计研究院有限公司 | Gnss与雷达测距相结合的铁水联运车辆跟踪定位方法及系统 |
| CN111483822A (zh) * | 2019-01-28 | 2020-08-04 | 上海图森未来人工智能科技有限公司 | 运输工具的停车控制方法、装置、系统、运输工具及车辆 |
| JP2020149271A (ja) * | 2019-03-13 | 2020-09-17 | 株式会社Ｉｈｉエアロスペース | 車両の走行制御システム |
-
2020
- 2020-09-30 CN CN202011064528.7A patent/CN112148018B/zh active Active
Patent Citations (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH04120605A (ja) * | 1990-09-12 | 1992-04-21 | Hitachi Ltd | 搬送車の走行制御方法及び装置 |
| KR200370933Y1 (ko) * | 2004-09-15 | 2004-12-23 | 서호전기주식회사 | 정지위치 유도 장치 및 그를 갖는 크레인 시스템 |
| CN1958428A (zh) * | 2006-09-26 | 2007-05-09 | 上海海事大学 | 港口运动集装箱卡车定位方法及装置 |
| DE102010052034A1 (de) * | 2010-11-23 | 2012-05-24 | Identec Solutions Ag | Verfahren und Vorrichtung zur georeferenzierten Ortsbestimmung von Containern im Ladebereich von Container-Kränen |
| EP2643258A1 (de) * | 2010-11-23 | 2013-10-02 | Identec Solutions AG | Verfahren und vorrichtung zur georeferenzierten ortsbestimmung von containern im ladebereich von container-kränen |
| CN203284078U (zh) * | 2013-05-08 | 2013-11-13 | 北京国泰星云科技有限公司 | 集装箱码头rtg/rmg吊具防碰箱自动控制系统 |
| CN111483822A (zh) * | 2019-01-28 | 2020-08-04 | 上海图森未来人工智能科技有限公司 | 运输工具的停车控制方法、装置、系统、运输工具及车辆 |
| CN109828577A (zh) * | 2019-02-25 | 2019-05-31 | 北京主线科技有限公司 | 无人驾驶集装箱卡车相对自动化场桥高精度定位停车方法 |
| JP2020149271A (ja) * | 2019-03-13 | 2020-09-17 | 株式会社Ｉｈｉエアロスペース | 車両の走行制御システム |
| CN110824515A (zh) * | 2019-10-25 | 2020-02-21 | 中铁武汉勘察设计研究院有限公司 | Gnss与雷达测距相结合的铁水联运车辆跟踪定位方法及系统 |
Non-Patent Citations (3)
| Title |
|---|
| 基于激光扫描测距技术的岸桥下集卡自动定位系统;许博;;集装箱化;20160828(08);论文第27-30页 * |
| 基于虚拟样机技术的岸桥前大梁结构设计及动力分析;张胜利;中国优秀硕士论文全文数据库工程科技Ⅱ辑;20060415;论文第49-53页 * |
| 激光扫描仪在集装箱吊装轨迹优化控制中的应用;卓宏明;王斌;何海华;;浙江国际海运职业技术学院学报;20180915(03);论文第14-18页 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN112148018A (zh) | 2020-12-29 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN112148018B (zh) | 一种对位控制方法、装置和自动驾驶集装箱卡车 | |
| US11167964B2 (en) | Control augmentation apparatus and method for automated guided vehicles | |
| EP3905215B1 (en) | Precise truck parking method, device, and system in quayside container crane area | |
| US20220187840A1 (en) | System and method for operating utility vehicles | |
| AU2013350345B2 (en) | Management system and management method | |
| CN110789518B (zh) | 一种停车控制方法、停车服务器、车辆控制器和车辆 | |
| CN111376905B (zh) | 运输工具的停车控制方法、装置、系统、运输工具及车辆 | |
| US10515490B2 (en) | Method and device for determining whether a motor vehicle is instantaneously driven manually or automatically | |
| CN110874944B (zh) | 一种停车控制方法、停车服务器、车辆控制器和车辆 | |
| CN111152782A (zh) | 一种自动泊车控制系统及控制方法 | |
| US11181928B2 (en) | Method for operating a transportation vehicle and transportation vehicle | |
| US10145881B1 (en) | Autonomous vehicle maintenance self-charge | |
| US20230132179A1 (en) | Tow management systems and methods for autonomous vehicles | |
| JP7373573B2 (ja) | 異なるタイプの停止位置で停止するときに車両を停止させる方法及び制御ユニット | |
| EP3072022A1 (en) | System and method to make possible autonomous operation and/or external control of a motor vehicle | |
| GB2559169A (en) | Controlling movement of a vehicle | |
| CN111942400A (zh) | 将负载分布用于根据具体情况适应的轨迹规划和轨迹调节 | |
| US20210208599A1 (en) | Control Device and Method for Automated Movement of a Motor Vehicle | |
| CN110502002B (zh) | 车辆引导系统、装卸设备控制系统和车辆控制系统 | |
| JP7360634B2 (ja) | 車両制御システム及び荷役制御システム | |
| EP4009672A1 (en) | Dump plate device, dump plate system, and method of handling dump plate device | |
| US20230131387A1 (en) | Tow management systems and methods for autonomous vehicles | |
| US20230373656A1 (en) | Remote-controllable lifting and/or transporting arrangement | |
| CN112469621B (zh) | 用于将商用车送往到目标位置中的控制方法和控制设备以及相关商用车 | |
| CN114538283A (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 | ||
| TA01 | Transfer of patent application right |
Effective date of registration: 20220525 Address after: No. 203, Shanghai Songjiang Road, No. 201563, Pudong New Area Applicant after: SAIC Motor Corp.,Ltd. Applicant after: Shanghai automotive industry (Group) Co.,Ltd. Address before: 201203 Room 509, Building No. 1, 563 Songtao Road, Zhangjiang High-tech Park, Pudong New Area, Shanghai Applicant before: SAIC Motor Corp.,Ltd. |
|
| TA01 | Transfer of patent application right | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |