Improve the linearity of the robot