Fixed the problem that the robot with respect to the rotational direction is oscillatory
Merge pull request #24 from open-rdc/suppress-oscillation

Fixed the problem that the robot with respect to the rotational direction is oscillatory