void odom_test(int degrees)
Zero odom then drive 24 in — test odometry.
void con_test()
Basic connectivity / control check.
void swing_test(int degrees)
Swing to N degrees — tune swing PID.
void drive_test(int inches)
Drive straight N inches — tune drive PID.
void default_positions()
Set starting piston / mechanism states.
void run_jerryio_path_1()
Run the path generated by the JerryIO path planner (path 1).
void default_constants()
Tune PID gains, exit conditions, and slew rates.
void turn_test(int degrees)
Turn to N degrees — tune turn PID.
void heading_test(int degrees)
Drive while fighting a heading offset.