SINS_Kalman2833410

卡尔曼滤波程序 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个文件信息