資源簡介
卡爾曼濾波程序 GPS/INS 組合導航例子
代碼片段和文件信息
function?T?=?A2T(A)
%?由姿態值計算捷聯矩陣(采用北東地“坐標系)
p?=?A(1);??%分別為橫搖、縱搖、航向角
q?=?A(2);
r?=?A(3);
%?
%?T?=?[?cos(p)*cos(C)-sin(R)*sin(P)*sin(C)??-cos(P)*sin(C) sin(R)*cos(C)+cos(R)*sin(P)*sin(C);
%???????cos(R)*sin(C)+sin(R)*sin(P)*cos(C)???cos(P)*cos(C)????sin(R)*sin(C)-cos(R)*sin(P)*cos(C);
%??????-sin(R)*cos(P)???????????????????????????????sin(P)?? ????????cos(R)*cos(P)????????????];
??????
????
?????
?????T?=?[cos(q)*cos(r)?-cos(p)*sin(r)+sin(p)*sin(q)*cos(r)??sin(p)*sin(r)+cos(p)*sin(q)*cos(r);
?????????cos(q)*sin(r)?cos(p)*cos(r)+sin(p)*sin(q)*sin(r)??-sin(p)*cos(r)+cos(p)*sin(q)*sin(r);
??????????-sin(q)??????????????sin(p)*cos(q)??????????????????????cos(p)*cos(q)????????????];
?屬性????????????大小?????日期????時間???名稱
-----------?---------??----------?-----??----
?????文件????????736??2008-10-13?16:34??SINS_Kalman\A2T.m
?????文件???????4412??2009-06-11?21:27??SINS_Kalman\AVP_Calc.m
?????文件????????353??2009-01-05?10:15??SINS_Kalman\Calc_Initial.m
?????文件???????4796??2009-06-06?15:12??SINS_Kalman\Data_Genetate.m
?????文件????????761??2009-06-10?11:12??SINS_Kalman\dispAVP.m
?????文件????????453??2009-06-11?19:14??SINS_Kalman\Feedback_Check.m
?????文件???????1744??2009-06-09?21:47??SINS_Kalman\F_update.m
?????文件????????944??2008-12-25?15:19??SINS_Kalman\GetDataFromFile.m
?????文件???????1101??2009-01-10?16:42??SINS_Kalman\GetParams.m
?????文件????????221??2009-06-09?21:49??SINS_Kalman\Gk_update.m
?????文件???????1948??2009-06-13?09:55??SINS_Kalman\initial_Kalman.m
?????文件???????2058??2009-06-13?09:13??SINS_Kalman\Kalman_Filter.m
?????文件???????4230??2009-06-17?09:12??SINS_Kalman\main.asv
?????文件???????4248??2009-06-17?09:14??SINS_Kalman\main.m
?????文件???????1257??2009-06-10?10:17??SINS_Kalman\measurement_update.m
?????文件????????693??2009-01-05?18:22??SINS_Kalman\Oula_Angla.m
?????文件????????267??2009-06-05?21:53??SINS_Kalman\Output_Check.m
?????文件???????2019??2009-06-11?15:12??SINS_Kalman\Para_Setting.m
?????文件???????6598??2009-06-05?17:04??SINS_Kalman\plot2.m
?????文件???????5946??2009-06-10?11:03??SINS_Kalman\plot3.m
?????文件????????405??2009-02-20?09:49??SINS_Kalman\PlotModeSetting.m
?????文件????????569??2009-01-09?09:55??SINS_Kalman\PlotResult.m
?????文件????????402??2008-09-26?08:02??SINS_Kalman\Q2T.m
?????文件????????132??2008-09-26?08:24??SINS_Kalman\Qone.m
?????文件????????463??2009-01-05?10:35??SINS_Kalman\Q_update.m
?????文件????????253??2008-09-26?07:50??SINS_Kalman\SkewMatrix_4.m
?????文件????????457??2008-10-25?10:14??SINS_Kalman\T2A.m
?????文件????????397??2007-09-14?17:16??SINS_Kalman\T2Q.m
?????目錄??????????0??2009-06-17?09:16??SINS_Kalman
-----------?---------??----------?-----??----
............此處省略2個文件信息
- 上一篇:UTC2GPS
- 下一篇:lena 灰圖像三級小波分解
評論
共有 條評論