More updates in Robot::updateRobotPosition()