altos: Build test framework for kalman filter

This has some known flight data and generates kalman filter
information for them to test

Signed-off-by: Keith Packard <keithp@keithp.com>

1 files changed, 16 insertions, 0 deletions

diff --git a/src/kalman/plotmicro b/src/kalman/plotmicro
new file mode 100755
index 00000000..0b7e95c0
--- /dev/null
+++ b/src/kalman/plotmicro
@@ -0,0 +1,16 @@
+#!/bin/sh
+for i in "$@"; do
+gnuplot -p << EOF &
+set title "$i"
+set ylabel "error"
+set y2label "height (m)"
+set xlabel "time (s)"
+set xtics border out nomirror
+set ytics border out nomirror
+set y2tics border out nomirror
+plot "$i" using 1:3 with lines lt 2 axes x1y2 title "raw height",\
+     "$i" using 1:7 with lines lt 4 axes x1y2 title "kalman height",\
+     "$i" using 1:9 with lines lt 1 axes x1y1 title "avg error", \
+     "$i" using 1:10 with lines lt 3 axes x1y1 title "valid"
+EOF
+done