Add rotation limitation when lateral steps
Modification of sway_motion_correction.py