commit 77aa62c40b8ebdd9fa6a290c12b4a84f76eecc1b
author James Kuszmaul <jabukuszmaul@gmail.com> Sat Mar 12 18:26:26 2022 -0800
committer James Kuszmaul <jabukuszmaul@gmail.com> Sat Mar 12 18:28:05 2022 -0800
tree 2f6d742b3eaf6c29517fd504bbf106826819bbae
parent 1f6099ee8a0462fe6c7090506cf60f98e76986a6

Add aimer status to 2022 turret plot

Change-Id: Id37e9822027791daec60acff294a81de2321b53d
Signed-off-by: James Kuszmaul <jabukuszmaul@gmail.com>

y2022/control_loops/superstructure/turret_plotter.ts

diff --git a/y2022/control_loops/superstructure/turret_plotter.ts b/y2022/control_loops/superstructure/turret_plotter.ts
index 10fc10e..6753880 100644
--- a/y2022/control_loops/superstructure/turret_plotter.ts
+++ b/y2022/control_loops/superstructure/turret_plotter.ts
@@ -29,6 +29,12 @@
   positionPlot.addMessageLine(status, ['turret', 'goal_position']).setColor(RED).setPointSize(4.0);
   positionPlot.addMessageLine(status, ['turret', 'goal_velocity']).setColor(ORANGE).setPointSize(4.0);
   positionPlot.addMessageLine(status, ['turret', 'estimator_state', 'position']).setColor(CYAN).setPointSize(1.0);
+  positionPlot.addMessageLine(status, ['aimer', 'turret_velocity'])
+      .setColor(WHITE)
+      .setPointSize(1.0);
+  positionPlot.addMessageLine(status, ['aimer', 'turret_position'])
+      .setColor(BROWN)
+      .setPointSize(1.0);
 
   const voltagePlot =
       aosPlotter.addPlot(element, [DEFAULT_WIDTH, DEFAULT_HEIGHT / 2]);