CN108225371B - 一种惯导/相机安装误差标定方法 - Google Patents
一种惯导/相机安装误差标定方法 Download PDFInfo
- 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
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
Landscapes
- Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Navigation (AREA)
- Gyroscopes (AREA)
Abstract
本发明属于视觉导航与组合导航技术领域,具体涉及一种惯导/相机安装误差标定方法。本方法包括如下步骤:步骤一、系统安装及其连接方式;步骤二、转台旋转并记录数据;步骤三、构建12个未知量的方程组并计算;步骤四、输出结果。本发明提出的标定方法无需激光扫描仪与差分卫星导航系统等繁重的设备,而是利用转台与标定板,在室内即可完成惯导与相机之间安装误差的标定,提高了工作效率,降低了标定成本。
Description
技术领域
本发明属于视觉导航与组合导航技术领域,具体涉及一种惯导/相机安装误差标定方法。
背景技术
视觉导航以传感器获取的客观事物的视觉图像为基础,通过计算机来模拟人的视觉功能,对图像进行识别和理解,进而获取载体的导航信息。
视觉导航的传感器即光学相机。将惯导与相机捷联安装在一起,形成惯性/ 视觉组合导航系统,可以将惯性导航的绝对导航信息与视觉导航的相对导航信息进行融合,特别适用于无人机自主着陆、智能机器人导航、工业测量等领域。而惯性/视觉组合导航是建立在惯导/相机安装误差的精密标定基础上的。
惯导与相机捷联安装在一起,惯导坐标系与相机坐标系之间存在一个姿态转转与平移的关系,这个关系称之为相对姿态与相对位置,也称之为姿态安装误差与位置安装误差,统称为安装误差。
发明内容
根据上述问题,本发明提供一种惯导/相机安装误差标定方法,完成惯性/视觉组合导航系统中,惯导与相机姿态安装误差与位置安装误差的精密标定问题。
为了实现这一目的,本发明采取的技术方案是:
一种惯导/相机安装误差标定方法,该方法包括如下步骤:
步骤一、系统安装及其连接方式;步骤二、转台旋转并记录数据;步骤三、构建12个未知量的方程组并计算;步骤四、输出结果;
所述系统安装及其连接方式,将惯导与相机安装在转台上,将标定板放置在转台附近,且处于相机的视场范围内。
一种惯导/相机安装误差标定方法,步骤二、旋转转台并记录数据:
系统安装完成后,旋转转台4次,旋转时要求保证:
1、惯导与相机之间的相对位置与相对姿态不变;
2、标定板位置保持不变,从而保证转台与标定板之间的相对位置与相对姿态不变;
3、转台的XYZ三个轴同时旋转一定的角度(三个轴旋角的大小与方向不要求一致);
4、旋转时要求保证标定板不超出相机的视场范围;
一种惯导/相机安装误差标定方法,步骤三、构建12个未知量的方程组并计算:
假设某空间点P由坐标系a中的坐标Pa转换为坐标系b中的坐标Pb,其过程可表示为,
公式(1),其中Pa=[xa,ya,za]T为空间点P在坐标系a中的坐标;是一个平移向量,其中tx为由坐标系a向坐标系b平移过程中x方向的平移量,ty为由坐标系a向坐标系b平移过程中y方向的平移量,tz为由坐标系a向坐标系b 平移过程中z 方向的平移量;是一个旋转矩阵,描述了从坐标系a向坐标系b的旋转过程,即坐标系a按的旋转顺序,分别旋转后,其三轴将与坐标系b平行,
令
公式(1)可以整理成以下形式
其中
将惯导与相机安装在转台上,将标定板放置在转台附近,且处于相机的视场范围内,转台、惯导、相机、标定板四者之间的关系可写成归一化矩阵连乘的形式:
式中:
将式(6)写成以下形式:
因此,得到该状态下12个未知量的3个方程;
转台旋转4次,每次都获得该状态下的3个方程,一共可以获得4个状态下12个未知量的12个方程,表示如下:
本发明的有益效果为:
本发明提出的标定方法无需激光扫描仪与差分卫星导航系统等繁重的设备,而是利用转台与标定板,在室内即可完成惯导与相机之间安装误差的标定,提高了工作效率,降低了标定成本。
具体实施方式
本发明具体实施例如下:
一种惯导/相机安装误差标定方法,包括下述步骤:
(1)系统安装及其连接方式;(2)转台旋转并记录数据;(3)构建12个未知量的方程组并计算;(4)输出结果,完成惯导/相机安装误差标定。
步骤一:系统安装及其连接方式
将惯导与相机安装在转台上,将标定板放置在转台附近,且处于相机的视场范围内。
步骤二:旋转转台并记录数据
系统安装完成后,旋转转台4次,旋转时要求保证:
(1)惯导与相机之间的相对位置与相对姿态不变;
(2)标定板位置保持不变,从而保证转台与标定板之间的相对位置与相对姿态不变;
(3)转台的XYZ三个轴同时旋转一定的角度(三个轴旋角的大小与方向不要求一致);
(4)旋转时要求保证标定板不超出相机的视场范围。
步骤三:构建12个未知量的方程组并计算
假设某空间点P由坐标系a中的坐标Pa转换为坐标系b中的坐标Pb,其过程可表示为
公式(1),其中Pa=[xa,ya,za]T为空间点P在坐标系a中的坐标;是一个平移向量,其中tx为由坐标系a向坐标系b平移过程中x方向的平移量,ty为由坐标系a向坐标系b平移过程中y方向的平移量,tz为由坐标系a向坐标系b 平移过程中z 方向的平移量;是一个旋转矩阵,描述了从坐标系a向坐标系b的旋转过程,即坐标系a按的旋转顺序,分别旋转后,其三轴将与坐标系b平行,
令
公式(9)可以整理成以下形式
其中
在本发明中,需要用到转台、惯导、相机、标定板四个装置,假设这4个装置分别定义了四个坐标系,分别称之为坐标系base、坐标系imu、坐标系cam、坐标系cal。
将惯导与相机安装在转台上,将标定板放置在转台附近,且处于相机的视场范围内,转台、惯导、相机、标定板四者之间的关系可写成归一化矩阵连乘的形式:
式中:
将式(14)写成以下形式:
因此,得到该状态下12个未知量的3个方程。
转台旋转4次,每次都获得该状态下的3个方程,一共可以获得4个状态下12个未知量的12个方程,表示如下:
步骤四:输出结果
Claims (3)
1.一种惯导/相机安装误差标定方法,该方法包括如下步骤:
步骤一、系统安装及其连接方式;步骤二、转台旋转并记录数据;步骤三、构建12个未知量的方程组并计算;步骤四、输出结果;
其特征在于:所述系统安装及其连接方式,将惯导与相机安装在转台上,将标定板放置在转台附近,且处于相机的视场范围内;
步骤三、构建12个未知量的方程组并计算:
假设某空间点P由坐标系a中的坐标Pa转换为坐标系b中的坐标Pb,其过程可表示为,
公式(1),其中Pa=[xa,ya,za]T为空间点P在坐标系a中的坐标;是一个平移向量,其中tx为由坐标系a向坐标系b平移过程中x方向的平移量,ty为由坐标系a向坐标系b平移过程中y方向的平移量,tz为由坐标系a向坐标系b平移过程中z方向的平移量;是一个旋转矩阵,描述了从坐标系a向坐标系b的旋转过程,即坐标系a按的旋转顺序,分别旋转后,其三轴将与坐标系b平行,
令
公式(1)整理成以下形式
其中
将惯导与相机安装在转台上,将标定板放置在转台附近,且处于相机的视场范围内,转台、惯导、相机、标定板四者之间的关系可写成归一化矩阵连乘的形式:
式中:
将式(6)写成以下形式:
因此,得到该状态下12个未知量的3个方程;
转台旋转4次,每次都获得该状态下的3个方程,一共获得4个状态下12个未知量的12个方程,表示如下:
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)
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)
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)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9243916B2 (en) * | 2013-02-21 | 2016-01-26 | Regents Of The University Of Minnesota | Observability-constrained vision-aided inertial navigation |
-
2016
- 2016-12-14 CN CN201611150018.5A patent/CN108225371B/zh active Active
Patent Citations (6)
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)
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标定的双目立体视觉测量方法与系统 | |
CN110695993B (zh) | 一种柔性机械臂同步测量方法、系统及装置 | |
CN108225371B (zh) | 一种惯导/相机安装误差标定方法 | |
CN109099883A (zh) | 高精度大视场机器视觉测量与标定装置及方法 | |
CN108106637B (zh) | 一种分布式pos的精度检校方法和装置 | |
CN103991555A (zh) | 一种用于飞机数字化装配的自动化测量方法 | |
CN106546172B (zh) | 基于非正交轴系激光全站仪的三维坐标测量方法 | |
CN108132029B (zh) | 一种卫星天线展开系统装配的精测方法及装置 | |
CN112684432A (zh) | 激光雷达标定方法、装置、设备及存储介质 | |
CN106643489A (zh) | 一种基于激光跟踪仪的地面二维码标定方法及装置 | |
CN101900552B (zh) | 经纬摄像机摄像测量方法 | |
CN110793542A (zh) | 一种基于广义探元指向角的面阵光学遥感卫星在轨几何定标方法 | |
CN111486867A (zh) | 一种视觉和惯性混合跟踪组件安装参数的标定装置及方法 | |
KR102152217B1 (ko) | Vr 장비와 ar 장비간의 좌표계 일치용 지그 및 이를 이용한 물리 공간 공유 방법 | |
CN108645392B (zh) | 一种相机安装姿态校准方法及装置 | |
CN108489338B (zh) | 红外导引头视线角速率精度测试方法及系统 | |
CN114659523A (zh) | 一种大范围高精度姿态测量方法及装置 | |
CN111121818B (zh) | 一种无人车中相机与二维码的标定方法 | |
CN106248000B (zh) | 零件孔轴线的测量方法 | |
CN111220118B (zh) | 基于视觉惯性导航系统的激光测距仪及测距方法 | |
CN109931956B (zh) | 捷联式三分量磁测系统中三轴磁力仪与惯导安装误差校正方法 | |
CN117553697A (zh) | 一种基于led的高速摄像测量方法及舱门形变测量系统 | |
Zhang et al. | Camera Calibration for Long‐Distance Photogrammetry Using Unmanned Aerial Vehicles | |
CN109945824B (zh) | 一种载机航向基准测量与传递的方法和系统 | |
CN108253931B (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 |