commit 5c40678282ae0418734d8764f4316e00892c7e87
author Milind Upadhyay <milind.upadhyay@gmail.com> Mon Sep 26 21:28:35 2022 -0700
committer Milind Upadhyay <milind.upadhyay@gmail.com> Sat Oct 22 14:08:26 2022 -0700
tree 79025ee9001f8f07c73789643dbdd8f72f8afe2a
parent d7b9eca44da3fa802c7272e66839f07997d802a4

Add superstructure goal plot

Signed-off-by: Milind Upadhyay <milind.upadhyay@gmail.com>
Change-Id: I3b7ab60fe0ad49231b8662cc548d5cb9dead47ab

y2022/control_loops/superstructure/superstructure_plotter.ts

diff --git a/y2022/control_loops/superstructure/superstructure_plotter.ts b/y2022/control_loops/superstructure/superstructure_plotter.ts
index 5a1537e..8590d7b 100644
--- a/y2022/control_loops/superstructure/superstructure_plotter.ts
+++ b/y2022/control_loops/superstructure/superstructure_plotter.ts
@@ -50,6 +50,16 @@
       .setColor(PINK)
       .setPointSize(1.0);
 
+  const goalPlot =
+      aosPlotter.addPlot(element, [DEFAULT_WIDTH, DEFAULT_HEIGHT / 2]);
+  goalPlot.plot.getAxisLabels().setTitle('Goal');
+  goalPlot.plot.getAxisLabels().setXLabel(TIME);
+  goalPlot.plot.getAxisLabels().setYLabel('value');
+  goalPlot.plot.setDefaultYRange([-1.0, 2.0]);
+  goalPlot.addMessageLine(goal, ['fire']).setColor(RED).setPointSize(1.0);
+  goalPlot.addMessageLine(goal, ['auto_aim']).setColor(BLUE).setPointSize(1.0);
+
+
   const shotCountPlot =
       aosPlotter.addPlot(element, [DEFAULT_WIDTH, DEFAULT_HEIGHT / 2]);
   shotCountPlot.plot.getAxisLabels().setTitle('Shot Count');