CN108225371B - 一种惯导/相机安装误差标定方法 - Google Patents

一种惯导/相机安装误差标定方法 Download PDF

Info

Publication number
CN108225371B
CN108225371B CN201611150018.5A CN201611150018A CN108225371B CN 108225371 B CN108225371 B CN 108225371B CN 201611150018 A CN201611150018 A CN 201611150018A CN 108225371 B CN108225371 B CN 108225371B
Authority
CN
China
Prior art keywords
coordinate system
camera
calibration
inertial navigation
matrix
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201611150018.5A
Other languages
English (en)
Other versions
CN108225371A (zh
Inventor
刘崇亮
刘垒
扈光锋
曲雪云
周东灵
林翰
徐兴华
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Automation Control Equipment Institute BACEI
Original Assignee
Beijing Automation Control Equipment Institute BACEI
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Beijing Automation Control Equipment Institute BACEI filed Critical Beijing Automation Control Equipment Institute BACEI
Priority to CN201611150018.5A priority Critical patent/CN108225371B/zh
Publication of CN108225371A publication Critical patent/CN108225371A/zh
Application granted granted Critical
Publication of CN108225371B publication Critical patent/CN108225371B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass

Abstract

本发明属于视觉导航与组合导航技术领域,具体涉及一种惯导/相机安装误差标定方法。本方法包括如下步骤:步骤一、系统安装及其连接方式;步骤二、转台旋转并记录数据;步骤三、构建12个未知量的方程组并计算;步骤四、输出结果。本发明提出的标定方法无需激光扫描仪与差分卫星导航系统等繁重的设备,而是利用转台与标定板,在室内即可完成惯导与相机之间安装误差的标定,提高了工作效率,降低了标定成本。

Description

一种惯导/相机安装误差标定方法
技术领域
本发明属于视觉导航与组合导航技术领域,具体涉及一种惯导/相机安装误差标定方法。
背景技术
视觉导航以传感器获取的客观事物的视觉图像为基础,通过计算机来模拟人的视觉功能,对图像进行识别和理解,进而获取载体的导航信息。
视觉导航的传感器即光学相机。将惯导与相机捷联安装在一起,形成惯性/ 视觉组合导航系统,可以将惯性导航的绝对导航信息与视觉导航的相对导航信息进行融合,特别适用于无人机自主着陆、智能机器人导航、工业测量等领域。而惯性/视觉组合导航是建立在惯导/相机安装误差的精密标定基础上的。
惯导与相机捷联安装在一起,惯导坐标系与相机坐标系之间存在一个姿态转转与平移的关系,这个关系称之为相对姿态与相对位置,也称之为姿态安装误差与位置安装误差,统称为安装误差。
发明内容
根据上述问题,本发明提供一种惯导/相机安装误差标定方法,完成惯性/视觉组合导航系统中,惯导与相机姿态安装误差与位置安装误差的精密标定问题。
为了实现这一目的,本发明采取的技术方案是:
一种惯导/相机安装误差标定方法,该方法包括如下步骤:
步骤一、系统安装及其连接方式;步骤二、转台旋转并记录数据;步骤三、构建12个未知量的方程组并计算;步骤四、输出结果;
所述系统安装及其连接方式,将惯导与相机安装在转台上,将标定板放置在转台附近,且处于相机的视场范围内。
一种惯导/相机安装误差标定方法,步骤二、旋转转台并记录数据:
系统安装完成后,旋转转台4次,旋转时要求保证:
1、惯导与相机之间的相对位置与相对姿态不变;
2、标定板位置保持不变,从而保证转台与标定板之间的相对位置与相对姿态不变;
3、转台的XYZ三个轴同时旋转一定的角度(三个轴旋角的大小与方向不要求一致);
4、旋转时要求保证标定板不超出相机的视场范围;
记录4个状态下惯导与转台之间的标定矩阵
Figure GDA0003012612490000021
相机与标定板之间的标定矩阵
Figure GDA0003012612490000022
其中
Figure GDA0003012612490000023
通过光瞄与转台旋转参数获得,
Figure GDA0003012612490000024
通过高精度光学测量方法获得。
一种惯导/相机安装误差标定方法,步骤三、构建12个未知量的方程组并计算:
假设某空间点P由坐标系a中的坐标Pa转换为坐标系b中的坐标Pb,其过程可表示为,
Figure GDA0003012612490000025
公式(1),其中Pa=[xa,ya,za]T为空间点P在坐标系a中的坐标;
Figure GDA0003012612490000026
是一个平移向量,其中tx为由坐标系a向坐标系b平移过程中x方向的平移量,ty为由坐标系a向坐标系b平移过程中y方向的平移量,tz为由坐标系a向坐标系b 平移过程中z 方向的平移量;
Figure GDA0003012612490000027
是一个旋转矩阵,描述了从坐标系a向坐标系b的旋转过程,即坐标系a按
Figure GDA0003012612490000028
的旋转顺序,分别旋转
Figure GDA0003012612490000029
后,其三轴将与坐标系b平行,
Figure GDA0003012612490000031
Figure GDA0003012612490000032
Figure GDA0003012612490000033
T中的6个参数(α,β,γ,tx,ty,tz)描述了坐标系a与坐标系b之间的相对位置与相对姿态关系,安装误差标定就是要把这6个参数求解出来;
Figure GDA0003012612490000034
公式(1)可以整理成以下形式
Figure GDA0003012612490000035
其中
Figure GDA0003012612490000036
Figure GDA0003012612490000037
Figure GDA0003012612490000038
分别称为空间点P在坐标系a向坐标系b下的齐次坐标,
Figure GDA00030126124900000313
中的元素由标定参数计算而来,称之为标定矩阵;
将惯导与相机安装在转台上,将标定板放置在转台附近,且处于相机的视场范围内,转台、惯导、相机、标定板四者之间的关系可写成归一化矩阵连乘的形式:
Figure GDA00030126124900000310
式中:
Figure GDA00030126124900000311
矩阵,惯导与转台之间的标定矩阵,通过光瞄与转台旋转参数方法求得,已知量;
Figure GDA00030126124900000312
矩阵,惯导与相机之间的标定矩阵,未知量,待求;
Figure GDA0003012612490000041
矩阵,相机与标定板之间的标定矩阵,通过光学测量方法求得,已知量;
Figure GDA0003012612490000042
矩阵,标定板与转台之间的标定矩阵,未知量;
在上面的连乘公式中,
Figure GDA0003012612490000043
Figure GDA0003012612490000044
这两个未知的4×4矩阵中可以由
Figure GDA0003012612490000045
Figure GDA0003012612490000046
共12个未知量表示;
将式(6)写成以下形式:
Figure GDA0003012612490000047
可以整理出3个以
Figure GDA0003012612490000048
为变量的方程,分别表示为:
Figure GDA0003012612490000049
因此,得到该状态下12个未知量的3个方程;
转台旋转4次,每次都获得该状态下的3个方程,一共可以获得4个状态下12个未知量的12个方程,表示如下:
Figure GDA0003012612490000051
采用通用的矩阵分解法、最小二乘法求解以上线性方程组,得到线性方程组的解,获得
Figure GDA0003012612490000052
Figure GDA0003012612490000053
共12个未知量的值。
一种惯导/相机安装误差标定方法,步骤四、输出结果,将步骤三中的
Figure GDA0003012612490000054
)作为惯导与相机之间的安装误差输出。
本发明的有益效果为:
本发明提出的标定方法无需激光扫描仪与差分卫星导航系统等繁重的设备,而是利用转台与标定板,在室内即可完成惯导与相机之间安装误差的标定,提高了工作效率,降低了标定成本。
具体实施方式
本发明具体实施例如下:
一种惯导/相机安装误差标定方法,包括下述步骤:
(1)系统安装及其连接方式;(2)转台旋转并记录数据;(3)构建12个未知量的方程组并计算;(4)输出结果,完成惯导/相机安装误差标定。
步骤一:系统安装及其连接方式
将惯导与相机安装在转台上,将标定板放置在转台附近,且处于相机的视场范围内。
步骤二:旋转转台并记录数据
系统安装完成后,旋转转台4次,旋转时要求保证:
(1)惯导与相机之间的相对位置与相对姿态不变;
(2)标定板位置保持不变,从而保证转台与标定板之间的相对位置与相对姿态不变;
(3)转台的XYZ三个轴同时旋转一定的角度(三个轴旋角的大小与方向不要求一致);
(4)旋转时要求保证标定板不超出相机的视场范围。
记录4个状态下惯导与转台之间的标定矩阵
Figure GDA0003012612490000061
相机与标定板之间的标定矩阵
Figure GDA0003012612490000062
其中
Figure GDA0003012612490000063
通过光瞄与转台旋转参数获得,
Figure GDA0003012612490000064
通过高精度光学测量方法获得。
步骤三:构建12个未知量的方程组并计算
假设某空间点P由坐标系a中的坐标Pa转换为坐标系b中的坐标Pb,其过程可表示为
Figure GDA0003012612490000065
公式(1),其中Pa=[xa,ya,za]T为空间点P在坐标系a中的坐标;
Figure GDA0003012612490000066
是一个平移向量,其中tx为由坐标系a向坐标系b平移过程中x方向的平移量,ty为由坐标系a向坐标系b平移过程中y方向的平移量,tz为由坐标系a向坐标系b 平移过程中z 方向的平移量;
Figure GDA0003012612490000067
是一个旋转矩阵,描述了从坐标系a向坐标系b的旋转过程,即坐标系a按
Figure GDA0003012612490000068
的旋转顺序,分别旋转
Figure GDA0003012612490000069
后,其三轴将与坐标系b平行,
Figure GDA0003012612490000071
Figure GDA0003012612490000072
Figure GDA0003012612490000073
T中的6个参数(α,β,γ,tx,ty,tz)描述了坐标系a与坐标系b之间的相对位置与相对姿态关系,安装误差标定就是要把这6个参数求解出来。
Figure GDA0003012612490000074
公式(9)可以整理成以下形式
Figure GDA0003012612490000075
其中
Figure GDA0003012612490000076
Figure GDA0003012612490000077
Figure GDA0003012612490000078
分别称为空间点P在坐标系a向坐标系b下的齐次坐标,
Figure GDA00030126124900000711
中的元素由标定参数计算而来,称之为标定矩阵。
在本发明中,需要用到转台、惯导、相机、标定板四个装置,假设这4个装置分别定义了四个坐标系,分别称之为坐标系base、坐标系imu、坐标系cam、坐标系cal。
将惯导与相机安装在转台上,将标定板放置在转台附近,且处于相机的视场范围内,转台、惯导、相机、标定板四者之间的关系可写成归一化矩阵连乘的形式:
Figure GDA00030126124900000710
式中:
Figure GDA0003012612490000081
矩阵,惯导与转台之间的标定矩阵,通过光瞄与转台旋转参数方法求得,已知量;
Figure GDA0003012612490000082
矩阵,惯导与相机之间的标定矩阵,未知量,待求;
Figure GDA0003012612490000083
矩阵,相机与标定板之间的标定矩阵,通过光学测量方法求得,已知量;
Figure GDA0003012612490000084
矩阵,标定板与转台之间的标定矩阵,未知量。
在上面的连乘公式中,
Figure GDA0003012612490000085
Figure GDA0003012612490000086
这两个未知的4×4矩阵中可以由
Figure GDA0003012612490000087
Figure GDA0003012612490000088
共12个未知量表示。
将式(14)写成以下形式:
Figure GDA0003012612490000089
可以整理出3个以
Figure GDA00030126124900000810
为变量的方程,分别表示为:
Figure GDA00030126124900000811
因此,得到该状态下12个未知量的3个方程。
转台旋转4次,每次都获得该状态下的3个方程,一共可以获得4个状态下12个未知量的12个方程,表示如下:
Figure GDA0003012612490000091
采用通用的矩阵分解法、最小二乘法求解以上线性方程组,得到线性方程组的解,获得
Figure GDA0003012612490000092
Figure GDA0003012612490000093
共12个未知量的值。
步骤四:输出结果
将步骤三中的
Figure GDA0003012612490000094
作为惯导与相机之间的安装误差输出。

Claims (3)

1.一种惯导/相机安装误差标定方法,该方法包括如下步骤:
步骤一、系统安装及其连接方式;步骤二、转台旋转并记录数据;步骤三、构建12个未知量的方程组并计算;步骤四、输出结果;
其特征在于:所述系统安装及其连接方式,将惯导与相机安装在转台上,将标定板放置在转台附近,且处于相机的视场范围内;
步骤三、构建12个未知量的方程组并计算:
假设某空间点P由坐标系a中的坐标Pa转换为坐标系b中的坐标Pb,其过程可表示为,
Figure FDA0003012612480000011
公式(1),其中Pa=[xa,ya,za]T为空间点P在坐标系a中的坐标;
Figure FDA0003012612480000012
是一个平移向量,其中tx为由坐标系a向坐标系b平移过程中x方向的平移量,ty为由坐标系a向坐标系b平移过程中y方向的平移量,tz为由坐标系a向坐标系b平移过程中z方向的平移量;
Figure FDA0003012612480000013
是一个旋转矩阵,描述了从坐标系a向坐标系b的旋转过程,即坐标系a按
Figure FDA0003012612480000014
的旋转顺序,分别旋转
Figure FDA0003012612480000015
后,其三轴将与坐标系b平行,
Figure FDA0003012612480000016
Figure FDA0003012612480000017
Figure FDA0003012612480000018
T中的6个参数(α,β,γ,tx,ty,tz)描述了坐标系a与坐标系b之间的相对位置与相对姿态关系,安装误差标定就是要把这6个参数求解出来;
Figure FDA0003012612480000019
公式(1)整理成以下形式
Figure FDA00030126124800000110
其中
Figure FDA0003012612480000021
Figure FDA0003012612480000022
Figure FDA0003012612480000023
分别称为空间点P在坐标系a向坐标系b下的齐次坐标,
Figure FDA0003012612480000024
中的元素由标定参数计算而来,称之为标定矩阵;
将惯导与相机安装在转台上,将标定板放置在转台附近,且处于相机的视场范围内,转台、惯导、相机、标定板四者之间的关系可写成归一化矩阵连乘的形式:
Figure FDA0003012612480000025
式中:
Figure FDA0003012612480000026
——4×4矩阵,惯导与转台之间的标定矩阵,通过光瞄与转台旋转参数方法求得,已知量;
Figure FDA0003012612480000027
——4×4矩阵,惯导与相机之间的标定矩阵,未知量,待求;
Figure FDA0003012612480000028
——4×4矩阵,相机与标定板之间的标定矩阵,通过光学测量方法求得,已知量;
Figure FDA0003012612480000029
——4×4矩阵,标定板与转台之间的标定矩阵,未知量;
在上面的连乘公式中,
Figure FDA00030126124800000210
Figure FDA00030126124800000211
这两个未知的4×4矩阵中由
Figure FDA00030126124800000212
Figure FDA00030126124800000213
共12个未知量表示;
将式(6)写成以下形式:
Figure FDA00030126124800000214
整理出3个以
Figure FDA00030126124800000215
为变量的方程,分别表示为:
Figure FDA0003012612480000031
Figure FDA0003012612480000032
Figure FDA0003012612480000033
因此,得到该状态下12个未知量的3个方程;
转台旋转4次,每次都获得该状态下的3个方程,一共获得4个状态下12个未知量的12个方程,表示如下:
Figure FDA0003012612480000034
Figure FDA0003012612480000035
Figure FDA0003012612480000036
Figure FDA0003012612480000037
Figure FDA0003012612480000038
Figure FDA0003012612480000039
Figure FDA00030126124800000310
Figure FDA00030126124800000311
Figure FDA00030126124800000312
Figure FDA00030126124800000313
Figure FDA00030126124800000314
Figure FDA00030126124800000315
采用通用的矩阵分解法、最小二乘法求解以上线性方程组,得到线性方程组的解,获得
Figure FDA00030126124800000316
Figure FDA00030126124800000317
共12个未知量的值。
2.如权利要求1所述的一种惯导/相机安装误差标定方法,其特征在于,步骤二、旋转转台并记录数据:
系统安装完成后,旋转转台4次,旋转时要求保证:
1、惯导与相机之间的相对位置与相对姿态不变;
2、标定板位置保持不变,从而保证转台与标定板之间的相对位置与相对姿态不变;
3、转台的XYZ三个轴同时旋转一定的角度(三个轴旋角的大小与方向不要求一致);
4、旋转时要求保证标定板不超出相机的视场范围;
记录4个状态下惯导与转台之间的标定矩阵
Figure FDA0003012612480000041
相机与标定板之间的标定矩阵
Figure FDA0003012612480000042
其中
Figure FDA0003012612480000043
通过光瞄与转台旋转参数获得,
Figure FDA0003012612480000044
通过高精度光学测量方法获得。
3.如权利要求1所述的一种惯导/相机安装误差标定方法,其特征在于,步骤四、输出结果,将步骤三中的
Figure FDA0003012612480000045
作为惯导与相机之间的安装误差输出。
CN201611150018.5A 2016-12-14 2016-12-14 一种惯导/相机安装误差标定方法 Active CN108225371B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201611150018.5A CN108225371B (zh) 2016-12-14 2016-12-14 一种惯导/相机安装误差标定方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201611150018.5A CN108225371B (zh) 2016-12-14 2016-12-14 一种惯导/相机安装误差标定方法

Publications (2)

Publication Number Publication Date
CN108225371A CN108225371A (zh) 2018-06-29
CN108225371B true CN108225371B (zh) 2021-07-13

Family

ID=62638144

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201611150018.5A Active CN108225371B (zh) 2016-12-14 2016-12-14 一种惯导/相机安装误差标定方法

Country Status (1)

Country Link
CN (1) CN108225371B (zh)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109238309B (zh) * 2018-10-31 2023-12-26 中航航空服务保障(天津)有限公司 一种捷联航姿安装板校准装置及其校准方法
CN110132309B (zh) * 2019-06-05 2023-04-25 西京学院 一种采煤机摇臂惯性/视觉组合定姿装置标定方法
CN111486867B (zh) * 2020-03-19 2023-08-11 天津大学 一种视觉和惯性混合跟踪组件安装参数的标定装置及方法
CN112611361A (zh) * 2020-12-08 2021-04-06 华南理工大学 一种无人机机载测绘吊舱的摄像头安装误差测定方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102435188A (zh) * 2011-09-15 2012-05-02 南京航空航天大学 一种用于室内环境的单目视觉/惯性全自主导航方法
CN103630138A (zh) * 2013-12-09 2014-03-12 天津工业大学 基于摄像机头标定算法的无人机视觉导航方法
CN105067011A (zh) * 2015-09-15 2015-11-18 沈阳飞机工业(集团)有限公司 一种基于视觉标定及坐标转换的测量系统整体校准方法
CN105509765A (zh) * 2014-09-23 2016-04-20 北京自动化控制设备研究所 一种惯性/dvl/usbl安装误差标定方法
CN105606127A (zh) * 2016-01-11 2016-05-25 北京邮电大学 一种双目立体相机与惯性测量单元相对姿态标定方法
CN106153041A (zh) * 2015-03-30 2016-11-23 北京自动化控制设备研究所 一种基于多景深信息的视觉里程计测速方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2014130854A1 (en) * 2013-02-21 2014-08-28 Regents Of The Univesity Of Minnesota Extrinsic parameter calibration of a vision-aided inertial navigation system

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102435188A (zh) * 2011-09-15 2012-05-02 南京航空航天大学 一种用于室内环境的单目视觉/惯性全自主导航方法
CN103630138A (zh) * 2013-12-09 2014-03-12 天津工业大学 基于摄像机头标定算法的无人机视觉导航方法
CN105509765A (zh) * 2014-09-23 2016-04-20 北京自动化控制设备研究所 一种惯性/dvl/usbl安装误差标定方法
CN106153041A (zh) * 2015-03-30 2016-11-23 北京自动化控制设备研究所 一种基于多景深信息的视觉里程计测速方法
CN105067011A (zh) * 2015-09-15 2015-11-18 沈阳飞机工业(集团)有限公司 一种基于视觉标定及坐标转换的测量系统整体校准方法
CN105606127A (zh) * 2016-01-11 2016-05-25 北京邮电大学 一种双目立体相机与惯性测量单元相对姿态标定方法

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
Fast Relative Pose Calibration for Visual and Inertial Sensors;Kelly.J et al;《11th International Symposium on Experimental Robotics (ISER)》;20091231;第54卷;第1-11页 *
INS/Vision组合导航中视觉系统动态定位方法研究;陈林等;《传感技术学报》;20080131;第21卷(第1期);第187-191页 *
一种基于惯性/视觉信息融合的无人机自主着陆导航算法;刘畅等;《导航定时与授时》;20161130;第3卷(第6期);第6-11页 *

Also Published As

Publication number Publication date
CN108225371A (zh) 2018-06-29

Similar Documents

Publication Publication Date Title
CN110296691B (zh) 融合imu标定的双目立体视觉测量方法与系统
CN108225371B (zh) 一种惯导/相机安装误差标定方法
CN106767917B (zh) 一种斜置冗余惯导系统标定误差模型建模方法
CN108106637B (zh) 一种分布式pos的精度检校方法和装置
CN105486289B (zh) 一种激光摄影测量系统及相机标定方法
CN103991555A (zh) 一种用于飞机数字化装配的自动化测量方法
CN110987021B (zh) 一种基于转台基准的惯性视觉相对姿态标定方法
CN106643489A (zh) 一种基于激光跟踪仪的地面二维码标定方法及装置
CN101900552B (zh) 经纬摄像机摄像测量方法
CN103679693A (zh) 一种多相机单视图标定装置及其标定方法
CN112684432A (zh) 激光雷达标定方法、装置、设备及存储介质
CN106405581B (zh) 卫星结构变形引起的多类型载荷间耦合指向精度评估方法
CN111486867A (zh) 一种视觉和惯性混合跟踪组件安装参数的标定装置及方法
CN112229323B (zh) 基于手机单目视觉的棋盘格合作目标的六自由度测量方法及其应用
CN110793542A (zh) 一种基于广义探元指向角的面阵光学遥感卫星在轨几何定标方法
CN104913775A (zh) 无人机对地高度的测量方法、无人机定位方法及装置
CN113267794A (zh) 一种基线长度约束的天线相位中心校正方法及装置
KR102152217B1 (ko) Vr 장비와 ar 장비간의 좌표계 일치용 지그 및 이를 이용한 물리 공간 공유 방법
CN108489338B (zh) 红外导引头视线角速率精度测试方法及系统
CN111121818B (zh) 一种无人车中相机与二维码的标定方法
CN106248000B (zh) 零件孔轴线的测量方法
CN111220118B (zh) 基于视觉惯性导航系统的激光测距仪及测距方法
CN109931956B (zh) 捷联式三分量磁测系统中三轴磁力仪与惯导安装误差校正方法
CN109945824B (zh) 一种载机航向基准测量与传递的方法和系统
CN110954081A (zh) 一种磁罗盘快速校准装置及方法

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant