双IMU单目视觉组合测量非惯性系下目标物位姿方法

摘要

本发明涉及惯性测量技术、视觉测量技术、组合测量技术，为准确测量非惯性系下目标物相对于运动参考系的位姿信息，本发明采用的技术方案是，双IMU单目视觉组合测量非惯性系下目标物位姿方法，根据两个惯性测量单元IMU输出的差异得到非惯性系下的目标物与运动参考系之间的相对角速度和相对加速度，相对角速度经过补偿并求出相对姿态角，相对加速度经过积分求出相对位置；利用单目视觉直接测出在非惯性系中目标物上的多特征点靶标相对摄像机坐标系的旋转矩阵和位置矢量，由旋转矩阵计算相对姿态角；统一两者测量结果到相同的坐标系，再根据数据融合方法最终实现相对位姿测量。本发明主要应用于位姿信息测量场合。