发明名称 |
一种基于角速度差值的方向修正方法 |
摘要 |
本发明公开了一种基于角速度差值的方向修正方法,包括以下步骤:将东北天坐标系中输出的加速度转化到载体坐标系中,获取加速度计的第一误差向量;将电子罗盘在载体坐标的输出经过旋转到东北天坐标系中,获取磁场向量的第二误差向量;将经过加速度数据和磁场数据补偿之后的第一误差向量和第二误差向量相加获取误差;根据误差修正陀螺仪的角速度值,获取修正后的角速度,利用修正后的角速度更新四元数;通过修正后的角速度,采用积分方法计算载体的方向角度信息。本发明通过结合四元数互补滤波和角速度差值计算方向角度,减小算法的复杂度,并通过改进积分方法,减小传感器本身存在随机常值偏移对角度计算造成的影响,提高角度计算的精度,进而提高室内定位的精确度。 |
申请公布号 |
CN105910606A |
申请公布日期 |
2016.08.31 |
申请号 |
CN201610470880.8 |
申请日期 |
2016.06.20 |
申请人 |
天津大学 |
发明人 |
刘安安;陈亚伟;苏育挺;赵泽;马宜科;靳国庆;崔洪亮;孔祥兵 |
分类号 |
G01C21/20(2006.01)I;G01C21/16(2006.01)I;G01C25/00(2006.01)I |
主分类号 |
G01C21/20(2006.01)I |
代理机构 |
天津市北洋有限责任专利代理事务所 12201 |
代理人 |
李林娟 |
主权项 |
一种基于角速度差值的方向修正方法,其特征在于,所述方法包括以下步骤:将东北天坐标系中输出的加速度转化到载体坐标系中,获取加速度计的第一误差向量;将电子罗盘在载体坐标的输出经过旋转到东北天坐标系中,获取磁场向量的第二误差向量;将经过加速度数据和磁场数据补偿之后的第一误差向量和第二误差向量相加获取误差;根据误差修正陀螺仪的角速度值,获取修正后的角速度,利用修正后的角速度更新四元数;通过修正后的角速度,采用积分方法计算载体的方向角度信息; |
地址 |
300072 天津市南开区卫津路92号 |