Add a new parameter : kinodynamic/forceYawOrientation to only adjust the orientation along the z axis