基于改进李群非线性优化的行车吊臂空间位姿测量方法

摘要

本发明公开了一种基于改进李群非线性优化的行车吊臂空间位姿测量方法，包括：S1：利用相机采集合作四个呈矩形分布的靶标目标点，并对采集到的图像中红外光标提取四个重心坐标；S2：对采集相机进行内外参数标定，确定成像中心、畸变系数，对步骤S1采集到的图像做成像畸变参数矫正；S3：将相机与合作靶标的相对位姿问题转换为最小化重投影问题；S4：利用EPNP法计算相机相对位姿初始旋转矩阵和平移量；S5：利用高斯牛顿法进行非线性迭代后最终收敛到真实解，得到旋转矩阵和平移量。本发明不仅提高了测量结果的精度，还提高了检测和计算速度，可以进行快速的目标检测和空间参数获取，提升了无人行车吊臂空间角度测量的实时性和准确性。