公开(公告)号：CN108398128B

公开(公告)日：2021-08-24

申请号：CN201810060960.5

申请日：2018-01-22

Applicant: 北京大学深圳研究生院

Inventor： 时广轶 ,  谢偰伟 ,  国林旗

IPC: G01C21/20

Abstract: 一种姿态角的融合解算方法和装置，姿态角的融合解算方法包括：根据陀螺仪的测量数据解算出第一姿态角；根据加速度计的测量数据和磁力计的测量数据解算出第二姿态角；根据互补滤波原理对第一姿态角和第二姿态角进行融合计算，得到第三姿态角；以第三姿态角为第一状态变量且互补滤波后获得的第二姿态角为观测量，利用扩展卡尔曼滤波计算得到融合姿态角。由于将互补滤波和卡尔曼滤波相结合来解算姿态角，弥补了互补滤波和卡尔曼滤波各自的缺陷，既能够提高动态条件下姿态角的跟随性，又能够达到较快的收敛速度。

公开(公告)号：CN108398128A

公开(公告)日：2018-08-14

申请号：CN201810060960.5

申请日：2018-01-22

Applicant: 北京大学深圳研究生院

Inventor： 时广轶 ,  谢偰伟 ,  国林旗

IPC: G01C21/20

Abstract: 一种姿态角的融合解算方法和装置，姿态角的融合解算方法包括：根据陀螺仪的测量数据解算出第一姿态角；根据加速度计的测量数据和磁力计的测量数据解算出第二姿态角；根据互补滤波原理对第一姿态角和第二姿态角进行融合计算，得到第三姿态角；以第三姿态角为第一状态变量且互补滤波后获得的第二姿态角为观测量，利用扩展卡尔曼滤波计算得到融合姿态角。由于将互补滤波和卡尔曼滤波相结合来解算姿态角，弥补了互补滤波和卡尔曼滤波各自的缺陷，既能够提高动态条件下姿态角的跟随性，又能够达到较快的收敛速度。