:協(xié)方差預測、過程噪聲與數(shù)值穩(wěn)定性)
PX4 EKF2 源碼解析(八):協(xié)方差預測、過程噪聲與數(shù)值穩(wěn)定性摘要狀態(tài)預測給出下一時刻的名義狀態(tài),協(xié)方差預測描述該結(jié)果可能有多大誤差。本文解釋 EKF2 的線性化傳播、IMU 噪聲和狀態(tài)隨機游走,并分析生成代碼、協(xié)方差對稱性及非負方差保護。1. 基本方程連續(xù)誤差模型離散化后,協(xié)方差預測為:Pk?=FkPk?1FkT+GkQkGkT P_k^-=F_kP_{k-1}F_k^T+G_kQ_kG_k^TP