PX4 EKF2 源碼解析(九):通用觀測更新內核 `measurementUpdate() 發布時間:2026/8/27 11:26:55 建盈捌捌建站 PX4 EKF2 源碼解析(九):通用觀測更新內核measurementUpdate()摘要不同傳感器具有不同觀測模型,但最終都要完成協方差和狀態更新。本文以標量觀測為對象,解析創新方差、卡爾曼增益、狀態抑制、協方差健康檢查和fuse(),建立各*_fusion.cpp的統一閱讀模板。1. 標量觀測更新對單個觀測分量:ν=h(x)?z,S=HPHT+R,K=PHT/S \nu=h(x)-z, \quad S=HPH^T+R, \quad K=PH^T/Sν= 商務建站 企業官網 運營推廣 返回列表 PREV 查看更多資訊 NEXT 返回資訊列表