【CN110118572A】多目立体视觉与惯性导航系统及相对位姿参数确定方法【专利】

  • 格式:pdf
  • 大小:789.92 KB
  • 文档页数:16

(19)中华人民共和国国家知识产权局
(12)发明专利申请
(10)申请公布号 (43)申请公布日 (21)申请号 201910379392.X
(22)申请日 2019.05.08
(71)申请人 北京建筑大学
地址 100044 北京市西城区西外展览路1号
(72)发明人 邱冬炜 李少甫 王来阳 李瑞杰 
王彤 许豪 
(74)专利代理机构 北京汇泽知识产权代理有限
公司 11228
代理人 刘淑敏
(51)Int.Cl.
G01C 25/00(2006.01)
G01C 21/16(2006.01)
(54)发明名称多目立体视觉与惯性导航系统及相对位姿参数确定方法(57)摘要本申请涉及一种多目立体视觉与惯性导航系统及相对位姿参数确定方法,其中,相对位姿参数确定方法,包括:通过多目立体视觉系统的多个相机获取多个标定点的测量像素坐标,通过惯性导航系统获取多个标定点的测量惯性坐标;使用多个标定点的测量像素坐标,基于多目立体视觉系统的相机畸变系数和深度测量误差约束,确定多个标定点的修正相机坐标;基于惯性导航系统的误差修正多个标定点的测量惯性坐标,得到多个标定点的修正惯性坐标;基于多个标定点的修正惯性坐标和修正相机坐标,确定多目立体视觉与惯性导航系统的相对位姿参数。

其解决了空间点精度分布不均以及惯性导航系统缺乏自主性误差补偿的问题,优化了相对位姿参数的标
定结果。

权利要求书2页 说明书9页 附图4页CN 110118572 A 2019.08.13
C N 110118572
A
权 利 要 求 书1/2页CN 110118572 A
1.一种多目立体视觉与惯性导航系统的相对位姿参数确定方法,其特征在于,包括:
通过多目立体视觉系统的多个相机获取多个标定点的测量像素坐标,通过惯性导航系统获取所述多个标定点的测量惯性坐标;
使用所述多个标定点的测量像素坐标,基于所述多目立体视觉系统的相机畸变系数和深度测量误差约束,确定所述多个标定点的修正相机坐标;
基于所述惯性导航系统的误差修正所述多个标定点的所述测量惯性坐标,得到所述多个标定点的修正惯性坐标;
基于所述多个标定点的所述修正惯性坐标和所述修正相机坐标,确定所述多目立体视觉与惯性导航系统的相对位姿参数,其中,所述相对位置参数包括:相机坐标变换到惯性坐标的旋转参数和所述相机坐标变换到惯性坐标的平移参数。

2.根据权利要求1所述的多目立体视觉与惯性导航系统的相对位姿参数确定方法,其特征在于,所述相对位姿参数还包括:所述相机坐标到惯性坐标的比例因子。

3.根据权利要求1或2所述的多目立体视觉与惯性导航系统的相对位姿参数确定方法,其特征在于,使用所述多个标定点的测量像素坐标,基于所述多目立体视觉系统的相机畸变系数和深度测量误差约束,确定所述多个标定点的修正相机坐标,包括:基于所述多目立体视觉系统的相机畸变系数修正所述多个标定点的所述测量像素坐标,得到所述多个标定点的修正像素坐标;
基于标定点的修正像素坐标确定对应标定点的测量深度信息;
基于标定点的深度测量误差约束修正所述测量深度信息,得到对应标定点的修正深度信息;
基于标定点的所述修正像素坐标和所述修正深度信息将对应标定点的像素坐标转换为相机坐标,得到所述多个标定点的修正相机坐标。

4.根据权利要求3所述的多目立体视觉与惯性导航系统的相对位姿参数确定方法,其特征在于,所述相机畸变系数包括:径向畸变系数、切向畸变系数和薄棱镜畸变系数;其中,基于所述多目立体视觉系统的相机畸变系数修正所述多个标定点的所述测量像素坐标,得到所述多个标定点的修正像素坐标,包括:
基于所述径向畸变系数确定每个标定点的测量像素坐标的径向畸变参数;
基于所述切向畸变系数确定每个标定点的测量像素坐标的切向畸变参数;
基于所述薄棱镜畸变系数确定每个标定点的测量像素坐标的薄棱镜畸变参数;
基于标定点的所述薄棱镜畸变参数、所述切向畸变参数和所述径向畸变参数修正对应标定点的测量像素坐标,得到所述多个标定点的修正像素坐标。

5.根据权利要求2所述的多目立体视觉与惯性导航系统的相对位姿参数确定方法,其特征在于,
相机坐标变换到惯性坐标满足如下约束条件:P INS=λ(R*P MSV+T),其中,P INS为标定点的修正惯性坐标,P MSV为标定点的修正相机坐标,R为所述旋转参数,T为所述平移参数,λ为比例因子;
其中,基于所述多个标定点的所述修正惯性坐标和所述修正相机坐标,按照所述约束条件确定所述多目立体视觉与惯性导航系统的相对位姿参数。

6.根据权利要求2所述的多目立体视觉与惯性导航系统的相对位姿参数确定方法,其
2。