-
Notifications
You must be signed in to change notification settings - Fork 0
/
test_script_p_p_gold_comp.m
53 lines (51 loc) · 1.29 KB
/
test_script_p_p_gold_comp.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
close all
clc
figure
for j_agent=1:9
subplot(3,3,j_agent)
P = inv(opt_dist.result.est{i_consensus}.Y_bar(:,:,j_agent));
x = P*(opt_dist.result.est{i_consensus}.y_bar(:,j_agent));
plot(x_gt(1),x_gt(2),'+r', 'MarkerSize',3); hold on;
error_ellipse(P,x); hold on
error_ellipse(P_gold{j_agent},x_gold{j_agent})
error_ellipse(P_cen,x_cen)
legend('gt','p','p_gold','p_cen')
axis equal
title(num2str(j_agent))
end
% close all
% clc
% figure
% for j_agent=2
% % subplot(3,3,j_agent)
% error_ellipse(P,x); hold on
% error_ellipse(P_gold{j_agent},x_gold{j_agent})
% error_ellipse(P_cen,x_cen)
% legend('p','p_gold','p_cen')
% end
%
%
% close all
% clc
% figure
% subplot(211)
% for j_agent=1:9
% % subplot(3,3,j_agent)
% % error_ellipse(P,x); hold on
% h(j_agent)=error_ellipse(P_gold{j_agent},x_gold{j_agent}); hold on
% leg{j_agent} = num2str(j_agent);
% legend(h,leg)
% % error_ellipse(P_cen,x_cen)
% % legend('p','p_gold','p_cen')
% end
%
% subplot(212)
% for j_agent=1:9
% % subplot(3,3,j_agent)
% % error_ellipse(P,x); hold on
% h(j_agent)=error_ellipse(P},x_gold{j_agent}); hold on
% leg{j_agent} = num2str(j_agent);
% legend(h,leg)
% % error_ellipse(P_cen,x_cen)
% % legend('p','p_gold','p_cen')
% end