Method and system for steerable medical device path definition and following during insertion and retraction
View Patent ↗Waypoints for a steerable medical device are stored as the steerable medical device is moved within a patient. The stored waypoints are an ordered sequence of locations. The ordered sequence of locations defines a safe path within the patient for moving an articulatable portion of the steerable medical device. The articulatable portion of the steerable medical device is constrained to follow the safe path as the articulatable portion moves within the patient. For example, the articulatable portion of the steerable medical device is constrained to remain within a boundary region enclosing the safe path as the articulatable portion of the steerable medical device follows the safe path.
1. A method comprising:
receiving, by a controller, a roll command, wherein the controller is coupled to a medical instrument, wherein the medical instrument comprises a plurality of articulatable segments, wherein each articulatable segment of the plurality of articulatable segments includes a serial combination of a plurality of links, wherein each link of the plurality of links is coupled to an adjacent link of the plurality of links by a joint;
determining, by the controller, roll of each of the plurality of articulatable segments, articulatable segment by articulatable segment, wherein the determining decouples the plurality of articulatable segments; and
sending, by the controller, at least one command to transmit roll to each of the articulatable segments from a proximal end of the articulatable segment to the distal end of the articulatable segment while maintaining each of the plurality of articulatable segments within a boundary region of that articulatable segment, wherein the boundary region is generated by the controller.
2. The method of claim 1 , wherein the determining roll further comprises:
generating orientation data of each of the plurality of articulatable segments.
3. The method of claim 2 , wherein the generating orientation data further comprises:
performing an iterative solution, using a kinematic model, on an articulatable segment by articulatable segment basis of each of the plurality of articulatable segments to generate the orientation data, wherein the orientation data is used in transmitting the roll from the proximal end to the distal end of each articulatable segment of the plurality of articulatable segments.
4. The method of claim 2 , wherein the generating orientation data further comprises:
retrieving a current yaw and a current pitch of one articulatable segment of the plurality of articulatable segments; and
generating a new yaw and a new pitch of the one articulatable segment from a proximal roll, the current yaw, and the current pitch of the one articulatable segment.
5. The method of claim 1 , wherein the boundary region of one articulatable segment of the plurality of articulatable segments is different from the boundary region of a different articulatable segment of the plurality of articulatable segments.