|
|
function Para = ang2Para_new(ang)
|
|
|
%---------------------------------------------------------------------%
|
|
|
%计算整星转动与附件振动耦合矩阵
|
|
|
%输入：帆板相对转角(弧度)
|
|
|
%输出：3*16：Fs1（3*5）+Fs2（3*5）+Ras1（3*3）+Ras2（3*3）
|
|
|
%说明：需要预先将卫星和帆板的参数和计算得到的耦合系数存到SaPara.mat中
|
|
|
|
|
|
load SatPara.mat;
|
|
|
|
|
|
%------------------ +Y帆板 -----------------------%
|
|
|
Ang = [0 ang(1) 0];
|
|
|
T_ab = EA2DCM(Ang); %转角坐标转换阵
|
|
|
T_ba = T_ab';
|
|
|
|
|
|
Fs1 = T_ba*B_rot1' + Rp_mat1*B_tran1'; % +Y帆板振动对卫星转动的耦合系数矩阵
|
|
|
Ras1 = T_ba*I_a1 + Rp_mat1*T_ba*P1; % +Y帆板相对于卫星转动的刚性耦合系数矩阵
|
|
|
%------------------ -Y帆板 -----------------------%
|
|
|
Ang = [0 ang(2) 0];
|
|
|
T_ab = EA2DCM(Ang); %转角坐标转换阵
|
|
|
T_ba = T_ab';
|
|
|
|
|
|
Fs2 = T_ba*B_rot2' + Rp_mat2*B_tran2'; % -Y帆板振动对卫星转动的耦合系数矩阵
|
|
|
Ras2 = T_ba*I_a2 + Rp_mat2*T_ba*P2; % -Y帆板相对于卫星转动的刚性耦合系数矩阵
|
|
|
%------------------输出-----------------------%
|
|
|
Para = [Fs1,Fs2,Ras1,Ras2]; |