You cannot select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.

20 lines
657 B
Matlab

This file contains ambiguous Unicode characters!

This file contains ambiguous Unicode characters that may be confused with others in your current locale. If your use case is intentional and legitimate, you can safely ignore this warning. Use the Escape button to highlight these characters.

function I_all = ang2Iall_new(ang)
%---------------------------------------------------------------------%
%计算帆板转动情况下整星转动惯量矩阵
%输入2维第一个为帆板1转角第二个为帆板2转角(弧度)
%输出:整星转动惯量矩阵
%说明需要预先将卫星和帆板的参数和计算得到的耦合系数存到SaPara.mat中
load SatPara.mat
Ang = [0 ang(1) 0];
T_1ab = EA2DCM(Ang); %转角坐标转换阵
T_1ba = T_1ab';
Fs1 = T_1ba*B_rot1' + Rp_mat1*B_tran1';
Ang = [0 ang(2) 0];
T_2ab = EA2DCM(Ang); %转角坐标转换阵
T_2ba = T_2ab';
Fs2 = T_2ba*B_rot2' + Rp_mat2*B_tran2';
I_all = I_ben + Fs1*Fs1' + Fs2*Fs2';