Summary
Add test mode back in and make it work. Basically, if you click 'test' on the driver station and then hit 'enable,' the arm should calibrate and then remain in place. Pressing the buttons on the gamepad should make it increase/decrease the arm/extend setpoints by a little bit so we can figure out what the setpoints need to be.
Summary Add test mode back in and make it work. Basically, if you click 'test' on the driver station and then hit 'enable,' the arm should calibrate and then remain in place. Pressing the buttons on the gamepad should make it increase/decrease the arm/extend setpoints by a little bit so we can figure out what the setpoints need to be.
Work Required
Verification