a2cwa.m

来自「本程序是关于四元数法捷联惯导解算算法的matlab程序组合包」· M 代码 · 共 7 行

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 ];