Add localizer velocity states to plotter
Change-Id: Ibb5499b2044bc415368b66c69539e7d96bf13c82
diff --git a/frc971/control_loops/drivetrain/drivetrain_plotter.ts b/frc971/control_loops/drivetrain/drivetrain_plotter.ts
index 90c58cf..0c01f6a 100644
--- a/frc971/control_loops/drivetrain/drivetrain_plotter.ts
+++ b/frc971/control_loops/drivetrain/drivetrain_plotter.ts
@@ -216,6 +216,16 @@
ekfRightVelocity.setColor(GREEN);
ekfRightVelocity.setPointSize(0.0);
+ const splineVelocityOffset = velocityPlot2.addMessageLine(
+ status, ['localizer', 'longitudinal_velocity_offset']);
+ splineVelocityOffset.setColor(BROWN);
+ splineVelocityOffset.setPointSize(0.0);
+
+ const splineLateralVelocity = velocityPlot2.addMessageLine(
+ status, ['localizer', 'lateral_velocity']);
+ splineLateralVelocity.setColor(PINK);
+ splineLateralVelocity.setPointSize(0.0);
+
// Heading
const yawPlot = aosPlotter.addPlot(element, [0, currentTop], [DEFAULT_WIDTH, DEFAULT_HEIGHT]);
currentTop += DEFAULT_HEIGHT;