quatevolve.m

来自「大气层内航天器飞行动力学matlab仿真模型」· M 代码 · 共 4 行

% Copyright Ashish Tewari (c) 2006
function q=quatevolve(q0,w,T)
S=[0 w(3,1) -w(2,1) w(1,1);-w(3,1) 0 w(1,1) w(2,1);w(2,1) -w(1,1) 0 w(3,1);-w(1,1) -w(2,1) -w(3,1) 0];
q=expm(0.5*S*T)*q0;