a2cnb.m

来自「前人用四阶龙格库塔方法进行微分方程解算,用matlab编写的源代码,主要用于四元」· M 代码 · 共 8 行

function Cnb=a2cnb(att)
    si = sin(att(1)); ci = cos(att(1)); 
    sj = sin(att(2)); cj = cos(att(2)); 
    sk = sin(att(3)); ck = cos(att(3));
    Cnb = [ cj*ck-si*sj*sk, -ci*sk,  sj*ck+si*cj*sk;
         cj*sk+si*sj*ck, ci*ck, sj*sk-si*cj*ck;
         -ci*sj,          si,     ci*cj ];