Systems and methods for controlling grip force of jaws when transitioning between position control mode and force mode
Disclosed are systems and methods for achieving a smooth transition in the grip force when the wrist jaws transition between the position and force mode. In the position mode, the desired jaw angle is above a threshold corresponding to an angle at which both jaws are just simultaneously in contact with an object held between the jaws or, if there is no object, when the jaws begin to touch each other. A feedback loop may determine that the jaws are transitioning between the modes based on changes of the desired jaw angle. The feedback loop may analyze the commanded grip force and the measured grip force to determine whether to adjust the commanded grip force during the transition. If so, the feedback loop may adjust the commanded grip force to reduce changes in the measured grip force that is otherwise based on the desired jaw angle.
1. A method for controlling grip force generated by jaws of a gripper tool of a surgical robotic system, comprising:
receiving, by a processor, an input jaw angle;
determining, by the processor, based on changes of the input jaw angle relative to a threshold jaw angle that the jaws are transitioning between a position mode and a force mode, the position mode being characterized by positioning an angle of the jaws at the input jaw angle, and the force mode being characterized by driving a grip force of the jaws to a commanded grip force, wherein the commanded grip force is determined based on the input jaw angle being below the threshold jaw angle;
measuring the grip force between the jaws to generate a measured grip force;
determining, by the processor, based on the commanded grip force and the measured grip force whether to adjust the commanded grip force during the transitioning between the position mode and the force mode; and
adjusting, by the processor, the commanded grip force during the transitioning between the position mode and the force mode in response to determining to adjust the commanded grip force.
2. The method of claim 1 , wherein determining that the jaws are transitioning between the position mode and the force mode comprises:
determining that the jaws are transitioning from the position mode to the force mode when the input jaw angle is initially larger than or equal to zero and becomes smaller than zero for a minimum time duration; or
determining that the jaws are transitioning from the force mode to the position mode when the input jaw angle is initially smaller than zero and becomes larger than or equal to zero.
3. The method of claim 1 , wherein determining that the jaws are transitioning between the position mode and the force mode comprises:
determining, by the processor, that the jaws are initially in the position mode when the input jaw angle is greater than or equal to the threshold jaw angle, wherein the threshold jaw angle is when the jaws simultaneously contact an object when the object is being held between the jaws or when the jaws begin to touch each other when there is no object being held; and
determining, by the processor, that the jaws transition from the position mode to the force mode when the input jaw angle becomes less than the threshold jaw angle for more than a minimum time duration.
4. The method of claim 3 , wherein determining whether to adjust the commanded grip force during the transitioning comprises:
determining, by the processor, to adjust the commanded grip force when the commanded grip force is increasing and a difference between the measured grip force and the commanded grip force is larger than a maximum grip force error during the transitioning from the position mode to the force mode.
5. The method of claim 4 , wherein adjusting the commanded grip force comprises:
setting, by the processor, the commanded grip force to the measured grip force minus a margin in response to determining to adjust the commanded grip force; or
setting, by the processor, the commanded grip force based on the input jaw angle in the force mode.
6. The method of claim 1 , wherein determining that the jaws are transitioning between the position mode and the force mode comprises:
determining, by the processor, that the jaws are initially in the force mode when the input jaw angle is smaller than the threshold jaw angle, wherein the threshold jaw angle is when the jaws simultaneously contact an object when the object is being held between the jaws or when the jaws begin to touch each other when there is no object being held; and
determining, by the processor, that jaws transition from the force mode to the position mode when the input jaw angle becomes larger than or equal to the threshold jaw angle.
7. The method of claim 6 , wherein determining whether to adjust the commanded grip force during the transitioning comprises:
determining, by the processor, to adjust the commanded grip force when the commanded grip force is decreasing, the commanded grip force is less than a minimum grip force, and an absolute value of a difference between the measured grip force and the minimum grip force is less than a maximum grip force error during the transitioning from the force mode to the position mode.
8. The method of claim 7 , wherein adjusting the commanded grip force comprises:
setting, by the processor, the commanded grip force to the minimum grip force in response to determining to adjust the commanded grip force; or
setting, by the processor, the commanded grip force based on the input jaw angle otherwise.
9. The method of claim 1 , further comprising:
changing, by the processor, the commanded grip force to be based on the input jaw angle in the force mode following the transitioning from the position mode to the force mode when the commanded grip force is adjusted; or
changing, by the processor, the commanded grip force to be based on the input jaw angle in the position mode following the transitioning from the force mode to the position mode when the commanded grip force is adjusted.
10. An apparatus to control jaws of a gripper tool of a surgical robotic system, comprising:
a sensor configured to estimate a grip force between the jaws to generate a measured grip force;
a processor configured to:
receive a desired jaw angle;
determine that a control mode for operating the jaws is to transition between a position mode and a force mode based on changes of the desired jaw angle with respect to a threshold jaw angle, the position mode being characterized by positioning an angle between the jaws at the desired jaw angle, and the force mode being characterized by driving a grip force of the jaws to a commanded grip force, wherein the commanded grip force is determined based on the desired jaw angle being below the threshold jaw angle;
determine whether to adjust the commanded grip force during the transition between the position mode and the force mode based on the commanded grip force and the measured grip force; and
adjust the commanded grip force during the transition between the position mode and the force mode in response to the determination to adjust the commanded grip force.
11. The apparatus of claim 10 , wherein the processor configured to determine that the jaws transition between the position mode and the force mode comprises:
determine that the jaws transition from the position mode to the force mode when the desired jaw angle is initially larger than or equal to zero and becomes smaller than zero for a minimum time duration; or
determine that the jaws transition from the force mode to the position mode when the desired jaw angle is initially smaller than zero and becomes larger than or equal to zero.
12. The apparatus of claim 10 , wherein the processor configured to determine that the jaws transition between the position mode and the force mode comprises:
determine that the jaws are initially in the position mode when the desired jaw angle is greater than or equal to the threshold jaw angle, wherein the threshold jaw angle is when the jaws simultaneously contact an object when the object is being held between the jaws or when the jaws begin to touch each other when there is no object being held; and
determine that the jaws transition from the position mode to the force mode when the desired jaw angle becomes less than the threshold jaw angle for more than a minimum time duration.
13. The apparatus of claim 12 , wherein the processor configured to determine whether to adjust the commanded grip force during the transition comprises:
determine to adjust the commanded grip force when the commanded grip force is increasing and a difference between the measured grip force and the commanded grip force is larger than a maximum grip force error during the transition from the position mode to the force mode.
14. The apparatus of claim 13 , wherein the processor configured to adjust the commanded grip force comprises:
set the commanded grip force to the measured grip force minus a margin in response to the determination to adjust the commanded grip force; or
set the commanded grip force based on the desired jaw angle in the force mode otherwise.
15. The apparatus of claim 10 , wherein the processor configured to determine that the jaws transition between the position mode and the force mode comprises:
determine that the jaws are initially in the force mode when the desired jaw angle is smaller than the threshold jaw angle, wherein the threshold jaw angle is when the jaws simultaneously contact an object when the object is being held between the jaws or when the jaws begin to touch each other when there is no object being held; and
determine that the jaws transition from the force mode to the position mode when the desired jaw angle becomes larger than or equal to the threshold jaw angle.
16. The apparatus of claim 15 , wherein the processor configured to determine whether to adjust the commanded grip force during the transition comprises:
determine to adjust the commanded grip force when the commanded grip force is decreasing, the commanded grip force is less than a minimum grip force, and an absolute value of a difference between the measured grip force and the minimum grip force is less than a maximum grip force error during the transition from the force mode to the position mode.
17. The apparatus of claim 16 , wherein the processor configured to adjust the commanded grip force comprises:
set the commanded grip force to the minimum grip force in response to the determination to adjust the commanded grip force; or
set the commanded grip force based on the desired jaw angle in the force mode otherwise.
18. The apparatus of claim 10 , where the processor is further configured to:
change the commanded grip force to be based on the desired jaw angle in the force mode subsequent to the transition from the position mode to the force mode when the processor is configured to adjust the commanded grip force; or
change the commanded grip force to be based on the desired jaw angle in the position mode subsequent to the transition from the force mode to the position mode when the processor is configured to adjust the commanded grip force.
19. A surgical robotic system, comprising:
an end effector including a pair of jaws;
a user interface device configured to generate an input jaw angle for the jaws;
a processor communicatively coupled to the end effector, the processor configured to:
determine that the jaws transition between a position mode and a force mode based on changes of the input jaw angle with respect to a threshold jaw angle, the position mode being characterized by positioning an angle between the jaws at the input jaw angle, and the force mode being characterized by driving a grip force of the jaws to a commanded grip force wherein the commanded grip force is determined based on the input jaw angle being below the threshold jaw angle;
measure a grip force between the pair of jaws to generate a measured grip force;
determine whether to adjust the commanded grip force during the transition between the position mode and the force mode based on the commanded grip force and the measured grip force; and
adjust the commanded grip force during the transition between the position mode and the force mode in response to the determination to adjust the commanded grip force.
20. The surgical robotic system of claim 19 , wherein the processor configured to determine that the jaws transition between the position mode and the force mode comprises:
determine that the jaws are initially in the position mode when the input jaw angle is greater than or equal to the threshold jaw angle, wherein the threshold jaw angle is when the jaws simultaneously contact an object when the object is being held between the jaws or when the jaws begin to touch each other when there is no object being held; and
determine that that the jaws transition from the position mode to the force mode when the input jaw angle becomes less than the threshold jaw angle for more than a minimum time duration,
and wherein the processor configured to determine whether to adjust the commanded grip force during the transition comprises:
determine to adjust the commanded grip force when the commanded grip force is increasing and a difference between the measured grip force and the commanded grip force is larger than a maximum grip force error during the transition from the position mode to the force mode,
and wherein the processor configured to adjust the commanded grip force comprises:
set the commanded grip force to the measured grip force minus a margin in response to the determination to adjust the commanded grip force; or
set the commanded grip force based on the input jaw angle in the force mode otherwise.