Lot of changes in Robot::updateRobotPosition()