Mph was being optimized out as the set_mph was casting wierd
the calculation units were meters per second
mph was getting calculated and set at the end of the torque state machine not the beginning, so it would never be reached if the car did state stuff or faulted.
Mph works with this PR. Some issues were: