Added seperate on and off constants for the wrist and angle adjust.
diff --git a/frc971/control_loops/wrist/wrist.cc b/frc971/control_loops/wrist/wrist.cc
index 13471fa..e364cd6 100644
--- a/frc971/control_loops/wrist/wrist.cc
+++ b/frc971/control_loops/wrist/wrist.cc
@@ -36,6 +36,11 @@
LOG(ERROR, "Failed to fetch the wrist start angle constant.\n");
return false;
}
+ if (!constants::wrist_zeroing_off_speed(&config_data->zeroing_off_speed)) {
+ LOG(ERROR, "Failed to fetch the wrist zeroing off speed constant.\n");
+ return false;
+ }
+
if (!constants::wrist_zeroing_speed(&config_data->zeroing_speed)) {
LOG(ERROR, "Failed to fetch the wrist zeroing speed constant.\n");
return false;