commit 4ddda33a1707dbdbdf1c1754f3b8e263a690d423
author James Kuszmaul <jabukuszmaul@gmail.com> Sat Mar 12 15:23:45 2022 -0800
committer James Kuszmaul <jabukuszmaul@gmail.com> Sat Mar 12 15:32:58 2022 -0800
tree 766eb93c625e50b688b7b406f08ce06595ab5f4c
parent 336282c41b969bc24a87edba8b5afdd95da827b0

Add GyroReading message to drivetrain plot

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

frc971/control_loops/drivetrain/drivetrain_plotter.ts

diff --git a/frc971/control_loops/drivetrain/drivetrain_plotter.ts b/frc971/control_loops/drivetrain/drivetrain_plotter.ts
index deb300f..4b59dc0 100644
--- a/frc971/control_loops/drivetrain/drivetrain_plotter.ts
+++ b/frc971/control_loops/drivetrain/drivetrain_plotter.ts
@@ -20,6 +20,8 @@
       '/drivetrain', 'frc971.control_loops.drivetrain.Status');
   const output = aosPlotter.addMessageSource(
       '/drivetrain', 'frc971.control_loops.drivetrain.Output');
+  const gyroReading = aosPlotter.addMessageSource(
+      '/drivetrain', 'frc971.sensors.GyroReading');
   const imu = aosPlotter.addRawMessageSource(
       '/drivetrain', 'frc971.IMUValuesBatch',
       new ImuMessageHandler(conn.getSchema('frc971.IMUValuesBatch')));
@@ -323,6 +325,7 @@
   gyroY.setColor(GREEN);
   const gyroZ = gyroPlot.addMessageLine(imu, ['gyro_z']);
   gyroZ.setColor(BLUE);
+  gyroPlot.addMessageLine(gyroReading, ['velocity']).setColor(BLUE);
 
   // IMU States
   const imuStatePlot =