MPC Tuning for Parking
Description
When parking, orientation should be weighted more heavily than speed or position. This does not seem to be the case currently from testing.
Expected behavior
The vehicle should not cut other nearby spots when parking (position weight needs to be increased during driving) and the vehicle should end up in the desired orientation at the end of the route (orientation weight needs to be increased at destination).