基于单位四元数的无初值依赖空间后方交会

为解决基于欧拉角的传统空间后方交会算法对初值强烈依赖的问题,提出一种利用四元数描述姿态的解算方法。本算法采用单位四元数描述旋转矩阵,然后对严格的共线条件方程进行线性化,并按照带有约束条件的间接平差进行迭代解算。试验表明本算法的可靠性和稳定性不依赖于像片位置和姿态的初值,并具有迭代次数少和解算时间短等优点。