| 引用本文: | 冯国虎,吴文启.基于对偶四元数的单目视觉/惯性组合导航算法.[J].国防科技大学学报,2012,34(3):80-84.[点击复制] |
| FENG Guohu,WU Wenqi.Algorithm for monocular camera/SINS integrated navigation based-on dual quaternion[J].Journal of National University of Defense Technology,2012,34(3):80-84[点击复制] |
|
| |
|
|
| 本文已被：浏览 7842次 下载 6426次 |
| 基于对偶四元数的单目视觉/惯性组合导航算法 |
| 冯国虎, 吴文启 |
|
(国防科技大学 机电工程与自动化学院，湖南 长沙 410073)
|
| 摘要: |
| 提出一种适用于结构化道路的单目视觉/惯性组合导航定位算法。针对点特征匹配和连续多帧追踪受车速和相机视野制约的不足，提取道路上车道线的直线特征，引入对偶四元数描述直线特征。在基于对偶四元数的相对位姿估计算法的基础上，推导了图像特征增量与相机位姿增量的表达式。通过配准和时间同步，用惯导系统和相机分别解算的载体速度之差作为组合导航的观测量，建立kalman滤波修正组合导航系统的误差，包括相机测速标度因数误差。车载实验结果表明在结构化道路上算法是有效的。 |
| 关键词: 结构化道路 单目视觉 SINS 对偶四元数 组合导航 |
| DOI： |
| 投稿日期： |
| 基金项目:高等学校博士学科点专项科研基金资助项目（20069998009）；教育部新世纪优秀人才支持计划(NCET-07-0225) |
|
| Algorithm for monocular camera/SINS integrated navigation based-on dual quaternion |
| FENG Guohu, WU Wenqi |
|
(College of Mechatronics Engineering and Automation, National University of Defense Technology, Changsha 410073, China)
|
| Abstract: |
| An algorithm of monocular camera/SINS integrated navigation is presented for structural road. In order to overcome the difficulties of point features matching and tracking, which are restricted by carrier velocity and camera view, line features are extracted from the lane marks on the road. The line features are represented by dual quaternion. Compared with the relative pose estimation algorithm based on dual quaternion, the proposed algorithm deduced the formula of image feature increment and camera position increment. After registration and time synchronization, the velocity computation difference between the SINS and the camera was chosen as observation of integrated navigation. A Kalman filter was used to correct the integrated navigation error including the camera scale factor error of velocity measurement. The experiment results show that the proposed algorithm is accurate for structural road. |
| Keywords: structural road monocular camera SINS dual quaternion integrated navigation |
|
|
