发明公开
- 专利标题: 利用激光点云计算卡车车头和挂车之间夹角的方法及系统
- 专利标题(英): Method and system for calculating included angle between truck head and trailer by using laser point cloud
-
申请号: CN201910154816.2申请日: 2019-03-01
-
公开(公告)号: CN109959352A公开(公告)日: 2019-07-02
- 发明人: 苏晓聪 , 孙黄玉
- 申请人: 武汉光庭科技有限公司
- 申请人地址: 湖北省武汉市东湖新技术开发区凤凰园三路一号
- 专利权人: 武汉光庭科技有限公司
- 当前专利权人: 武汉光庭科技有限公司
- 当前专利权人地址: 湖北省武汉市东湖新技术开发区凤凰园三路一号
- 代理机构: 武汉河山金堂专利事务所
- 代理商 胡清堂
- 主分类号: G01B11/26
- IPC分类号: G01B11/26 ; G01S17/88
摘要:
本发明公开一种利用激光点云计算卡车车头和挂车之间夹角的方法及系统,其通过在卡车车头设置激光雷达,实时采集并存储激光雷达扫描得到的点云数据,根据挂车边缘线与激光雷达原点之间的距离范围,自存储的点云数据中筛选出激光雷达扫描挂车边缘线得到的点云,然后将扫描挂车边缘线的三维点云投影至XY二维平面得到一束点集,并利用最小二乘原理把投影在XY二维平面的一束点集拟合成直线,最后根据直线的斜率计算得到挂车边缘线与卡车车头中轴线的夹角,进而得到卡车车头和挂车之间的夹角,从而仅利用卡车头部激光雷达扫描到的挂车边缘线点云做处理,不需要额外增加辅助设备,且不受地理条件区域限制,使用范围广泛。