Generalize unit tests

Change vehicles to MKZ

Change vehicles to MKZ

Use time scale explicitly for non-realtime simulation.

Use time scale explicitly for non-realtime simulation.