Admittance compensation for surgical tool
The disclosed embodiments relate to systems and methods for a surgical tool or a surgical robotic system. An actuator or a motor of a tool driver is configured to operate a joint of a tool. One or more processors are configured to receive an initial joint command for the joint of the tool, determine a joint torque based on motor torque of the motor or actuator as well as motor to joint torque mapping, calculate a tip force based on an effective length associated with the joint and based on the joint torque, compare the tip force to a predetermined threshold, calculate an admittance control compensation term in response to the tip force exceeding the predetermined threshold, and generate a command for the motor or actuator based on the admittance control compensation term and the initial joint command.
1. A surgical robotic system comprising:
a tool driver;
a motor of the tool driver, the motor configured to operate a joint of a tool; and
one or more processors configured to:
receive an initial joint command for the joint of the tool;
determine a joint torque based on motor torque of the motor;
calculate a tip force based on an effective geometry associated with the joint and based on the joint torque;
perform a comparison of the tip force to a predetermined threshold;
calculate an admittance control compensation term in response to the comparison of the tip force and the predetermined threshold; and
generate a command for the motor based on the admittance control compensation term and the initial joint command.
2. The surgical robotic system of claim 1 , wherein the joint is a closure joint.
3. The surgical robotic system of claim 2 , wherein the effective geometry is the length of a jaw for the closure joint.
4. The surgical robotic system of claim 1 , wherein the joint is a roll joint.
5. The surgical robotic system of claim 4 , wherein the effective geometry is the length of the roll joint.
6. The surgical robotic system of claim 1 , wherein the admittance control compensation term is based on an inverse of mechanical impedance of at least a portion of the tool.
7. The surgical robotic system of claim 6 , wherein the mechanical impedance is a degree of resistance to motion that the portion of the tool provides.
8. The surgical robotic system of claim 1 , the one or more processors configured to:
receive sensor data for the position of the motor for the joint of the tool; and
modify the command for the motor in response to the sensor data.
9. The surgical robotic system of claim 1 , wherein the command for the motor based on the admittance control compensation term improves safety at the tip of the tool.
10. The surgical robotic system of claim 1 , the one or more processors configured to:
calculate a tip force saturation value in response to the comparison of the tip force to the predetermined threshold, wherein the admittance control compensation term is based on the tip force saturation value.
11. An apparatus comprising:
a tool driver;
an actuator driven by the tool driver, the actuator configured to operate a joint of a tool;
a torque sensor configured to collect sensor data for a joint torque associated with the actuator; and
a controller configured to generate one or more commands for the actuator based on an admittance control compensation term, wherein the admittance control compensation term is calculated based on the sensor data for the joint torque and a tip force of the tool.
12. The apparatus of claim 11 , wherein the tip force is based on an effective geometry associated with the joint and based on the joint torque.
13. The apparatus of claim 12 , wherein the joint is a closure joint and the effective geometry is the length of a jaw for the closure joint.
14. The apparatus of claim 12 , wherein the joint is a roll joint and the effective geometry corresponds to the roll joint.
15. The apparatus of claim 11 , wherein the controller is configured to calculate the admittance control compensation term in response to the tip force exceeding a predetermined threshold.
16. A method comprising:
receiving an initial joint command for the joint of a surgical tool;
determining a joint torque based on motor torque of a motor for the joint of the surgical tool;
calculating a tip force based on an effective geometry associated with the joint and based on the joint torque;
comparing the tip force to a predetermined threshold;
calculating an admittance control compensation term in response to the comparison of the tip force and the predetermined threshold; and
generating a command for the motor based on the admittance control compensation term and the initial joint command.
17. The method of claim 16 , wherein the joint is a closure joint and the effective geometry is the length of a jaw for the closure joint.
18. The method of claim 16 , wherein the joint is a roll joint and the effective geometry corresponds to the roll joint.
19. The method of claim 16 , further comprising:
calculate a tip force saturation value in response to the comparison of the tip force to the predetermined threshold.
20. The method of claim 19 , wherein the admittance control compensation term is based on the tip force saturation value.