本发明属于误差标定领域,具体涉及一种离线快速实现pos/激光雷达安装误差标定的方法。
背景技术:
pos数据经事后处理可获得wgs-84世界大地坐标系下的高精度位置信息,激光雷达利用激光测距原理可给出目标物体在雷达机体坐标系下的三维位置坐标,根据pos给出的姿态角信息及事先标定出的pos/激光雷达之间的安装误差,即可将激光雷达给出的三维相对位置坐标投影到wgs-84坐标系,从而给出目标物体的点云数据。现有技术中并没有一种高效准确的离线快速实现pos/激光雷达安装误差标定的方法。
技术实现要素:
本发明的目的在于提供一种离线快速实现pos/激光雷达安装误差标定的方法。
实现本发明目的的技术方案:
一种快速实现pos/激光雷达安装误差标定的方法,包括下列步骤:
步骤1:选定合适的标校地物
(1.1)选定测量目标建筑物s,建筑物s的棱边垂直于地面,取棱边的某高端点作为第一特征点a,取棱边的某低端点作为第二特征点b;
(1.2)选定试验场地;在试验场地上设置两条平行线,分别为第一条试验车行车基准线l1、第二条试验车行车基准线l2,两条基准线的间距为l;
步骤2:展外场车载试验,采集pos和雷达数据;
综合pos和雷达数据,获得在第一条试验车行车基准线l1中获得的建筑物s粗略三维位置坐标(x,y,z)和在第二条试验车行车基准线l2中获得的建筑物s粗略三维位置坐标(x’,y’,z’);
步骤3:解算安装误差
(3.1)将步骤2获得的建筑物s粗略三维位置坐标(x,y,z)投影到wgs-84坐标系下,计算公式如下:
[xyz]t=c(δψ,δθ,δγ)[xyz]t
式中,
δψ为pos和雷达之间的航向安装误差角,δθ为俯仰安装误差角,δγ为滚动安装误差角,三个误差角的初始值均为0;
c为δψ→δθ→δγ获得方向余弦矩阵:
经过解算,分别得到建筑物s在wgs-84坐标系下的点云数据,并形成建筑物s在wgs-84坐标系下的图像;
在建筑物s在wgs-84坐标系下的图像中识别出第一特征点a和第二特征点b,将二者的坐标分别记作a(xa、ya、za)、b(xb、yb、zb);
(3.2)标定滚动安装误差角
通过公式
获得滚动安装误差角δγ;
将δγ带入步骤(3.1)的公式中,获得更新1次后的建筑物s在wgs-84坐标系下的点云数据和建筑物s在wgs-84坐标系下的图像,再次从图形中识别出a、b,坐标分别记作
(3.2)标定俯仰安装误差角
通过公式
获得俯仰安装误差角δθ;
将δγ、δθ同时带入步骤(3.1)的公式中,建筑物s在wgs-84坐标系下的点云数据和建筑物s在wgs-84坐标系下的图像,再次从图形中识别出a、b,坐标分别记作
(3.3)标定航向安装误差角
对第二条试验车行车基准线l2中获得的建筑物s粗略三维位置坐标(x’,y’,z’)及更新后的δγ、δθ带入步骤(3.1)的公式中,得到a、b坐标,分别记作
通过公式
获得航向安装误差角δψ。
本发明的有益技术效果在于:
本发明提供的一种离线快速实现pos/激光雷达安装误差标定的方法通过迭代的方法依次解算出三个安装误差角δγ、δθ、δψ,从而实现将三维相对位置坐标精确投影到wgs-84坐标系;通过设计建筑物和试验车的试验场景,实现了理论计算与实地检测的统一,高效准确地实现了离线快速实现pos/激光雷达安装误差标定的方法。
附图说明
图1为本发明所提供的一种离线快速实现pos/激光雷达安装误差标定的方法的示意图。
图中:s.建筑物、l1.第一条试验车行车基准线、l2.第二条试验车行车基准线、l.两条基准线的间距、a.第一特征点、b.第二特征点。
具体实施方式
下面结合附图和实施例对本发明作进一步详细说明。
本发明提供的一种快速实现pos/激光雷达安装误差标定的方法包括下列步骤:
步骤1:选定合适的标校地物
(1.1)选定测量目标为图1所示的建筑物s,建筑物s的棱边垂直于地面,取棱边的某高端点作为第一特征点a,取棱边的某低端点作为第二特征点b。
(1.2)选定试验场地,试验场地为水平面,试验场地和建筑物s之间无遮挡,建筑物s的棱边垂直于试验场地,试验场地和建筑物s之间的距离小于激光雷达的测距长度。在试验场地上设置两条平行线,分别为第一条试验车行车基准线l1、第二条试验车行车基准线l2,两条基准线的间距为l。
步骤2:展外场车载试验,采集pos和雷达数据。
将pos和激光雷达分别刚性安装于试验车车顶,pos的前向轴方向、雷达的纵轴方向与试验车的前进方向三者同向安装。整个试验过程中pos和激光雷达两者之间没有相对位移。
启动试验车,同时采集、存储pos和雷达数据。试验车首先沿基准线l1朝一个方向直线行驶,到试验场地边缘后,调头,沿基准线l2朝另一个方向直线行驶,至试验场地边缘后,停车断电。
综合pos和雷达数据,获得在第一条试验车行车基准线l1中获得的建筑物s粗略三维位置坐标(x,y,z)和在第二条试验车行车基准线l2中获得的建筑物s粗略三维位置坐标(x’,y’,z’)。
步骤3:解算安装误差
(3.1)将步骤2获得的建筑物s粗略三维位置坐标(x,y,z)投影到wgs-84坐标系下,计算公式如下:
[xyz]t=c(δψ,δθ,δγ)[xyz]t
式中,
δψ为pos和雷达之间的航向安装误差角,δθ为俯仰安装误差角,δγ为滚动安装误差角,三个误差角的初始值均为0。
c为δψ→δθ→δγ获得方向余弦矩阵:
经过解算,分别得到建筑物s在wgs-84坐标系下的点云数据,并形成建筑物s在wgs-84坐标系下的图像。
在建筑物s在wgs-84坐标系下的图像中识别出第一特征点a和第二特征点b,将二者的坐标分别记作a(xa、ya、za)、b(xb、yb、zb)。
(3.2)标定滚动安装误差角
通过如下公式:
获得滚动安装误差角δγ。
将δγ带入步骤(3.1)的公式中,获得更新1次后的建筑物s在wgs-84坐标系下的点云数据和建筑物s在wgs-84坐标系下的图像,再次从图形中识别出a、b,坐标分别记作
(3.2)标定俯仰安装误差角
通过如下公式:
获得俯仰安装误差角δθ。
将δγ、δθ同时带入步骤(3.1)的公式中,建筑物s在wgs-84坐标系下的点云数据和建筑物s在wgs-84坐标系下的图像,再次从图形中识别出a、b,坐标分别记作
(3.3)标定航向安装误差角
对第二条试验车行车基准线l2中获得的建筑物s粗略三维位置坐标(x’,y’,z’)及更新后的δγ、δθ带入步骤(3.1)的公式中,得到a、b坐标,分别记作
通过如下公式:
获得航向安装误差角δψ。
至此,实现pos和激光雷达之间三个安装误差角δγ、δθ、δψ的离线快速标定。
上面结合附图和实施例对本发明作了详细说明,但是本发明并不限于上述实施例,在本领域普通技术人员所具备的知识范围内,还可以在不脱离本发明宗旨的前提下作出各种变化。本发明中未作详细描述的内容均可以采用现有技术。