一种基于角速度差值的方向修正方法
摘要:
本发明公开了一种基于角速度差值的方向修正方法,包括以下步骤:将东北天坐标系中输出的加速度转化到载体坐标系中,获取加速度计的第一误差向量;将电子罗盘在载体坐标的输出经过旋转到东北天坐标系中,获取磁场向量的第二误差向量;将经过加速度数据和磁场数据补偿之后的第一误差向量和第二误差向量相加获取误差;根据误差修正陀螺仪的角速度值,获取修正后的角速度,利用修正后的角速度更新四元数;通过修正后的角速度,采用积分方法计算载体的方向角度信息。本发明通过结合四元数互补滤波和角速度差值计算方向角度,减小算法的复杂度,并通过改进积分方法,减小传感器本身存在随机常值偏移对角度计算造成的影响,提高角度计算的精度,进而提高室内定位的精确度。
公开/授权文献
0/0