y_qua.m

来自「惯性导航系统传递对准系统模型程序」· M 代码 · 共 5 行

function Y=Y_qua(q)
Y=[-q(1+1) -q(2+1) -q(3+1)
    q(0+1)  q(3+1) -q(2+1)
   -q(3+1)  q(0+1)  q(1+1)
    q(2+1) -q(1+1)  q(0+1)];