state machine works for all 5 routes, turns other than 90, and final routes