基于AFCKF的捷聯(lián)旋轉(zhuǎn)彈視線(xiàn)角速率濾波算法

打開(kāi)文本圖片集

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