一种基于卡尔曼滤波器的智能手机姿态估算算法

摘要

利用内置陀螺仪估算姿态可实现基于智能手机的惯性导航系统,但测量噪声导致姿态无限漂移,使得基于智能手机的惯性导航系统具有一定的局限.根据该不足,提出一种基于卡尔曼滤波的姿态估算算法,通过融合陀螺仪的姿态估算结果和加速度计的测量结果得到高精度的智能手机姿态,并利用集成在智能手机的惯性导航算法得到参考姿态,避免使用较昂贵的测量设备.首先介绍了一种智能手机和内置惯性传感器的初始参数,用于计算智能手机的姿态.然后比较了6次从自由落体到静止和绕x轴缓慢旋转360°场景时智能手机的参考姿态、基于陀螺仪的估算姿态和基于推荐算法的姿态.实验结果表明基于推荐算法的智能手机姿态精度最高且没有漂移现象,该结果论证了本工作对提高智能手机姿态的精度具有可行性.