基于AFCKF的捷聯旋轉彈視線角速率濾波算法

打開文本圖片集

摘 要：針對捷聯旋轉彈輸出的視線角速率與姿態(tài)誤差強耦合的問題， 提出一種基于自適應漸消容積卡爾曼濾波（AFCKF）的方法。 為實現彈目視線角速率的解耦， 考慮彈目相對運動特性， 構建包含末制導段視線角速率估計模型的狀態(tài)模型， 并根據幾何關系建立了包含彈目視線角和姿態(tài)角的量測模型。 為解決旋轉彈下傳統CKF視線角速率估計結果的發(fā)散導致濾波失效， 引入基于殘差序列的漸消因子對預測狀態(tài)協方差進行調節(jié)以快速收斂估計結果。（剩余13605字）