a2cwa.m

前人用四阶龙格库塔方法进行微分方程解算,用matlab编写的源代码,主要用于四元素微分方程的实时解算

function Cwa=a2cwa(att)
    si = sin(att(1)); ci = cos(att(1)); 
    sj = sin(att(2)); cj = cos(att(2)); 
    Cwa = [  cj, 0, -sj*ci; 
            0,  1, si; 
            sj, 0, cj*ci ];