Class-based state machine WIP
Working on the class based state machine. Got the structure set up, just need to flesh out the details. AMBTrafficVehicle calls through to the currentState's methods, and switches states if the method returns a new state.