[发明专利]基于三维激光的集卡防砸检测方法、装置和计算机设备有效
申请号: | 202010158561.X | 申请日: | 2020-03-09 |
公开(公告)号: | CN113376654B | 公开(公告)日: | 2023-05-26 |
发明(设计)人: | 胡荣东;文驰;李敏;李雅盟;彭清 | 申请(专利权)人: | 长沙智能驾驶研究院有限公司 |
主分类号: | G01S17/93 | 分类号: | G01S17/93 |
代理公司: | 华进联合专利商标代理有限公司 44224 | 代理人: | 黄恕 |
地址: | 410006 湖南省长沙市岳麓区学士*** | 国省代码: | 湖南;43 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 基于 三维 激光 集卡防砸 检测 方法 装置 计算机 设备 | ||
1.一种基于三维激光的集卡防砸检测方法,所述方法包括:
获取集卡装箱作业中集装箱起重机的吊具当前所夹住的集装箱的尺寸参数;
获取在所述吊具夹住所述集装箱下落时激光雷达采集的集装箱作业的三维点云;
获取所述激光雷达的姿态参数;
根据所述姿态参数,对所述三维点云进行转换,得到集装箱作业的全面点云;
获取吊具与所述激光雷达的相对平移量;
根据所述相对平移量以及所述集装箱的尺寸参数,在所述全面点云中确定集装箱下落区域范围;
当在所述集装箱下落区域范围内检测到障碍物时,发出防砸警报。
2.根据权利要求1所述的方法,其特征在于,所述激光雷达包括安装在集装箱起重机吊具下方的同一侧呈一定夹角设置的基准激光雷达和至少一个对准激光雷达;所述姿态参数包括所述基准激光雷达的第一姿态角、所述对准激光雷达的第二姿态角和所述对准激光雷达相对于所述基准激光雷达的位置平移量;
获取在所述吊具夹住所述集装箱下落时激光雷达采集的集装箱作业的三维点云,包括:
获取在所述吊具夹住所述集装箱下落时所述基准激光雷达采集的集装箱作业的第一三维点云,以及对准激光雷达采集的集装箱作业的第二三维点云;
根据所述姿态参数,对所述三维点云进行转换,得到集装箱作业的全面点云,包括:
根据所述第一姿态角将所述第一三维点云转换至检测系统坐标系;
根据所述第二姿态角和所述位置平移量将所述第二三维点云转换至所述检测系统坐标系;
融合转换后的所述第一三维点云和转换后的所述第二三维点云,得到集装箱作业的全面点云;
其中,所述相对平移量为所述吊具与所述基准激光雷达的相对平移量。
3.根据权利要求2所述的方法,其特征在于,获取所述基准激光雷达的第一姿态角的方式,包括:
获取在标定状态所述吊具夹住所述集装箱下落时所述基准激光雷达采集的第一方向标定三维点云;
根据所述基准激光雷达的安装高度,从所述第一方向标定三维点云中确定地面点云;
计算所述地面点云的平面法向量;
根据所述地面点云的平面法向量,计算所述基准激光雷达的翻滚角和俯仰角;
根据所述基准激光雷达的安装高度、集卡托架高度、集装箱高度以及与所述基准激光雷达的距离,从所述第一方向标定三维点云中确定集装箱侧面点云;
计算所述集装箱侧面点云的平面法向量;
根据所述集装箱侧面点云的平面法向量,计算所述基准激光雷达的偏航角,所述第一姿态角包括所述翻滚角、所述俯仰角和所述偏航角。
4.根据权利要求2所述的方法,其特征在于,获取对准激光雷达的第二姿态角和所述对准激光雷达相对于所述基准激光雷达的位置平移量的方式,包括:
获取对同一标定物,所述基准激光雷达采集的标定物第一三维点云,以及所述对准激光雷达采集的标定物第二三维点云;
将所述标定物第一三维点云转换至检测系统坐标系;
对所述标定物第二三维点云和转换后的所述标定物第一三维点云进行点云匹配,确定所述对准激光雷达的第二姿态角以及所述对准激光雷达相对于所述基准激光雷达的位置平移量。
5.根据权利要求1所述的方法,其特征在于,当在所述集装箱下落区域范围内检测到障碍物时,发出防砸警报,包括:
根据集卡托架高度阈值,在所述全面点云中滤除集卡托架点云;
对所述集装箱下落区域范围内的点云,进行滤波处理;
对滤波处理后所述集装箱下落区域范围内的点云,进行障碍物检测;
若检测到障碍物点云,则发出防砸警报。
6.根据权利要求1所述的方法,其特征在于,当在所述集装箱下落区域范围内检测到障碍物时,发出防砸警报,包括:
将所述全面点云投影为二维图像;
确定所述集装箱下落区域范围以及集卡托架在所述二维图像中的位置范围;
根据确定的集卡托架在二维图像中的位置范围,去除二维图像中的集卡托架像素点;
对所述二维图像中的所述集装箱下落区域范围的像素点进行图像检测,若检测到障碍物,发出防砸警报。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于长沙智能驾驶研究院有限公司,未经长沙智能驾驶研究院有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202010158561.X/1.html,转载请声明来源钻瓜专利网。