噪声自适应强跟踪扩展卡尔曼滤波器四旋翼姿态解算方法

    公开(公告)号:CN114964226A

    公开(公告)日:2022-08-30

    申请号:CN202210471564.8

    申请日:2022-04-29

    Applicant: 燕山大学

    Abstract: 本发明涉及一种噪声自适应强跟踪扩展卡尔曼滤波器四旋翼姿态解算方法,属于无人机技术领域,包括构建状态方程和观测方程,初始化系统噪声和量测噪声初值;计算下一时刻的一次预测状态;计算新息,更新强跟踪滤波器,将次优渐消因子拆分;计算得到改进的一步预测误差协方差矩阵对下一时刻的噪声方差及噪声均值重新估计,将估计值引入EKF公式;计算卡尔曼增益矩阵、状态的二次估计和误差协方差的二次估计,判断是否循环结束;输出结果。本发明引入强跟踪滤波器,解决了传统扩展卡尔曼滤波器因泰勒展开近似线性化等问题导致的跟踪能力弱的问题,通过改进次优渐消因子引入形式,保证了协方差矩阵计算结果的对称性,提高了系统跟踪速度。

    噪声自适应强跟踪扩展卡尔曼滤波器四旋翼姿态解算方法

    公开(公告)号:CN114964226B

    公开(公告)日:2024-09-20

    申请号:CN202210471564.8

    申请日:2022-04-29

    Applicant: 燕山大学

    Abstract: 本发明涉及一种噪声自适应强跟踪扩展卡尔曼滤波器四旋翼姿态解算方法,属于无人机技术领域,包括构建状态方程和观测方程,初始化系统噪声和量测噪声初值;计算下一时刻的一次预测状态;计算新息,更新强跟踪滤波器,将次优渐消因子拆分;计算得到改进的一步预测误差协方差矩阵对下一时刻的噪声方差及噪声均值重新估计,将估计值引入EKF公式;计算卡尔曼增益矩阵、状态的二次估计和误差协方差的二次估计,判断是否循环结束;输出结果。本发明引入强跟踪滤波器,解决了传统扩展卡尔曼滤波器因泰勒展开近似线性化等问题导致的跟踪能力弱的问题,通过改进次优渐消因子引入形式,保证了协方差矩阵计算结果的对称性,提高了系统跟踪速度。

Patent Agency Ranking