MainState state switching not re-indexed with teleop takeover #86
Description
When Teleop or Safety overwrites the tractor state, the state index doesn't change for joystick state switching.
Ex: If tractor is in state 6 and safety activates, setting the state to 0, upon re-activating and attempting to switch to state 1, the tractor instead switches to state 7.