无人驾驶集装箱卡车相对自动化场桥高精度定位停车方法技术

本发明专利技术涉及一种无人驾驶集装箱卡车相对自动化场桥高精度定位停车方法，其特征是：采用激光雷达和视觉传感器将无人驾驶集装箱卡车与自动化场桥之间的相对定位区间调整至10米以内；通过自动化场桥拖挂定位检测信息，修正无人驾驶集装箱卡车与自动化场桥之间的相互位置，根据相对定位信息，利用定位有限状态机和步进停车控制器，实现无人驾驶集装箱卡车场桥作业的高精度定位。有益效果：本发明专利技术解决了无人驾驶集装箱卡车在堆场作业时GPS/北斗定位误差的问题，可以实现无人驾驶集装箱卡车和自动化场桥的相对精确定位，同时减少无人驾驶集装箱卡车位置姿态调整的次数，实现精确停车，提高自动化场桥与集装箱卡车之间完成装箱、卸箱的效率。

High Precision Location and Parking Method for Unmanned Container Truck Relatively Automated Field Bridge

The present invention relates to a high precision positioning and parking method for driverless container trucks relative to automated field bridges, which is characterized by: adjusting the relative positioning range between driverless container trucks and automated field bridges to less than 10 meters by using lidar and visual sensors; correcting the positioning and detection information of driverless container trucks and automated field bridges by towing automated field bridges According to the relative positioning information, the positioning finite state machine and the stepping and parking controller are used to realize the high precision positioning of the driverless container truck yard and bridge operation. Beneficial effect: The invention solves the problem of GPS/Beidou positioning error of Unmanned Container truck in yard operation, realizes relatively accurate positioning of Unmanned Container truck and automated yard bridge, reduces the times of position and attitude adjustment of Unmanned Container truck, realizes precise parking, and improves loading and unloading between automated yard bridge and container truck. Efficiency.

【技术实现步骤摘要】
无人驾驶集装箱卡车相对自动化场桥高精度定位停车方法
本专利技术属于无人驾驶汽车
，尤其涉及一种无人驾驶集装箱卡车相对自动化场桥高精度定位停车方法。
技术介绍
港口平面运输效率主要取决于岸桥和场桥与集装箱卡车之间完成装箱、卸箱的效率。目前岸桥、场桥与集装箱卡车之间进行装箱、卸箱操作时，对桥吊与集装箱卡车之间的相对位置和姿态要求比较高，误差范围比较小，往往需要驾驶员多次调整相对位置与姿态，对驾驶技术要求较高，同时也会影响装卸效率。港口自动化改造主要涉及港口作业调度系统改造、场桥自动化改造和无人驾驶集装箱卡车等。港口作业调度系统发出作业指令，场桥和集装箱卡车分别要移动到指定的作业贝位，因此，在自动化改造过程中，场桥一般通过磁钉实现精确定位，集装箱卡车一般通过GPS/北斗定位系统增加定位能力，但是限于GPS/北斗的定位精度，还需要通过增加激光雷达和视觉传感器提高定位精度。在实际使用过程中，场桥和集装箱卡车到达作业贝位，开始进行装卸箱操作之前，需要场桥和集装箱卡车互相配合，分别或者同时移动场桥和集装箱卡车，逐步优化场桥和集装箱卡车各自的停车位置以及相互位置和姿态关系，最终保证场桥到达正确的贝位位置，集装箱卡车到达该场桥能够正确装卸箱的位置，并保持正确的停车姿态。无人驾驶集装箱卡车在港口平面运输中发挥作业，需要具备相对自动化场桥精确定位停车装卸箱的能力。实现上述方案的难点主要包括：无人驾驶集装箱卡车在堆场作业时，由于自动化场桥或者集装箱遮挡，会造成GPS/北斗定位误差增大；自动化场桥和无人驾驶集装箱卡车同时运动时，如何协调两者之间的相互运动，提供优化控制策略，减少无人驾驶集装箱卡车位置姿态调整的次数和距离；由于无人驾驶集装箱卡车拖挂尺寸变化，会导致利用激光雷达或者视觉传感器实现的卡车与场桥之间的定位位置与实际装卸箱位置存在一定的偏移，无法正确完成装卸箱操作。
技术实现思路
本专利技术的目的在于克服上述技术的不足，而提供一种无人驾驶集装箱卡车相对自动化场桥高精度定位停车方法，利用激光雷达和视觉传感器，通过无人驾驶集装箱卡车共享自动场桥拖挂定位检测信息，可以控制无人驾驶集装箱卡车厘米级精确定位停车。本专利技术为实现上述目的，采用以下技术方案：一种无人驾驶集装箱卡车相对自动化场桥高精度定位停车方法，其特征是：采用激光雷达和视觉传感器将无人驾驶集装箱卡车与自动化场桥之间的相对定位区间调整至10米以内；通过自动化场桥拖挂定位检测信息，修正无人驾驶集装箱卡车与自动化场桥之间的相互位置，增加无人驾驶集装箱卡车和自动化场桥之间的定位信息交互，根据相对定位信息，利用定位有限状态机和步进停车控制器，实现无人驾驶集装箱卡车场桥作业的高精度定位，具体步骤如下：步骤一、自动化场桥接收调度系统指令，开始向指定贝位运动；自动化场桥到达指定贝位，停止运动，等待无人驾驶集装箱卡车；步骤二、无人驾驶集装箱卡车利用定位有限状态机调整自车运动，实现与自动化场桥的互定位以及精确停车，有限状态机的状态以及状态转移关系如下：1)准备：无人驾驶集装箱卡车接收调度系统指令，查询指定贝位定位信息，规划行驶轨迹，发送开始运行指令；2)运行：无人驾驶集装箱卡车接收指令，开始向指定贝位运动；此时无人驾驶集装箱卡车并没有进入能够与自动化场桥相互定位检测的距离，无人驾驶集装箱卡车根据指定贝位及GPS/北斗定位位置的规划轨迹运动；3)低速运行：无人驾驶集装箱卡车继续移动，当进入与自动化场桥相对定位区域，进入低速运行状态，降低无人驾驶集装箱卡车的运行速度，无人驾驶集装箱卡车根据自车配备的激光雷达或者视觉传感器检测自动化场桥，计算得到与自动化场桥的相对定位信息，更新相对定位；4)微调定位：无人驾驶集装箱卡车进入自动化场桥的拖挂定位有效区间，无人驾驶集装箱卡车通过无线局域网接收自动化场桥发出的拖挂偏移信息，根据偏移信息移动，利用步进停车控制器，实现无人驾驶集装箱卡车的步进运动，最终实现精确停车；5)到达目的地：当无人驾驶集装箱卡车达到停车误差合理范围内，无人驾驶集装箱卡车停止运动，并向调度系统反馈到达目的地信号，开始装卸箱。步骤二中的状态3)所述低速运行为将无人驾驶集装箱卡车的运行速度降至2km/h。步骤二中的状态5)所述到达目的地后无人驾驶集装箱卡车停车的合理误差范围为2-3cm。所述步进停车控制器是实现车辆在空载、重载等不同载重情况下，通过控制车辆油门刹车动作，完成车辆步进行进；其中：油门刹车动作是指固定油门开度f的油门输出一段时间interval，然后立即输出刹车控制量b；步进停车控制器的控制量为油门输出时间interval；反馈量为一次油门刹车动作后车辆实际行进距离dt，由激光或者视觉传感器测量得到，固定油门开度f为怠速时的油门开度，刹车控制量b为最大刹车控制量；初始油门输出时间intervalinit是车辆载重量w和期望的行进距离d的二次函数，通过参数拟合获得不同载重条件下车辆行进距离与油门输出时间的关系，intervalinit＝αw2+βw+γd2+δd+∈。有益效果：与现有技术相比，本专利技术解决了无人驾驶集装箱卡车在堆场作业时GPS/北斗定位误差的问题，可以实现无人驾驶集装箱卡车和自动化场桥的相对精确定位，同时减少无人驾驶集装箱卡车位置姿态调整的次数，实现精确停车，提高自动化场桥与集装箱卡车之间完成装箱、卸箱的效率。附图说明图1是初始状态下无人驾驶集装箱卡车、自动化场桥与指定贝位位置的示意图；图2是无人驾驶集装箱卡车进入准备状态示意图；图3是无人驾驶集装箱卡车运行状态示意图；图4是无人驾驶集装箱卡车低速运行状态示意图；图5是无人驾驶集装箱卡车微调定位状态示意图；图6是无人驾驶集装箱卡车定位有限状态机的状态及状态转移关系框图。(摘要附图)具体实施方式下面结合较佳实施例详细说明本专利技术的具体实施方式。详见附图，本实施例提供了一种无人驾驶集装箱卡车相对自动化场桥高精度定位停车方法，采用激光雷达和视觉传感器将无人驾驶集装箱卡车与自动化场桥之间的相对定位区间调整至10米以内；通过自动化场桥拖挂定位检测信息，修正无人驾驶集装箱卡车与自动化场桥之间的相互位置，增加无人驾驶集装箱卡车和自动化场桥之间的定位信息交互，根据相对定位信息，利用定位有限状态机和步进停车控制器，实现无人驾驶集装箱卡车自动化场桥作业的高精度定位。初始时，无人驾驶集装箱卡车与自动化场桥的位置如图1所示，无人驾驶集装箱卡车位于A点，自动化场桥位于B点。具体步骤如下：步骤一、自动化场桥接收调度系统指令，得到指定贝位C点坐标，开始向指定贝位运动；自动化场桥到达指定贝位C点后停止运动，等待无人驾驶集装箱卡车；步骤二、无人驾驶集装箱卡车利用定位有限状态机调整自车运动，实现与自动化场桥的互定位以及精确停车，有限状态机的状态以及状态转移关系如下：1.准备：无人驾驶集装箱卡车接收调度系统指令，查询指定贝位定位信息，得到指定贝位C点坐标，A点与C点距离约50m，根据A点与C点坐标规划行驶轨迹，发送开始运行指令，如图2所示；2.运行：无人驾驶集装箱卡车接收指令，开始向指定贝位C运动，由于此时无人驾驶集装箱卡车并没有进入能够与自动化场桥相互定位检测的距离，如图3，无人驾驶集装箱卡车根据C点坐标及自车配备的GPS/北斗定位系统得到自车坐本文档来自技高网...

【技术保护点】
1.一种无人驾驶集装箱卡车相对自动化场桥高精度定位停车方法，其特征是：采用激光雷达和视觉传感器将无人驾驶集装箱卡车与自动化场桥之间的相对定位区间调整至10米以内；通过自动化场桥拖挂定位检测信息，修正无人驾驶集装箱卡车与自动化场桥之间的相互位置，增加无人驾驶集装箱卡车和自动化场桥之间的定位信息交互，根据相对定位信息，利用定位有限状态机和步进停车控制器，实现无人驾驶集装箱卡车场桥作业的高精度定位，具体步骤如下：步骤一、自动化场桥接收调度系统指令，开始向指定贝位运动；自动化场桥到达指定贝位，停止运动，等待无人驾驶集装箱卡车；步骤二、无人驾驶集装箱卡车利用定位有限状态机调整自车运动，实现与自动化场桥的互定位以及精确停车，有限状态机的状态以及状态转移关系如下：1)准备：无人驾驶集装箱卡车接收调度系统指令，查询指定贝位定位信息，规划行驶轨迹，发送开始运行指令；2)运行：无人驾驶集装箱卡车接收指令，开始向指定贝位运动；此时无人驾驶集装箱卡车并没有进入能够与自动化场桥相互定位检测的距离，无人驾驶集装箱卡车根据指定贝位及GPS/北斗定位位置的规划轨迹运动；3)低速运行：无人驾驶集装箱卡车继续移动，当进入与自动化场桥相对定位区域，进入低速运行状态，降低无人驾驶集装箱卡车的运行速度，无人驾驶集装箱卡车根据自车配备的激光雷达或者视觉传感器检测自动化场桥，计算得到与自动化场桥的相对定位信息，更新相对定位；4)微调定位：无人驾驶集装箱卡车进入自动化场桥的拖挂定位有效区间，无人驾驶集装箱卡车通过无线局域网接收自动化场桥发出的拖挂偏移信息，根据偏移信息移动，利用步进停车控制器，实现无人驾驶集装箱卡车的步进运动，最终实现精确停车；5)到达目的地：当无人驾驶集装箱卡车达到停车误差合理范围内，无人驾驶集装箱卡车停止运动，并向调度系统反馈到达目的地信号，开始装卸箱。...

【技术特征摘要】
1.一种无人驾驶集装箱卡车相对自动化场桥高精度定位停车方法，其特征是：采用激光雷达和视觉传感器将无人驾驶集装箱卡车与自动化场桥之间的相对定位区间调整至10米以内；通过自动化场桥拖挂定位检测信息，修正无人驾驶集装箱卡车与自动化场桥之间的相互位置，增加无人驾驶集装箱卡车和自动化场桥之间的定位信息交互，根据相对定位信息，利用定位有限状态机和步进停车控制器，实现无人驾驶集装箱卡车场桥作业的高精度定位，具体步骤如下：步骤一、自动化场桥接收调度系统指令，开始向指定贝位运动；自动化场桥到达指定贝位，停止运动，等待无人驾驶集装箱卡车；步骤二、无人驾驶集装箱卡车利用定位有限状态机调整自车运动，实现与自动化场桥的互定位以及精确停车，有限状态机的状态以及状态转移关系如下：1)准备：无人驾驶集装箱卡车接收调度系统指令，查询指定贝位定位信息，规划行驶轨迹，发送开始运行指令；2)运行：无人驾驶集装箱卡车接收指令，开始向指定贝位运动；此时无人驾驶集装箱卡车并没有进入能够与自动化场桥相互定位检测的距离，无人驾驶集装箱卡车根据指定贝位及GPS/北斗定位位置的规划轨迹运动；3)低速运行：无人驾驶集装箱卡车继续移动，当进入与自动化场桥相对定位区域，进入低速运行状态，降低无人驾驶集装箱卡车的运行速度，无人驾驶集装箱卡车根据自车配备的激光雷达或者视觉传感器检测自动化场桥，计算得到与自动化场桥的相对定位信息，更新相对定位；4)微调定位：无人驾驶集装箱卡车进入自动化场桥的拖挂定位有效区间，无人驾驶集装箱卡车通...

【专利技术属性】
技术研发人员：王晓东，张天雷，何贝，刘鹤云，郑思仪，
申请(专利权)人：北京主线科技有限公司，
类型：发明
国别省市：北京,11