Create an auto mode that starts when the robot is enabled in Test mode. The auto should run one mechanism at a time to test it for proper functionality.
The mode should test for:
- Each control component is connected
- Each mechanism moves to chase its setpoint, and draws a reasonable amount of current when doing so
- Robot receives correct input from HIDs when user is prompted to press a button on a controller
Create an auto mode that starts when the robot is enabled in Test mode. The auto should run one mechanism at a time to test it for proper functionality.
The mode should test for: