-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathfrozencap.m
112 lines (110 loc) · 3 KB
/
frozencap.m
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
% 冻结轨道捕获
clear
clc
close all
% 初始时间
epoch = [2020,9,1,4,0,0];
% 初始轨道高度
h0 = 1175;
a = h0 + Re;
% 初始轨道根数
kp = [a,0.002,85,120,180,0];
fnpostfix = '2'; % 保存曲线的后缀名
F = 0.015; % 推力
Isp = 1300; % 比冲
dm = -F/Isp/9.8; % 秒流量
Mass = 200; % 质量
% 轨道初始化
s(1,:) = mexOrbitDyn('sat','init',[epoch,kp,Mass]);
mexOrbitDyn('sat','SetForce',[8,1+2+4+8+16+32]); % 8*8阶，日月大气光压
mexOrbitDyn('sat','SetAD',5);
mexOrbitDyn('sat','SetSRP',5);
m(1,:) = mexOrbitDyn('sat','GetMean'); % 平根数
%% 偏心率矢量调整量
% 目标偏心率矢量
et = 0.001174; % 目标偏心率
wt = 90; % 目标近地点幅角
ext = et*cosd(wt);
eyt = et*sind(wt);
% 当前偏心率矢量
ex = m(1,2)*cos(m(1,5));
ey = m(1,2)*sin(m(1,5));
% 偏心率矢量差
dex = ex - ext;
dey = ey - eyt;
fc = atan2(dey,dex);
if fc < 0
fc = fc + 2*pi;
end
% 点火参数
df = 30*rad;
u_n_on = fc-df;
u_n_off = fc+df;
u_p_on = fc+pi-df;
u_p_off = fc+pi+df;
%%
step = 60; % 仿真步长
i = 1;
j = 1;
for i = 2:(1440*5)
qbi = c2q(getcoi(s(i-1,2:7)));
if mod(i,109) == 0 % 每圈更新点火参数
% 当前偏心率矢量
ex = m(i-1,2)*cos(m(i-1,5));
ey = m(i-1,2)*sin(m(i-1,5));
% 偏心率矢量差
dex = ex - ext;
dey = ey - eyt;
fc = atan2(dey,dex);
if fc < 0
fc = fc + 2*pi;
end
% 点火参数
df = 30*rad;
u_n_on = fc-df;
u_n_off = fc+df;
u_p_on = fc+pi-df;
u_p_off = fc+pi+df;
uec(j,1:4) = [u_n_on,u_n_off,u_p_on,u_p_off]*deg;
j = j+1;
end
f = ma2ta(m(i-1,2),m(i-1,6));
u = ewmu(m(i-1,2),m(i-1,5),m(i-1,6));
if InArc(u*deg,u_n_on*deg,u_n_off*deg) % 点火状态
s(i,:) = mexOrbitDyn('sat','step',[step, qbi', -F, 0, 0, dm]);
elseif InArc(u*deg,u_p_on*deg,u_p_off*deg) % 点火状态
s(i,:) = mexOrbitDyn('sat','step',[step, qbi', F, 0, 0, dm]);
else % 非点火状态
s(i,:) = mexOrbitDyn('sat','step',step);
end
m(i,:) = mexOrbitDyn('sat','GetMean'); % 平根数
ex = m(i,2)*cos(m(i,5));
ey = m(i,2)*sin(m(i,5));
dex = ex - ext;
dey = ey - eyt;
if sqrt(dex.^2+dey.^2) < 5e-5
break;
end
end
mexOrbitDyn('sat','remove');
%% 数据保存和画图
t = (s(:,1)-s(1,1)); %时间
ex = m(:,2).*cos(m(:,5));
ey = m(:,2).*sin(m(:,5));
%% 曲线
figure('Name','冻结轨道捕获瞬根数'),plot6coe(t,kdeg(s(:,2:7)));
saveas(gcf,['冻结轨道捕获瞬根数',fnpostfix,'.png'])
figure('Name','冻结轨道捕获平根数'),plot6coe(t,kdeg(m));
saveas(gcf,['冻结轨道捕获平根数',fnpostfix,'.png'])
figure('Name','偏心率矢量'),plot(ex,ey),grid on,hold on;
plot(ex(1),ey(1),'ro');plot(ex(end),ey(end),'rd');
plot(ext,eyt,'ko');
xlabel('e_x'),ylabel('e_y');
legend('e_v','初始点','最终点','目标点','location','best');
saveas(gcf,['偏心率矢量',fnpostfix,'.png']);
figure('Name','冻结轨道捕获开机弧段');
n = 1:length(uec);
plot(n,uec(:,1),'.-',n,uec(:,2),'.-',n,uec(:,3),'.-',n,uec(:,4),'.-'),grid on;
xlabel('rev'),ylabel('arg');
legend('u_p_o_n','u_p_o_f_f','u_n_o_n','u_n_o_f_f','location','best');
saveas(gcf,['冻结轨道捕获开机弧段',fnpostfix,'.png']);