METHOD AND SYSTEM FOR STEERABLE MEDICAL DEVICE PATH DEFINITION AND FOLLOWING DURING INSERTION AND RETRACTION

A method may comprise storing a first waypoint corresponding to a first position of a tip of a steerable medical device including an articulatable segment. The controller may perform a motion pause check operation to determine that an insertion motion of the articulatable segment into a patient anatomy has been paused, while the tip is at a second position. The controller may determine that the articulatable segment has resumed the insertion motion into the patient anatomy. After determining that the articulatable segment has resumed the insertion motion, a second waypoint corresponding to the second position of the tip of the steerable medical device, may be stored. A boundary region may be defined to form a three-dimensional volume enclosing the positions of the stored waypoints. The articulatable segment may be constrained to remain within the boundary region as the articulatable segment is inserted in the patient anatomy.