Code for the motor controller
This is basically what we used in Detroit.
Change-Id: If2820d7ec5fcbc5f33b4082025027a6e969ad0e1
diff --git a/motors/plot.py b/motors/plot.py
new file mode 100755
index 0000000..013f308
--- /dev/null
+++ b/motors/plot.py
@@ -0,0 +1,25 @@
+#!/usr/bin/python3
+
+import numpy
+from matplotlib import pylab
+
+data = numpy.loadtxt('/tmp/dump3.csv',
+ delimiter=',',
+ skiprows=1)
+x = range(len(data))
+
+pylab.subplot(1, 1, 1)
+pylab.plot(x, [d[0] for d in data], 'ro', label='ia')
+pylab.plot(x, [d[1] for d in data], 'go', label='ib')
+pylab.plot(x, [d[2] for d in data], 'bo', label='ic')
+pylab.plot(x, [d[3] for d in data], 'r--', label='ia_goal')
+pylab.plot(x, [d[4] for d in data], 'g--', label='ib_goal')
+pylab.plot(x, [d[5] for d in data], 'b--', label='ic_goal')
+pylab.plot(x, [d[6] for d in data], 'rx', label='i_overall')
+pylab.plot(x, [d[7] for d in data], 'gx', label='omega')
+pylab.plot(x, [d[8] for d in data], 'r', label='van')
+pylab.plot(x, [d[9] for d in data], 'g', label='vbn')
+pylab.plot(x, [d[10] for d in data], 'b', label='vcn')
+pylab.legend()
+
+pylab.show()