avv.m

星命转换 星命转换 星命转换

%利用星敏感器输出矢量X、Z，确定惯性系下姿态矩阵A
function A=AVV(X,Z,Xb,Zb)
%X表示横轴矢量；Z轴表示光轴矢量；Xb表示横轴安装星体坐标；Zb表示光轴安装星体坐标
V2i=cross(X,Z);
V2i=norm(V2i);
V3i=cross(X,V2i);
V2b=cross(Xb,Zb);
V2b=norm(V2b);
V3b=cross(X,V2b);
A=Xb*X'+V3b*V3b'+Zb*Z';