Ratcheting for master alignment of a teleoperated minimally invasive surgical instrument
A teleoperated system includes a robotic arm configured to support an instrument, a grip configured to be manipulated by an operator to command motion of the instrument, and a control system communicatively coupled to the robotic arm and the grip. To align the grip with the instrument by the grip, the control system is configured to determine grip rotation values describing an orientation of the grip, determine instrument rotation values describing an orientation of the instrument, determine an orientation error between the orientation of the grip and the orientation of the instrument based on the grip rotation values and the instrument rotation values, produce a motion command by selectively imposing, based on the orientation error, an artificial joint limit on a commanded movement of the instrument, and command the robotic arm to move in accordance with the motion command.
1. A teleoperated system comprising:
a robotic arm configured to support an instrument;
a grip configured to be manipulated by an operator to command motion of the instrument; and
a control system communicatively coupled to the robotic arm and the grip;
wherein to align the grip with the instrument, the control system is configured to:
determine grip rotation values describing an orientation of the grip,
determine instrument rotation values describing an orientation of the instrument,
determine an orientation error between the orientation of the grip and the orientation of the instrument based on the grip rotation values and the instrument rotation values,
produce a motion command by selectively imposing, based on the orientation error, an artificial joint limit on a commanded movement of the instrument, and
command the robotic arm to move in accordance with the motion command.
2. The teleoperated system of claim 1 , wherein the control system is further configured to:
determine the artificial joint limit based on the orientation error.
3. The teleoperated system of claim 2 , wherein to determine the artificial joint limit based on the orientation error, the control system is configured to:
widen the artificial joint limit as the orientation error decreases.
4. The teleoperated system of claim 1 , wherein imposing the artificial joint limit comprises allowing the instrument to move in a same relative direction as the grip until the artificial joint limit is reached.
5. The teleoperated system of claim 1 , wherein selectively imposing the artificial joint limit comprises:
imposing the artificial joint limit when the orientation error is above a threshold.
6. The teleoperated system of claim 1 , wherein the control system is further configured to:
apply force feedback to the grip when the artificial joint limit has been reached.
7. The teleoperated system of claim 1 , wherein the orientation of the instrument is an orientation of a tip of the instrument.
8. The teleoperated system of claim 1 , wherein the control system is further configured to:
determine if the grip is right-side-up or upside-down; and
determine the orientation error further based on whether the grip is right-side-up or upside-down.
9. The teleoperated system of claim 8 , wherein the control system is further configured to:
rotate, when the grip is upside-down grip, a relative rotation matrix characterizing the orientation error before determining the orientation error.
10. A method of controlling a teleoperated system comprising a robotic arm configured to support an instrument, the method comprising:
determining, by one or more processors of the teleoperated system, grip rotation values describing an orientation of a grip configured to be manipulated by an operator to command motion of the instrument;
determining, by the one or more processors, instrument rotation values describing an orientation of the instrument controlled by the grip;
determining, by the one or more processors, an orientation error between the orientation of the grip and the orientation of the instrument based on the grip rotation values and the instrument rotation values; and
producing a motion command by selectively imposing, by the one or more processors and based on the orientation error, an artificial joint limit on a commanded movement of the instrument; and
commanding, by the one or more processors, the robotic arm to move in accordance with the motion command.
11. The method of claim 10 , further comprising:
determining, by the one or more processors, the artificial joint limit based on the orientation error.
12. The method of claim 11 , wherein determining the artificial joint limit based on the orientation error comprises:
widening the artificial joint limit as the orientation error decreases.
13. The method of claim 10 , wherein imposing the artificial joint limit comprises allowing the instrument to move in a same relative direction as the grip until the artificial joint limit is reached.
14. The method of claim 10 , wherein selectively imposing the artificial joint limit comprises:
imposing, by the one or more processors, the artificial joint limit when the orientation error is above a threshold.
15. The method of claim 10 , further comprising:
applying, by the one or more processors, force feedback to the grip when the artificial joint limit has been reached.
16. The method of claim 10 , further comprising:
determining, by the one or more processors, if the grip is right-side-up or upside-down; wherein
determining, by the one or more processors, the orientation error further based on whether the grip is right-side-up or upside-down.
17. A non-transitory computer-readable medium comprising computer-readable code which, when executed by one or more processors associated with a teleoperated system, are adapted to cause the one or more processors to perform a method comprising:
determining grip rotation values describing an orientation of a grip configured to be manipulated by an operator to command motion of an instrument, the teleoperated system comprising a robotic arm configured to support the instrument;
determining instrument rotation values describing an orientation of the instrument controlled by the grip;
determining an orientation error between the orientation of the grip and the orientation of the instrument based on the grip rotation values and the instrument rotation values; and
producing a motion command by selectively imposing, based on the orientation error, an artificial joint limit on a commanded movement of the instrument; and
commanding, by the one or more processors, the robotic arm to move in accordance with the motion command.
18. The non-transitory computer-readable medium of claim 17 , wherein the method further comprises:
determining the artificial joint limit based on the orientation error.
19. The non-transitory computer-readable medium of claim 17 , wherein selectively imposing the artificial joint limit comprises:
imposing the artificial joint limit when the orientation error is above a threshold.
20. The non-transitory computer-readable medium of claim 17 , wherein the method further comprises:
determining, by the one or more processors, if the grip is right-side-up or upside-down; and
determining, by the one or more processors, the orientation error further based on whether the grip is right-side-up or upside-down.