Optimize the robot movement in the demo by modifying the robot package