基于凸松弛全局优化算法的视觉测量位姿估计

摘要

针对参考点存在较大噪声时基于光束法平差的视觉测量位姿估计无法确保目标函数在全局极小处收敛,本文提出利用凸松弛(LMI)全局优化算法进行视觉测量全局最优位姿估计。利用归一化图像点和摄像机光心组成的正交投影矩阵,构造以旋转矩阵四元数为参数的物空间误差目标非凸多项式函数。对非凸多项式进行LMI,可以逼近其全局极小值,进而求解出全局最优旋转矩阵和平移矢量。数值仿真表明,通过与正交迭代全局优化算法比较,本文算法可以求得全局最优解,结果稍优于光束法平差。利用实物实验,验证了算法的可行性。