[发明专利]基于目标特征的单目视觉快速相对位姿估计系统及方法

摘要

本发明涉及一种基于目标特征的单目视觉快速相对位姿估计系统及方法，包括：目标图像预处理单元，用于去除背景中的噪声，定位目标所在局部区域；目标快速特征检测及提取单元，用于完成局部轮廓和对接圆面特征的检测提取；目标位置和姿态估计单元，用于分别根据提取的对接圆面和轮廓特征完成目标位置和姿态粗值的估计，并采用优化算法实现最终目标位置和姿态的实时获取。本发明具有实时性好、鲁棒性强及测量精度高等优点，为后续空间在轨操控任务的顺利实施提供位姿信息支持。

主权项

1.基于目标特征的单目视觉快速相对位姿估计系统，其特征在于，包括目标图像预处理单元、目标快速特征检测及提取单元、目标位置和姿态估计单元，目标图像预处理单元去除背景中的噪声，定位目标所在局部区域；目标快速特征检测及提取单元，用于完成局部轮廓特征和对接圆面特征的检测提取，首先对初始帧目标区域局部小窗边缘轮廓特征进行检测及提取，其次根据初始帧得到的目标轮廓信息，从第二帧开始，结合目标运动变化特性，利用前一帧图像的轮廓信息确定目标在当前帧图像中的位置，并基于当前窗口目标本体区域中的四方向条带状区域完成当前帧目标轮廓特征的检测及提取；最后根据当前帧目标轮廓确定的区域进行边缘检测，以较长圆弧边缘且与区域中心平均欧式距离最小为约束条件完成当前帧目标区域对接圆面特征的检测，并采用基于几何距离的最小二乘椭圆拟合算法完成对接圆面特征的提取；目标位置和姿态估计单元，用于分别根据提取的对接圆面和轮廓特征完成目标位置和姿态粗值的估计，并采用优化算法实现最终目标位置和姿态的实时获取，首先基于轮廓特征获得的特征点完成目标三个姿态的初值的解算，其次利用给定空间对接环的半径和相机内参，完成空间对接环法向量和圆心坐标的求解，并基于轮廓特征求解的目标法向量去除解的二义性，完成目标三个位置的初值的解算；最后以特征点的重投影误差为目标函数，优化位置和姿态初值，获得精确的相对位姿估计信息。