Added methods to Drive so that when the Robot tips past a certain threshold (currently 5 degrees), the drivetrain modifies the motor speeds to compensate for the tipping. It does not override driver control. Also added a button to disable/enable the Anti-Tip functions.
Added methods to Drive so that when the Robot tips past a certain threshold (currently 5 degrees), the drivetrain modifies the motor speeds to compensate for the tipping. It does not override driver control. Also added a button to disable/enable the Anti-Tip functions.