Fix loitering trajectory when the drone is closer to the center than the required radius.
This will create a new commit in order to revert the existing changes.
