蛇形机器人互补滤波和四元数的姿态解算*
2014-07-07王超杰时佳斌
传感器与微系统 2014年10期
关键词:融合
王超杰,苏 中,时佳斌,陈 庚
(北京信息科技大学 高动态导航技术北京市重点实验室,北京100101)
蛇形机器人互补滤波和四元数的姿态解算*
王超杰,苏 中,时佳斌,陈 庚
(北京信息科技大学 高动态导航技术北京市重点实验室,北京100101)
针对蛇形机器人姿态解算问题,陀螺存在漂移特性,加速度计的测量值包含重力加速度和运动加速度,磁强计易受周围环境地磁干扰,并且蛇形机器人采用嵌入式微处理器,需要减少计算量。设计了用互补滤波器来实现惯性传感器的数据融合,用四元数进行姿态解算的方法。经过实验验证表明:采用互补滤波和四元数进行姿态解算能有效融合各个惯性传感器的数据,计算量小,能够满足蛇形机器人对精度和实时性的要求。
蛇形机器人;姿态解算;互补滤波器;惯性传感器;四元数
0 引 言
蛇形机器人由于具有广阔的应用前景,使其成为了当前的研究热点。其中,姿态检测是控制机器人在未知环境空间运动的关键问题之一,通过融合各种传感器的数据来获取机器人的运动姿态,进而实现对机器人的运动控制与路径规划。姿态解算的精度和速度将直接影响对蛇形机器人的控制的稳定性和可靠性。随着MEMS技术的发展与对成本因素的考虑,低成本的捷联惯性测量单元越来越多的被应用到移动机器人中,其主要包括陀螺仪、加速度计和磁强计[1]。MEMS陀螺仪具有漂移特性,加速度计的测量值中同时包含了重力加速度和运动加速度,同时磁强计容易受到周围环境中外部磁场的干扰。……
登录APP查看全文
