利用激光点云计算卡车车头和挂车之间夹角的方法及系统
摘要:
本发明公开一种利用激光点云计算卡车车头和挂车之间夹角的方法及系统,其通过在卡车车头设置激光雷达,实时采集并存储激光雷达扫描得到的点云数据,根据挂车边缘线与激光雷达原点之间的距离范围,自存储的点云数据中筛选出激光雷达扫描挂车边缘线得到的点云,然后将扫描挂车边缘线的三维点云投影至XY二维平面得到一束点集,并利用最小二乘原理把投影在XY二维平面的一束点集拟合成直线,最后根据直线的斜率计算得到挂车边缘线与卡车车头中轴线的夹角,进而得到卡车车头和挂车之间的夹角,从而仅利用卡车头部激光雷达扫描到的挂车边缘线点云做处理,不需要额外增加辅助设备,且不受地理条件区域限制,使用范围广泛。
0/0