bugfixes and parameter adjustment. Motion looks good
inverse turning direction to the right side