Fixed a problem that the robot shakes up and down when moving