论文部分内容阅读
在机器人导航与运动控制中,实时获取运动姿态是不可缺少的重要步骤之一,尤其在自平衡移动机器人的平稳姿态控制中更为关键。自平衡移动机器人在实现各种复杂动作以及定向移动时需要时刻感知航向(yaw)、俯仰(pitch)以及滚转(roll)三个自由度的变化,并根据测量结果调整好自身的空间姿态,从而保持平稳运动,因此研究机器人运动姿态的实时测量技术有着十分重要的意义。首先本文采用低成本MEMS传感器件设计一种基于惯性导航技术的机器人姿态测量系统。系统硬件部分主要由数据采集与处理、MEMS传感器、数据存储、电压转换以及串口通信五个功能模块组成;而软件部分主要包括系统硬件底层驱动设计和数据融合算法实现。在姿态测量过程中,系统主控制器STM32F405RG通过SPI总线采集惯性测量单元MPU6000的角速率和加速度数据,同时通过IIC总线采集数字罗盘HMC5883L的地磁场数据,然后利用数据融合算法解算出机器人当前姿态,并且通过串口将更新的姿态发送至PC端实时显示。对于运动姿态实时更新,本文提出了两种基于四元数姿态的数据融合算法:梯度下降和互补滤波,并且在自行设计的姿态测量系统中进行验证与对比。由于陀螺仪侧重于动态性能,而加速度计与数字罗盘则更侧重于静态性能,因此数据融合算法的总体设计思路均为:对陀螺仪的角速率进行高速积分,同时将加速度计的重力场数据和数字罗盘的地磁场数据与角速率积分结果进行低速融合,从而不仅纠正了陀螺仪的漂移误差,还实现了三种传感器在组合应用中的优势互补。为了弥补惯性导航技术中惯性器件随机误差累积而导致测量精度下降的缺陷,本文最后还研究了基于双目立体视觉的姿态测量方法,且主要研究目标为实现惯性导航技术与双目立体视觉对机器人运动姿态的组合测量。双目立体视觉除了能够测量三维姿态,还可进行空间定位,因此被广泛应用于目标检测、跟踪与定位。在实验过程中,本文首先采用两个相同的摄像头采集16组左右图像,其次利用matlab进行摄像机参数标定,最后使用计算机视觉库(OpenCV)完成图像校正与匹配。