Slow down for curves (avoid slipping)

Support lateral acceleration, parameters to slow down for curves. This should be at the planning level. Will later consider doing it dynamically. In the current simulation, it constantly slips around corners with max_v set to 3 m/s, this should fix that.