-
Notifications
You must be signed in to change notification settings - Fork 0
/
plots.m
99 lines (93 loc) · 2.47 KB
/
plots.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
figure(1)
subplot(3,1,1)
plot(tfs,omegadfs(:,1),'-','LineWIdth',2)
hold on
plot(tfs,omegafs(:,1)','--','LineWIdth',2)
% axis([0 tend -0.5 0.5])
set(gca,'FontSize',30)
subplot(3,1,2)
plot(tfs,omegadfs(:,2),'-','LineWIdth',2)
hold on
plot(tfs,omegafs(:,2)','--','LineWIdth',2)
% axis([0 tend -0.4 0.4])
ylabel('\Omega (rad/s)')
set(gca,'FontSize',30)
subplot(3,1,3)
plot(tfs,omegadfs(:,3),'-','LineWIdth',2)
hold on
plot(tfs,omegafs(:,3)','--','LineWIdth',2)
% axis([0 tend -0.1 0.2])
xlabel('Time (s)')
set(gca,'FontSize',30)
figure(2)
subplot(3,1,1)
hold on
plot(tfs,efs_att(:,1),'-','LineWIdth',2)
% axis([0 tend -0.025 0.015])
set(gca,'FontSize',30)
subplot(3,1,2)
hold on
plot(tfs,efs_att(:,2)','-','LineWIdth',2)
% axis([0 tend -0.06 0.01])
ylabel('e_R ')
set(gca,'FontSize',30)
subplot(3,1,3)
hold on
plot(tfs,efs_att(:,3),'-','LineWIdth',2)
% axis([0 tend -10*10^-3 4*10^-3])
xlabel('Time (s)')
set(gca,'FontSize',30)
figure(3)
subplot(2,1,1)
plot(tfs,Jhatfs{1}(:,1),'LineWIdth',2)
hold on
plot(tfs,Jhatfs{1}(:,2),'LineWIdth',2)
plot(tfs,Jhatfs{1}(:,3),'LineWIdth',2)
plot(tfs,Jfs{1}(:,1),'--','LineWIdth',2)
plot(tfs,Jfs{1}(:,2),'--','LineWIdth',2)
plot(tfs,Jfs{1}(:,3),'--','LineWIdth',2)
plot(tfs,Jhatfs{2}(:,1),'LineWIdth',2)
plot(tfs,Jhatfs{2}(:,2),'LineWIdth',2)
plot(tfs,Jhatfs{2}(:,3),'LineWIdth',2)
plot(tfs,Jfs{2}(:,1),'--','LineWIdth',2)
plot(tfs,Jfs{2}(:,2),'--','LineWIdth',2)
plot(tfs,Jfs{2}(:,3),'--','LineWIdth',2)
% axis([0 tend 0 0.05])
ylabel ('h_{xx},h_{yy},h{zz}')
set(gca,'FontSize',30)
subplot(2,1,2)
plot(tfs,Jhatfs{1}(:,4),'LineWIdth',2)
hold on
plot(tfs,Jhatfs{1}(:,5),'LineWIdth',2)
plot(tfs,Jhatfs{1}(:,end),'LineWIdth',2)
plot(tfs,Jfs{1}(:,4),'--','LineWIdth',2)
plot(tfs,Jfs{1}(:,5),'--','LineWIdth',2)
plot(tfs,Jfs{1}(:,end),'--','LineWIdth',2)
plot(tfs,Jhatfs{2}(:,4),'LineWIdth',2)
plot(tfs,Jhatfs{2}(:,5),'LineWIdth',2)
plot(tfs,Jhatfs{2}(:,end),'LineWIdth',2)
plot(tfs,Jfs{2}(:,4),'--','LineWIdth',2)
plot(tfs,Jfs{2}(:,5),'--','LineWIdth',2)
plot(tfs,Jfs{2}(:,end),'--','LineWIdth',2)
% axis([0 tend -25*10^-3 10*10^-3])
xlabel('Time (s)')
ylabel ('h_{xy},h_{yz},h{xz}')
set(gca,'FontSize',30)
figure(4)
subplot(3,1,1)
hold on
plot(tfs,controlfs(:,1),'LineWIdth',2)
% axis([0 tend -0.02 0.02])
set(gca,'FontSize',30)
subplot(3,1,2)
hold on
plot(tfs,controlfs(:,2),'LineWIdth',2)
% axis([0 tend -0.02 0.02])
ylabel ('\tau')
set(gca,'FontSize',30)
subplot(3,1,3)
hold on
plot(tfs,controlfs(:,3),'LineWIdth',2)
% axis([0 tend -0.006 0.006])
xlabel('Time (s)')
set(gca,'FontSize',30)