modifications at Davis. SPLIT OUT LATER
diff --git a/frc971/control_loops/wrist/wrist.cc b/frc971/control_loops/wrist/wrist.cc
index 392e630..97a0cef 100644
--- a/frc971/control_loops/wrist/wrist.cc
+++ b/frc971/control_loops/wrist/wrist.cc
@@ -9,6 +9,7 @@
#include "aos/common/messages/RobotState.q.h"
#include "aos/common/control_loop/control_loops.q.h"
#include "aos/common/logging/logging.h"
+#include "aos/atom_code/messages/DriverStationDisplay.h"
#include "frc971/constants.h"
#include "frc971/control_loops/wrist/wrist_motor_plant.h"
@@ -91,6 +92,9 @@
position->pos,
position->hall_effect ? "true" : "false",
zeroed_joint_.absolute_position());
+
+ ::aos::DriverStationDisplay::Send(3, "wrist: %6.4f ",
+ position->calibration);
}
if (output) {