From b4963b21ef7013f9683e4f08b1fcd04dd3913622 Mon Sep 17 00:00:00 2001
From: Claudio <claudio.mandrioli@control.lth.se>
Date: Tue, 26 Feb 2019 17:29:22 +0100
Subject: [PATCH] polished plotting code
---
matlab/plot_data.m | 32 ++++++++++++++++++++++++++++++++
1 file changed, 32 insertions(+)
create mode 100644 matlab/plot_data.m
diff --git a/matlab/plot_data.m b/matlab/plot_data.m
new file mode 100644
index 0000000..03f5d00
--- /dev/null
+++ b/matlab/plot_data.m
@@ -0,0 +1,32 @@
+%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
+% Script for data plot:
+% plots the trajecotry and the stimation accuracy with the GPS turn on
+% signal
+%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
+
+% display the overall error (root mean square)
+out_data.error
+
+% Display trajectory estimated with sensor fusion against trajectory for the
+% GPS alone always on
+h=zeros(1,2);
+figure(1)
+hold on
+plot(in_data.GNSS.pos_ned(2,:),in_data.GNSS.pos_ned(1,:),'b-');
+h(1)=plot(in_data.GNSS.pos_ned(2,:),in_data.GNSS.pos_ned(1,:),'b.');
+h(2)=plot(out_data.x_h(2,:),out_data.x_h(1,:),'-');
+title('Trajectory')
+ylabel('North [m]')
+xlabel('East [m]')
+legend(h,'GNSS position estimate','GNSS aided INS trajectory')
+axis equal
+grid on
+
+%plot control signal P and turn on signal of the GPS
+h=zeros(1,2);
+figure(2)
+hold on
+h(1)=plot(out_data.P_store);
+h(2)=plot(out_data.turn);
+legend(h,'sum of the trace of P','antenna turned ON')
+grid on
\ No newline at end of file
--
GitLab