Create an auto balance

[Derp88]

For driving to the other side of the table, then balancing.

• Have a command that drives the robot until it detects the pitch is not zero
• Once the pitch has changed to above a certain amount, drive until the pitch is 0.
• Drive the robot back until the pitch is not zero
• Drive the robot 35 inches (using encoders), go to 0 once we hit our setpoint.

For driving just onto the table.

• Have a command that drives the robot until it detects the pitch is not zero
• Drive the robot 35 inches (using encoders), go to 0 once we hit our setpoint.

[Derp88]

The basis of this seems to be working, but it has some issues in reverse.

Will need to checkout and reexamine the logic.

[Derp88]

All autos seem to be work as intended.