一种基于改进互补滤波的人体运动姿态解算方法

摘要

本发明公开一种基于改进互补滤波的人体运动姿态解算方法，1：分别建立陀螺仪和加速度计的量测模型，将MIMU固定在人体上，采集人体运动的加速度和角速率；2：利用MIMU所采集的角速率求解姿态四元数微分方程，获得人体先验姿态；3：将人体先验姿态代入加速度计的量测模型计算当前时刻加速度估计值，利用当前时刻加速度与所求得的加速度估计值计算出姿态误差角速率；4：判断此时人体运动状态，若静止，则直接使用姿态误差角速率对角速率进行补偿；若运动，则将姿态误差角速率经PI控制器处理后获得补偿信息，再对角速率进行补偿；5：利用补偿后的角速率更新姿态四元数微分方程，获得人体后验姿态，本发明能够高效地补偿角速率误差，提高解算精度。