同时考虑测角与定位误差的相机姿态估计算法

针对测角误差与定位误差对精度的影响持平的高精度场合, 提出了能够同时考虑测角误差与定位误差的相机姿态估计算法。在传统最小二乘平差相机姿态估计算法的迭代过程中, 将定位误差的协方差投影到单位球面上并与测角误差的协方差融合; 用块松弛迭代法解决投影过程依赖于待估计参数的问题; 用融合后的协方差作为权重构建加权最小二乘平差方程; 从平差方程中解出融合定位与测角误差的相机姿态在当前迭代状态下的估计值。该方法统一了位置测量误差模型与角度测量误差模型, 实验结果表明其可有效应用于导弹发射车定向系统。