基于多传感器数据融合的巡检机器人测姿系统研究

作     者：樊志强 董朝轶 王启来 母英泽 李柏辰 陈旗鸣 FAN Zhiqiang;DONG Chaoyi;WANG Qilai;MU Yingze;LI Bochen;CHEN Qiming

作者机构：内蒙古工业大学电力学院呼和浩特010080 内蒙古机电控制重点实验室呼和浩特010051 

基　　金：国家自然科学基金内蒙古科技成果转化项目(No.CGZH2018129) 内蒙古自治区高等学校科学研究项目(No.NJZY16093) 第五批“草原英才”工程培养高层次人才、2015年度内蒙古自治区高等学校青年科技英才计划项目(No.NJYT-15-A05)的资助 

出 版 物：《自动化与仪器仪表》 (Automation & Instrumentation)

年 卷 期：2021年第3期

页      码：77-82,86页

摘      要：针对当前电力巡检机器人实时姿态测量和导航控制问题,设计了基于STM32F767和MEMS传感器ADIS16405的捷联惯导姿态测量系统。在姿态解算中单独使用陀螺仪或加速度计和磁力计求解姿态角存在精度较低、易受外界条件的干扰、稳定性差等问题,采用卡尔曼滤波并将多传感器的数据进行融合的方法可有效地避免上述问题。首先,STM32F767与ADIS16405通过SPI通信协议采集角速度、加速度、磁感应强度等数据,并进行姿态解算。然后,利用MEMS陀螺仪的数据建立四元数方程,使用四阶龙格-库塔法求解姿态角,根据加速度计和磁力计采集的数据作为观测值进行卡尔曼滤波。将卡尔曼滤波和互补滤波融合后的姿态角的精度进行比较,转台仿真实验表明:卡尔曼滤波的精度较高,角度误差保持在1°以内。因此,融合后的数据有效地抑制了噪声,提高了姿态角的解算精度。

主 题 词：巡检机器人 姿态解算 ADIS1405 卡尔曼滤波 互补滤波 

学科分类：080202[080202] 08[工学] 0802[工学-机械学] 

D　O　I：10.14016/j.cnki.1001-9227.2021.03.077

馆 藏 号：203102662...