Added moveRobotToHomePos