Noises fixed, function move_to_position(goal)