www.pudn.com > SINS-MatlabImplement.rar > q2cnb.m, change:2009-02-05,size:455b


function Cnb = q2cnb(qnb)  
    q11 = qnb(1)*qnb(1); q12 = qnb(1)*qnb(2); q13 = qnb(1)*qnb(3); q14 = qnb(1)*qnb(4);  
    q22 = qnb(2)*qnb(2); q23 = qnb(2)*qnb(3); q24 = qnb(2)*qnb(4);      
    q33 = qnb(3)*qnb(3); q34 = qnb(3)*qnb(4);   
    q44 = qnb(4)*qnb(4); 
    Cnb = [ q11+q22-q33-q44,  2*(q23-q14),     2*(q24+q13); 
            2*(q23+q14),      q11-q22+q33-q44, 2*(q34-q12); 
            2*(q24-q13),      2*(q34+q12),     q11-q22-q33+q44 ];