Add more MPC tests to identify rollout issues.

Fix minor bug in path_sender when resetting initial car state.