用于港口无人集卡的激光雷达辅助集装箱对位方法技术

本发明专利技术公开了用于港口无人集卡的激光雷达辅助集装箱对位方法，包括以下步骤：获取激光雷达点云数据，提取检测区域点云；通过直线检测算法拟合检测区域点云内的所有直线；遍历所有直线，提取车载集装箱边沿与激光原点正方向垂直的直线，计算出激光原点到车载集装箱的距离，遍历所有直线，提取落地集装箱的外侧顶点与激光原点正方向垂直的直线，计算出激光原点与落地集装箱的距离，从而计算出车载集装箱与落地集装箱的对位差值。与传统的UWB定位，其对位精度在5cm以内适应于港口的容许误差，对位精度高，车载集装箱与落地集装箱摆放对齐以便于港口吊具快速抓取装卸集装箱，提高港口的装卸效率。

【技术实现步骤摘要】
用于港口无人集卡的激光雷达辅助集装箱对位方法
本专利技术属于导航定位
，尤其是涉及一种用于港口无人集卡的激光雷达辅助集装箱对位方法。
技术介绍
智慧港口是现代港口发展的必然趋势，其主要宗旨是充分借助物联网、传感网、云计算、决策分析优化等技术手段，通过预测感知、广泛连接、深度计算各港口供应链系统核心的关键信息，实现港口供应链上的各种资源和各个参与方之间无缝连接与协调联动，从而对港口管理做出及时响应，形成信息化、智能化和最优化的现代港口应用。智慧港口的实现，需要通过各类信息通信技术、传感定位技术将港口码头信息、物流装备、堆场仓储作业、货物运输等物流信息进行采集并有效处理、整合和数据挖掘。在港口环境下，无人集卡停位时需要对齐车载集装箱与落地集装箱，以便于将集装箱摆放整齐。UWB(UltraWideban)是一种无载波通信技术，利用纳秒至微秒级的非正弦波窄脉冲传输数据。UWB早期主要应用在近距离高速数据传输，近年来国内外开始利用其亚纳秒级窄脉冲来做近距离精确室内定位。但是，UWB受金属遮挡物体的影响十分严重，甚至可能会失效，需要在开阔条件下才能达到10cm的测距精度，但是，在港口环境相对复杂，经常存在金属集装箱，并且车体等物体会存在遮挡现象，这对于UWB的影响非常大，无法保证开阔条件，且易受到金属遮挡物体的影响，难以达到10cm的测距精度，另外，港口环境的集装箱对位的容许误差在5cm以内，UWB难以适应港口环境的集装箱对位。因此，基于上述技术问题，为了适应港口场景下，自动驾驶车辆的快速准确定位定向，亟需研发出一种新的应用于港口无人集卡的辅助集装箱对位方法。
技术实现思路
本专利技术的目的是提供一种结构简单、操作简单、对位精度高的用于港口无人集卡的激光雷达辅助集装箱对位方法。本专利技术的技术方案如下：一种用于港口无人集卡的激光雷达辅助集装箱对位方法，包括以下步骤：S1.安装在无人集卡上的激光雷达获取所述无人集卡周边环境的激光点云，根据无人集卡的车头与车载集装箱、落地集装箱的位置，提取所述激光点云中的检测区域点云；S2.将所述步骤S1的检测区域点云分割为车载集装箱区域点云和落地集装箱区域点云；S3.提取所述检测区域点云内的激光点，通过直线检测算法拟合出所述检测区域点云内的所有直线；S4.遍历所述步骤S3的所有直线，提取出所述车载集装箱区域点云内与激光原点正方向相垂直的直线，计算激光原点到该直线的垂直距离，得到激光原点到车载集装箱的距离D1；S5.遍历所述步骤S3的所有直线，提取出所述落地集装箱区域点云内两条相互垂直且直线的端点相交于直角点的垂线，且两条所述垂线的直角开口远离激光原点，计算激光原点到与激光原点正方向相垂直的直线的垂直距离，得到激光原点到落地集装箱的距离D2；S6.通过所述步骤S4的激光到车载集装箱的距离D1与所述步骤S5的激光到落地集装箱的距离D2的差值，计算出所述无人集卡车头距离车载集装箱与落地集装箱的距离差值D，由如下公式计算：D＝D1-D2；S7.所述激光雷达与无人集卡上的控制端通讯连接，所述控制端接收所述步骤S6中的距离差值，根据所述距离差值控制无人集卡进行移动，以使所述距离差值D的绝对值达到其最小值。在上述技术方案中，所述距离差值D≤±5cm。在上述技术方案中，所述步骤S5中，提取两条垂线包括以下步骤：S5-1.遍历所述步骤S3中的所有直线，提取出落地集装箱区域点云内的多个相邻直线对，且所述相邻直线对为相互垂直的一对相邻直线；S5-2.遍历所述步骤S5-1中的所有相邻直线对，提取所述相邻直线对中的直角开口远离激光原点一侧的两条相邻直线；S5-3.根据提取的两条相邻直线的直线信息，通过所述直线信息判断出两条相邻直线中与激光原点正方向相垂直的直线，计算激光原点与激光原点正方向相垂直的直线的距离，得到激光原点到落地集装箱的距离D2。在上述技术方案中，所述步骤S5-3中的直线信息包括直线的斜率、直线的起点和终点，通过直线的起点和终点计算出直线的斜率。在上述技术方案中，以激光原点正方向为x轴，与x轴相垂直的竖直方向为y轴，所述检测区域点云为在x轴方向上-90°～+90°范围内的激光点云。在上述技术方案中，所述落地集装箱区域点云为在所述x轴方向上的-90°～-45°、45°～90°。在上述技术方案中，所述车载集装箱区域点云为在所述x轴方向上的-45°～45°。在上述技术方案中，所述激光雷达安装在无人集卡的车头尾部中心，且放置在地面上的落地集装箱高度-激光雷达的高度≤10cm。在上述技术方案中，所述激光雷达的正方向为朝向无人集卡的车尾正后方。本专利技术具有的优点和积极效果是：1.在港口环境中，通过激光雷达采集无人集卡周围环境的激光点云，提取感兴趣的检测区域点云，拟合出检测区域点云内的所有直线，提取出车载集装箱与激光原点相垂直的直线及相互垂直的相邻直线，分别计算出激光原点与车载集装箱、激光原点与落地集装箱之间的距离，从而得出车载集装箱及落地集装箱的对位差值，与传统的UWB定位，其对位精度在5cm以内以使用港口内的容许误差，对位精度高。2.通过对位方法得出的无人集卡车头距离车载集装箱和落地集装箱的距离，车载集装箱与落地集装箱在装卸过程中的对位精度高，摆放对位整齐，停位准确，当在港口环境中需要通过吊具来吊装集装箱时，有效避免吊具无法吊取集装箱的问题，提高港口集装箱的装卸生产效率。3.实时通过无人集卡上的激光雷达采集车载集装箱及落地集装箱的激光点云，其采集的频率高，检测稳定性强。附图说明图1是本专利技术的对位方法的流程图；图2是本专利技术的对位方法的车辆位置摆放示意图；图3是本实施例1中无人集卡停位距离检测示意图；图4是本实施例1中直角开口的示意图；图5是本实施例2中无人集卡停位距离检测示意图。具体实施方式以下结合具体实施例对本专利技术作进一步详细说明。应当理解，此处所描述的具体实施例仅仅用于解释本专利技术，并不用于限定本专利技术，决不限制本专利技术的保护范围。实施例1如图1-图3所示，激光雷达安装在无人集卡的车头尾部的中心位置，其中，定义激光雷达的正方向为朝向无人集卡的车体正后方(车头行进方向的反方向)为激光X轴，与激光X轴相垂直的方向为激光Y轴，放置在无人集卡上的集装箱为车载集装箱，放置在港口地面上的集装箱为落地集装箱，所述落地集装箱分别位于所述车载集装箱的左右两侧。本专利技术的一种用于港口无人集卡的激光雷达辅助集装箱对位方法，包括以下步骤：S1.安装在无人集卡上的激光雷达获取所述无人集卡周边环境的激光点云，根据无人集卡的车头与车载集装箱、落地集装箱的位置，提取所述激光点云中的检测区域点云(以x轴为横轴，y轴为纵轴的坐标系下，提取范围为x轴方向的-90°～90°)；S2.将所述步骤S1的检测区域点云分割为车载集装箱区域点云(提本文档来自技高网...

【技术保护点】
1.一种用于港口无人集卡的激光雷达辅助集装箱对位方法，其特征在于：包括以下步骤：/nS1.安装在无人集卡上的激光雷达获取所述无人集卡周边环境的激光点云，根据无人集卡的车头与车载集装箱、落地集装箱的位置，提取所述激光点云中的检测区域点云；/nS2.将所述步骤S1的检测区域点云分割为车载集装箱区域点云和落地集装箱区域点云；/nS3.提取所述检测区域点云内的激光点，通过直线检测算法拟合出所述检测区域点云内的所有直线；/nS4.遍历所述步骤S3的所有直线，提取出所述车载集装箱区域点云内与激光原点正方向相垂直的直线，计算激光原点到该直线的垂直距离，得到激光原点到车载集装箱的距离D1；/nS5.遍历所述步骤S3的所有直线，提取出所述落地集装箱区域点云内两条相互垂直且直线的端点相交于直角点的垂线，且两条所述垂线的直角开口远离激光原点，计算激光原点到与激光原点正方向相垂直的直线的垂直距离，得到激光原点到落地集装箱的距离D2；/nS6.通过所述步骤S4的激光到车载集装箱的距离D1与所述步骤S5的激光到落地集装箱的距离D2的差值，计算出所述无人集卡车头距离车载集装箱与落地集装箱的距离差值D，由如下公式计算：/nD＝D1-D2；/nS7.所述激光雷达与无人集卡上的控制端通讯连接，所述控制端接收所述步骤S6中的距离差值，根据所述距离差值控制无人集卡进行移动，以使所述距离差值D的绝对值达到其最小值。/n...

【技术特征摘要】
1.一种用于港口无人集卡的激光雷达辅助集装箱对位方法，其特征在于：包括以下步骤：
S1.安装在无人集卡上的激光雷达获取所述无人集卡周边环境的激光点云，根据无人集卡的车头与车载集装箱、落地集装箱的位置，提取所述激光点云中的检测区域点云；
S2.将所述步骤S1的检测区域点云分割为车载集装箱区域点云和落地集装箱区域点云；
S3.提取所述检测区域点云内的激光点，通过直线检测算法拟合出所述检测区域点云内的所有直线；
S4.遍历所述步骤S3的所有直线，提取出所述车载集装箱区域点云内与激光原点正方向相垂直的直线，计算激光原点到该直线的垂直距离，得到激光原点到车载集装箱的距离D1；
S5.遍历所述步骤S3的所有直线，提取出所述落地集装箱区域点云内两条相互垂直且直线的端点相交于直角点的垂线，且两条所述垂线的直角开口远离激光原点，计算激光原点到与激光原点正方向相垂直的直线的垂直距离，得到激光原点到落地集装箱的距离D2；
S6.通过所述步骤S4的激光到车载集装箱的距离D1与所述步骤S5的激光到落地集装箱的距离D2的差值，计算出所述无人集卡车头距离车载集装箱与落地集装箱的距离差值D，由如下公式计算：
D＝D1-D2；
S7.所述激光雷达与无人集卡上的控制端通讯连接，所述控制端接收所述步骤S6中的距离差值，根据所述距离差值控制无人集卡进行移动，以使所述距离差值D的绝对值达到其最小值。


2.根据权利要求1所述的激光雷达辅助集装箱对位方法，其特征在于，所述步骤S5中，提取两条垂线包括以下步骤：
S5-1.遍历所述步骤S3中的所有直线，提取出所述落地集装箱区域点云内的多个相邻直线对，且所述相邻直线对为相互垂直的一...

【专利技术属性】
技术研发人员：张祖锋，殷嘉伦，王广全，刘凯，孙忠平，
申请(专利权)人：畅加风行苏州智能科技有限公司，
类型：发明
国别省市：江苏;32