Controller assisted reconfiguration of an articulated instrument during movement into and out of an entry guide
To perform a tool exchange in a medical robotic system, tool is retracted back into an entry guide from a deployed position and pose so that an assistant in the operating room may replace it with a different tool. While the tool is being retracted back towards the entry guide by user action, its configuration is changed to an entry pose while avoiding collisions with other objects so that it may fit in the entry guide. After the tool exchange is completed, a new tool is inserted in the entry guide and extended out of the guide by user action to the original position of the old tool prior to its retraction into the entry guide while the tool's controller assists the user by reconfiguring the new tool so as to resemble the original deployed pose of the old tool prior to its retraction into the entry guide.
1. A medical system comprising:
an entry guide;
a manipulator configured to couple to an articulated instrument having a plurality of links, wherein adjacent links of the plurality of links are coupled together by a rotary joint, and wherein the articulated instrument is configured to couple to the manipulator so that a most proximal link of the plurality of links is at least partially disposed within the entry guide and a most distal link of the plurality of links is configured to retract into, and extend out of, the entry guide; and
a processor configured to:
determine a current mode of the medical system, the current mode being one of a plurality of modes including a retraction mode; and
conditioned upon the current mode being the retraction mode:
allow a part of the manipulator to be manually moved so that when the articulated instrument is coupled to the manipulator, the most proximal link moves in a direction along a longitudinal axis of the most proximal link; and
cause at least one of the adjacent links to be rotated about the rotary joint in response to the part of the manipulator being manually moved, so that longitudinal axes of the adjacent links are substantially in line with the longitudinal axis of the most proximal link prior to the adjacent links entering the entry guide.
2. The medical system according to claim 1 , further comprising:
an input device;
wherein the plurality of modes includes a normal mode; and
wherein the processor is further configured to:
conditioned upon the current mode being the normal mode:
operatively couple the input device to the manipulator so that when the articulated instrument is coupled to the manipulator, the manipulator manipulates the articulated instrument in response to a command received from the input device.
3. The medical system according to claim 2 ,
wherein the input device is configured to be operated by a surgeon during performance of a medical procedure; and
wherein the part of the manipulator is configured to be moved by an assistant during the performance of the medical procedure.
4. The medical system according to claim 3 , further comprising:
a switch configured to be operated by the assistant;
wherein the processor is further configured to:
determine the current mode of the medical system by determining a current state of the switch.
5. The medical system according to claim 4 ,
wherein the switch comprises a button provided on the manipulator.
6. The medical system according to claim 1 ,
wherein the processor is further configured to:
conditioned upon the current mode being the retraction mode:
cause the at least one of the adjacent links to be rotated about the rotary joint, so that the adjacent links define a previously deployed angle as the most distal link is extended out of, and away from, the entry guide.
7. The medical system according to claim 1 ,
wherein the processor is further configured to:
conditioned upon the current mode being the retraction mode:
cause the at least one of the adjacent links to be rotated about the rotary joint, so that the at least one of the adjacent links is rotated at a rate that increases according to an increase in rate that the part of the manipulator is being manually moved.
8. The medical system according to claim 1 ,
wherein the processor is further configured to:
conditioned upon the current mode being the retraction mode:
cause the at least one of the adjacent links to be rotated about the rotary joint, so that the at least one of the adjacent links is rotated at a rate that increases according to a decreasing distance of the rotary joint from a point of entry of the rotary joint into the entry guide.
9. The medical system according to claim 1 ,
wherein the processor is further configured to:
conditioned upon the current mode being the retraction mode:
inhibit the most distal link from moving in an opposite direction than a direction being commanded by the part of the manipulator being manually moved, until a distal end of the most proximal link is within a threshold distance to a distal end of the entry guide.
10. The medical system according to claim 1 ,
wherein the processor is further configured to:
conditioned upon the current mode being the retraction mode:
cause a haptic force to be applied against movement of the part of the manipulator, wherein a magnitude of the haptic force decreases as the at least one of the adjacent links is rotated about the rotary joint towards a condition in which the longitudinal axes of the adjacent links are substantially collinear with the longitudinal axis of the most proximal link.
11. The medical system according to claim 1 , wherein the part of the manipulator to be manually moved comprises a prismatic joint coupled to the most proximal link, so that manual movement of the part of the manipulator results in translational movement of the most proximal link along the longitudinal axis of the most proximal link.
12. A method of operating a medical system comprising an entry guide, an articulated instrument, a manipulator, and a processor, the articulated instrument having a plurality of links, wherein adjacent links of the plurality of links are coupled together by a rotary joint, and wherein the articulated instrument is configured to be coupled to the manipulator so that a most proximal link of the plurality of links is at least partially disposed within the entry guide and a most distal link of the plurality of links is configured to retract into, and extend out of, the entry guide, the method comprising:
determining, using the processor, a current mode of the medical system, the current mode being one of a plurality of modes including a retraction mode; and
conditioned upon the current mode being the retraction mode:
allowing, using the processor, a part of the manipulator to be manually moved so that when the articulated instrument is coupled to the manipulator, the most proximal link moves in a direction along a longitudinal axis of the most proximal link; and
causing, using the processor, at least one of the adjacent links to be rotated about the rotary joint in response to the part of the manipulator being manually moved, so that longitudinal axes of the adjacent links are substantially in line with the longitudinal axis of the most proximal link prior to the adjacent links entering the entry guide.
13. The method according to claim 12 , further comprising:
conditioned upon the current mode being a normal mode of the plurality of modes:
operatively coupling, using the processor, an input device to the manipulator so that when the articulated instrument is coupled to the manipulator, the manipulator manipulates the articulated instrument in response to a command received from the input device.
14. The method according to claim 13 , wherein the input device is configured to be operated by a surgeon during performance of a medical procedure and the part of the manipulator is configured to be moved by an assistant during the performance of the medical procedure, wherein determining the current mode of the medical system comprises determining a current state of a switch configured to be operated by the assistant.
15. The method according to claim 12 , further comprising:
conditioned upon the current mode being the retraction mode:
causing, using the processor, the at least one of the adjacent links to be rotated about the rotary joint, so that the adjacent links define a previously deployed angle as the most distal link is extended out of, and away from, the entry guide.
16. The method according to claim 12 , further comprising:
conditioned upon the current mode being the retraction mode:
causing, using the processor, the at least one of the adjacent links to be rotated about the rotary joint, so that the at least one of the adjacent links is rotated at a rate that increases according to an increase in rate that the part of the manipulator is being manually moved.
17. The method according to claim 12 , further comprising:
conditioned upon the current mode being the retraction mode:
causing, using the processor, the at least one of the adjacent links to be rotated about the rotary joint, so that the at least one of the adjacent links is rotated at a rate that increases according to a decreasing distance of the rotary joint from a point of entry of the rotary joint into the entry guide.
18. The method according to claim 12 , further comprising:
conditioned upon the current mode being the retraction mode:
inhibiting, using the processor, the most distal link from moving in an opposite direction than a direction being commanded by the part of the manipulator being manually moved, until a distal end of the most proximal link is within a threshold distance to a distal end of the entry guide.
19. The method according to claim 12 , further comprising:
conditioned upon the current mode being the retraction mode:
causing a haptic force to be applied against movement of the part of the manipulator, wherein a magnitude of the haptic force decreases as the at least one of the adjacent links is rotated about the rotary joint towards a condition in which the longitudinal axes of the adjacent links are substantially collinear with the longitudinal axis of the most proximal link.
20. The method according to claim 12 , wherein the part of the manipulator comprises a prismatic joint coupled to the most proximal link, so that allowing the part of the manipulator to be manually moved comprises allowing translational movement of the most proximal link along the longitudinal axis of the most proximal link.