Systems and methods for limiting grip force of closing jaws in position control mode
Disclosed are systems and methods for limiting the grip force generated by closing robotic wrist jaws while operating in position mode in which the jaws are commanded to a desired jaw angle prior to being commanded to generate a grip force. In the positional mode, the desired jaw angle is above a threshold that corresponds to an angle at which both jaws are just simultaneously in contact with an object between the jaws or, if there is no object to grasp, when the jaws begin to touch each other. A feedback loop may analyze the desired jaw angle and the measured grip force to determine if the jaws are closing in the position mode and if the measured grip force exceeds a maximum grip force threshold. If so, the feedback loop may calculate a grip force error to limit the measured grip force to the maximum grip force threshold.
1. A method for controlling grip force generated by jaws of a gripper tool of a surgical robotic system, comprising:
determining, by a processor, based on an input jaw angle between the jaws that the jaws are closing in a position mode, the position mode being characterized by using a position command to position the jaws at the input jaw angle;
measuring a grip force between the jaws while the jaws are closing in the position mode;
determining, by the processor, whether the measured grip force exceeds a grip force threshold in the position mode;
generating, by the processor, a grip force error in response to determining that the measured grip force exceeds the grip force threshold, wherein the grip force error comprises a difference between the measured grip force and the grip force threshold;
generating an updated position command based on the grip force error; and
applying the updated position command to position the jaws, which limits the grip force to the grip force threshold.
2. The method of claim 1 , wherein determining that the jaws are closing in the position mode comprises:
determining, by the processor, that the input jaw angle is greater than or equal to a threshold jaw angle for more than a minimum time period, wherein the threshold jaw angle comprises a jaw angle when the jaws simultaneously contact an object held between the jaws or when the jaws begin to touch each other without an object being held.
3. The method of claim 1 , wherein determining that the jaws are closing in the position mode comprises:
determining, by the processor, that the input jaw angle is decreasing in the position mode for a minimum time period.
4. The method of claim 1 , wherein determining whether the measured grip force exceeds the grip force threshold comprises:
determining, by the processor, that the measured grip force exceeds the grip force threshold as long as the measured grip force exceeds the grip force threshold minus a margin anywhere within a time window.
5. The method of claim 4 , wherein a length of the time window is measured by a grip force counter, wherein an operation of the grip force counter comprises:
incrementing the grip force counter by one when the measured grip force is less than the grip force threshold minus the margin every time the measured grip force is sampled; and
resetting the grip force counter when the measured grip force is larger than the grip force threshold.
6. The method of claim 5 , wherein determining whether the measured grip force exceeds the grip force threshold further comprises:
determining, by the processor, that the measured grip force exceeds the grip force threshold for an entirety of the length of the time window equaling to the grip force counter when the measured grip force exceeds the grip force threshold minus the margin anywhere within the time window.
7. The method of claim 1 , wherein generating the updated position command comprises:
generating a compensating position command by the processor from the grip force error; and
combining the compensating position command and the position command by the processor to generate the updated position command.
8. An apparatus for controlling grip force in a surgical robotic system, comprising:
a processor configured to:
determine, based on an input jaw angle, wherein the input jaw angle represents an angle between the jaws of a surgical gripper tool, that the jaws are closing in a position mode, the position mode being characterized by using a position command to position the jaws at the input jaw angle;
measure a grip force between the jaws while the jaws are closing in the position mode;
determine whether the measured grip force exceeds a grip force threshold in the position mode;
generate a grip force error in response to determining that the measured grip force exceeds the grip force threshold, wherein the grip force error comprises a difference between the measured grip force and the grip force threshold;
generate an updated position command based on the grip force error; and
apply the updated position command to position the jaws, which limits the grip force to the grip force threshold.
9. The apparatus of claim 8 , wherein the processor configured to determine that the jaws are closing in the position mode comprises:
determine that the input jaw angle is greater than or equal to a threshold jaw angle for more than a minimum time period, wherein the threshold jaw angle comprises a jaw angle when the jaws simultaneously contact an object held between the jaws or when the jaws begin to touch each other without an object being held.
10. The apparatus of claim 8 , wherein the processor configured to determine that the jaws are closing in the position mode comprises:
determine that the input jaw angle is decreasing in the position mode for a minimum time period.
11. The apparatus of claim 8 , wherein the processor configured to determine whether the measured grip force exceeds the grip force threshold comprises:
determine that the measured grip force exceeds the grip force threshold as long as the measured grip force exceeds the grip force threshold minus a margin anywhere within a time window.
12. The apparatus of claim 11 , wherein a length of the time window is measured by a grip force counter, wherein the grip force counter is configured to:
increment the grip force counter by one when the measured grip force is less than the grip force threshold minus the margin every time the measured grip force is sampled; and
reset the grip force counter when the measured grip force is larger than the grip force threshold.
13. The apparatus of claim 12 , wherein the processor configured to determine whether the measured grip force exceeds the grip force threshold further comprises:
determine that the measured grip force exceeds the grip force threshold for an entirety of the length of the time window equaling to the grip force counter when the measured grip force exceeds the grip force threshold minus the margin anywhere within the time window.
14. The apparatus of claim 8 , wherein the processor configured to generate the updated position command comprises:
generate a compensating position command by the processor from the grip force error; and
combine the compensating position command and the position command by the processor to generate the updated position command.
15. A surgical robotic system, comprising:
jaws of a gripper tool; and
a processor configured to:
determine, based on an input jaw angle between the jaws that the jaws are closing in a position mode, the position mode being characterized by using a position command to position the jaws at the input jaw angle;
measure a grip force between the jaws while the jaws are closing in the position mode;
determine whether the measured grip force exceeds grip force threshold in the position mode;
generate a grip force error in response to determining that the measured grip force exceeds the grip force threshold, wherein the grip force error comprises a difference between the measured grip force and the grip force threshold;
generate an updated position command based on the grip force error; and
apply the updated position command to position the jaws, which limits the grip force to the grip force threshold.
16. The surgical robotic system of claim 15 , wherein the processor configured to determine that the jaws are closing in the position mode comprises:
determine that the input jaw angle is greater than or equal to a threshold jaw angle for more than a minimum time period, wherein the threshold jaw angle comprises a jaw angle when the jaws simultaneously contact an object held between the jaws or when the jaws begin to touch each other without an object being held.
17. The surgical robotic system of claim 15 , wherein the processor configured to determine that the jaws are closing in the position mode comprises:
determine that the input jaw angle is decreasing in the position mode for a minimum time period.
18. The surgical robotic system of claim 15 , wherein the processor configured to determine whether the measured grip force exceeds the grip force threshold comprises:
determine that the measured grip force exceeds the grip force threshold as long as the measured grip force exceeds the grip force threshold minus a margin anywhere within a time window.