一种小型四足机器人全局视觉定位方法和系统

摘要

本发明公开了一种小型四足机器人全局视觉定位方法和系统，该方法包括以下步骤：标定双摄像头系统，计算双摄像头系统运动模型参数；获取标定好的鱼眼摄像头拍摄的目标区域图像；对目标区域图像进行处理，得到待定位目标在鱼眼摄像头坐标系中的位置，通过双摄像头系统运动学模型计算待定位目标在云台坐标系中的空间位置，并进行二自由度运动学反解，得到二自由度关节转角；获取待定位目标图像，并对待定位目标图像中的二维码进行检测，得到二维码中心点在待定位图像中的二维坐标，经过变换得到二维码中心点在地面坐标系中二维坐标；对二维码中心点在地面坐标系中二维坐标进行校正，得到待定位目标在地面坐标系中的位置和朝向。