基于多传感器融合的航天器间位姿参数估计

提出了利用单目视觉与激光测距仪混合的航天器间相对位置和姿态参数测量的解析算法。首先利用四元数测量算法,采用5个非共面特征光点和单目视觉获取航天器间相对位置和姿态参数的解析解,并对解析解进行修正;然后,将上述6D位姿参数与激光测距仪获取的1D距离进行融合,以进一步对6D位姿参数进行修正。最后,通过计算实例对该算法进行数学仿真,仿真结果表明:该算法保证了在相机标定和特征光点提取及匹配较大误差下的位姿参数的估计精度,能够满足航天器相对位姿确定精度和实时计算要求。