Ratcheting for master alignment of a teleoperated minimally invasive surgical instrument
A minimally-invasive surgical system includes a slave surgical instrument having a slave surgical instrument tip and a master grip. The slave surgical instrument tip has an alignment in a common frame of reference and the master grip, which is coupled to the slave surgical instrument, has an alignment in the common frame of reference. An alignment error, in the common frame of reference, is a difference in alignment between the alignment of the slave surgical instrument tip and the alignment of the master grip. A ratcheting system (i) coupled to the master grip to receive the alignment of the master grip and (ii) coupled to the slave surgical instrument, to control motion of the slave by continuously reducing the alignment error, as the master grip moves, without autonomous motion of the slave surgical instrument tip and without autonomous motion of the master grip.
1. A teleoperated system comprising:
a master grip; and
a controller configured to be coupled to a teleoperated slave instrument, the controller being configured to:
align the master grip with the slave instrument, wherein the controller being configured to align the master grip with the slave instrument comprises: the controller being configured to introduce a control system error between a slave instrument alignment and a master grip alignment to speed up convergence of alignment between the slave instrument and the master grip relative to convergence of alignment between the slave instrument and the master grip without introduction of the control system error.
2. The teleoperated system of claim 1 , wherein the controller being configured to align the master grip with the slave instrument further comprises: the controller being configured to use a new alignment error to control motion of the slave instrument only if the new alignment error is smaller than a current alignment error.
3. The teleoperated system of claim 1 , wherein the controller being configured to introduce a control system error comprises: the controller being configured to artificially adjust a commanded movement of the slave instrument.
4. The teleoperated system of claim 1 :
wherein the controller being configured to align the master grip with the slave instrument further comprises: the controller being configured to characterize a rotation angle error between an alignment of the master grip and an alignment of the slave instrument; and
wherein the controller being configured to introduce a control system error comprises: the controller being configured to adjust a commanded movement of the slave instrument based on the rotation angle error.
5. The teleoperated system of claim 4 , wherein the controller being configured to adjust a commanded movement of the slave instrument based on the rotation angle error comprises: the controller being configured to penalize the commanded movement of the slave instrument based on the rotation angle error and a penalty profile.
6. The teleoperated system of claim 5 , wherein the controller being configured to adjust a commanded movement of the slave instrument based on the rotation angle error comprises: the controller being configured to select a scale factor based on the rotation angle error, wherein the scale factor is used to adjust the commanded movement of the slave instrument.
7. The teleoperated system of claim 5 , wherein the penalty profile comprises a continuous and monotonic penalty profile.
8. The teleoperated system of claim 5 , wherein the penalty profile comprises a first region for values of the rotation angle error less than a first value, a third region for values of the rotation angle error greater than a second value, and a second region for values of the rotation angle error between the first value and the second value.
9. The teleoperated system of claim 1 , wherein the master grip is selected from a group consisting of: a master grip without powered alignment and a master grip with powered alignment.
10. A teleoperated system comprising:
a master grip; and
a controller coupled to the master grip and configured to be coupled to a teleoperated slave instrument, the controller being configured to align the master grip with the teleoperated slave instrument, wherein the controller being configured to align the master grip with the teleoperated slave instrument comprises the controller being configured to:
characterize a rotation angle error between an alignment of the master grip and an alignment of the slave instrument; and
generate a commanded movement for the slave instrument based on an output taken from a penalty profile, wherein the output taken from the penalty profile is selected using the rotation angle error.
11. The teleoperated system of claim 10 , wherein the alignment of the teleoperated slave instrument is an alignment of a tip of the teleoperated slave instrument.
12. The teleoperated system of claim 10 , wherein the penalty profile comprises a first region for values of the rotation angle error less than a first value, a third region for values of the rotation angle error greater than a second value, and a second region for values of the rotation angle error between the first value and the second value.
13. The teleoperated system of claim 12 , wherein the penalty profile comprises a curve, wherein the first value is at a first inflection point of the curve, and wherein the second value is at a second inflection point of the curve.
14. The teleoperated system of claim 10 , wherein the output is a scale factor.
15. The teleoperated system of claim 10 , the controller further being configured to impose a joint limit on the commanded movement.
16. The teleoperated system of claim 10 , wherein the rotation angle error is one Euler angle in a set of Euler angles.
17. The teleoperated system of claim 10 , wherein the penalty profile comprises a continuous and monotonic penalty profile.
18. The teleoperated system of claim 10 , wherein the penalty profile is the same for all users of the teleoperated system.
19. The teleoperated system of claim 10 , wherein the master grip is selected from a group consisting of: a master grip without powered alignment and a master grip with powered alignment.
20. A method of operating a teleoperated system, the teleoperated system comprising a master grip and a robot arm configured to move a slave instrument, the method comprising:
characterizing a rotation angle error between an alignment of the master grip and an alignment of the slave instrument; and
generating a commanded movement for the slave instrument based on an output taken from a penalty profile, wherein the output taken from the penalty profile is selected using the rotation angle error.
21. The method of claim 20 , wherein the penalty profile comprises a first region for values of the rotation angle error less than a first value, a third region for values of the rotation angle error greater than a second value, and a second region for values of the rotation angle error between the first value and the second value.
22. The method of claim 20 , wherein the alignment of the slave instrument is an alignment of a tip of the slave instrument.
23. The method of claim 20 , wherein the penalty profile comprises a continuous and monotonic penalty profile.