SINS_Kalman

捷联惯性导航系统、GPS/SINS组合导航系统仿真程序

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  量测平均法\A2T.m

     文件       4114  2009-06-11 16:03  量测平均法\AVP_Calc.asv

     文件       4412  2009-06-11 21:27  量测平均法\AVP_Calc.m

     文件        353  2009-01-05 10:15  量测平均法\Calc_Initial.m

     文件       4713  2009-06-06 15:11  量测平均法\Data_Genetate.asv

     文件       4796  2009-06-06 15:12  量测平均法\Data_Genetate.m

     文件        507  2009-01-10 19:05  量测平均法\Delete_Bias.m

     文件        761  2009-06-10 11:12  量测平均法\dispAVP.m

     文件        453  2009-06-11 19:14  量测平均法\Feedback_Check.m

     文件       1706  2009-06-06 15:26  量测平均法\F_update.asv

     文件       1744  2009-06-09 21:47  量测平均法\F_update.m

     文件        944  2008-12-25 15:19  量测平均法\GetDataFromFile.m

     文件       1101  2009-01-10 16:42  量测平均法\GetParams.m

     文件        136  2009-06-06 19:16  量测平均法\Gk_update.asv

     文件        221  2009-06-09 21:49  量测平均法\Gk_update.m

     文件       1887  2009-06-09 19:30  量测平均法\initial_Kalman.asv

     文件       1948  2009-06-13 09:55  量测平均法\initial_Kalman.m

     文件     144264  2006-07-03 20:17  量测平均法\jl.dat

     文件       1603  2007-09-12 15:54  量测平均法\jl.ini

     文件       2050  2009-06-13 09:09  量测平均法\Kalman_Filter.asv

     文件       2058  2009-06-13 09:13  量测平均法\Kalman_Filter.m

     文件       4224  2009-06-13 10:04  量测平均法\main.asv

     文件       4224  2009-06-13 10:07  量测平均法\main.m

     文件       1257  2009-06-10 10:17  量测平均法\measurement_update.m

     文件        693  2009-01-05 18:22  量测平均法\Oula_Angla.m

     文件        168  2009-06-04 20:57  量测平均法\Output_Check.asv

     文件        267  2009-06-05 21:53  量测平均法\Output_Check.m

     文件       1931  2009-06-10 21:02  量测平均法\Para_Setting.asv

     文件       2019  2009-06-11 15:12  量测平均法\Para_Setting.m

     文件       6598  2009-06-05 16:59  量测平均法\plot2.asv

............此处省略18个文件信息