[发明专利]一种自适应梯度下降惯性测量单元的姿态解算方法及系统

摘要

本发明涉及一种自适应梯度下降惯性测量单元的姿态解算方法，包括：步骤S1、获取惯性测量单元的输入数据并进行预处理，得到归一化后的角速度四元数更新值以及归一化后的加速度；步骤S2、利用归一化后的角速度四元数更新值求解预测角速度四元数qPre；步骤S3、利用预测角速度四元数qPre对加速度进行修正及归一化处理，得到归一化后的修正加速度求解梯度方向后归一化处理得到归一化后的梯度方向步骤S4、基于遗传算法对模糊系统进行调参；根据前N个时刻归一化后的修正加速度平均值和标准差，采用模糊系统求得自适应系数w；步骤S5、互补滤波法求解下一时刻的角速度四元数精确值Qexact。与现有技术相比，本发明具有精确度高的优点。