Added findRobot and calculateRobotMovement