MPC has Poor Tracking Accuracy
The default parameter has not a good performance for tracking, especially at the endpoint. The following parameters with an increased terminal position weight worked better. mpc.param.yaml
We still need to adjust them considering the real vehicle limitation (e.g. max steering angle/angular-velocity)
Reported by @TakaHoribe