卡爾曼濾波器的應(yīng)用-閱讀頁
2025-06-02 18:14本頁面
【正文】 111 1 1 1323 3 2 2( 1 ) ( 1 )11[ ( 2) ( 1 ) ] [ ( 2) ( 1 ) ]? ( 2)( 2) ( 2)11[ ( 2) ( 1 ) ] [ ( 2) ( 1 ) ]svs s v vTTsvs s v vTT?????? ? ?????? ? ?????s1122 13324411211213442( 2) ( 1 ) 01 0 0( 2) ( 1 ) ( 1 )0 1 0 0( 2)0( 2) ( 1 )0 0 1( 1 )0 0 0 1( 2) ( 1 )( 2)( 1 ) ( 1 )1[ ( 2)( 1 ) ( 1 )( 1 ) ( 1 )( 1 ) ( 1 )ss Tss uss Tussss T ssssuTs T ssu? ? ? ? ????? ? ? ? ????? ? ? ? ????? ? ? ?? ? ? ? ????? ? ? ? ?????? ??? ? ? ????????????????????s133 3 2( 1 ) ] ( 1 )( 2)1[ ( 2) ( 1 ) ] ( 1 )uss s uT?????? ???????????????因此 , 由上式 , 可根據(jù)定義確定均方誤差 的初始值為 其中 , 和 通常是給定的 , 因而可計(jì)算 值 . 為了得到 值 , 需 指定 和 的方差 和 . 11 1 122 2 1( 2)1( 1 ) [ ( 2) ( 1 ) ]?( 2) ( 2)( 2)1( 1 ) [ ( 2) ( 1 ) ]vu v vTvu v vT????????????????????ss)(n?222 2 212222 2 2221001200( 2)1001200TT TTT T??????????? ? ???? ? ???????????2?? 2?? ()nQ ()nR1()un 2()un 21? 22? 為簡單起見 , 假定在各個(gè)方向上 , 加速度 [包括徑向加速度 和方 位角加速度 ]服從 均勻分布 , 在 范圍內(nèi) , 其概率密度函數(shù) 因此 , 加速度方差 由于 。 雷達(dá)方位角測量誤差均 方根值等于 或 . 由 和 可算出矩
環(huán)評(píng)公示相關(guān)推薦
鄂ICP備17016276號(hào)-1