Joint calibration for surgical tool
The disclosed embodiments relate to systems and methods for a surgical tool or a surgical robotic system. An end effector of the surgical tool is coupled to a tool driver. An actuator is driven by a motor of the tool driver and configured to drive a degree of freedom of the end effector. One or more processors are configured to receive a position command describing a desired position for the end effector, translate the desired position to a command for a joint associated with the end effector, calculate a compensation term to compensate for a source of hysteresis for backlash and/or compliance, and send a motor command for the motor coupled with the actuator based on the compensation term and the command for the end effector.
1. A surgical robotic system, comprising:
an end effector of a surgical tool coupled to a tool driver;
an actuator of the tool driver, the actuator configured to drive the end effector; and
one or more processors configured to:
receive a position command describing a desired position for the end effector;
translate the desired position to a command for a joint associated with the end effector;
calculate a compensation term to compensate for a source of hysteresis for backlash or compliance; and
send an instruction for the actuator based on the compensation term and the command for the end effector.
2. The surgical robotic system of claim 1 , wherein the joint is a closure joint and the desired position includes a closure angle.
3. The surgical robotic system of claim 2 , the one or more processors configured to:
determine whether the desired position corresponds to opening the closure joint or closing the closure joint.
4. The surgical robotic system of claim 3 , the one or more processors configured to:
access a first polynomial for translating the desired position to the command for the closure joint when the desired position corresponds to opening the closure joint; and
access a second polynomial for translating the desired position to the command for the closure joint when the desired position corresponds to closing the closure joint.
5. The surgical robotic system of claim 1 , wherein the joint is a roll joint and the desired position includes a roll angle.
6. The surgical robotic system of claim 5 , the one or more processors configured to:
determine whether the desired position corresponds to a clockwise rotation or a counter-clockwise rotation for the roll joint, wherein the compensation term is selected according to the clockwise rotation or the counter-clockwise rotation.
7. The surgical robotic system of claim 1 , wherein the source of hysteresis or recoil includes a gearbox, a driver interface, an internal gear mechanism, or a driving mechanism for the end effector.
8. The surgical robotic system of claim 1 , wherein the source of hysteresis or recoil includes a pad that presses against a jaw of the end effector.
9. The surgical robotic system of claim 1 , wherein the compensation term compensates for a plurality of regions in a relationship between the instruction for the actuator and a measured position for the end effector.
10. The surgical robotic system of claim 9 , wherein the plurality of regions includes a compliance region in which the source of hysteresis or recoil is substantially from compliance, or wherein the plurality of regions includes a backlash region in which the source of hysteresis or recoil is substantially from backlash.
11. The surgical robotic system of claim 9 , wherein the plurality of regions includes a combination region in which the source of hysteresis or recoil is from backlash and compliance.
12. A surgical robotic system, comprising:
an end effector of a surgical tool coupled to a tool driver;
an actuator of the tool driver, the actuator configured to drive the end effector; and
one or more processors configured to:
receive a position command describing a desired position for the end effector;
translate the desired position to a command for a joint associated with the end effector;
calculate a compensation term to compensate for a source of hysteresis for backlash or compliance;
receive sensor data for the position of the actuator or the associated end effector;
modify an instruction for the actuator in response to the sensor data; and
send the modified instruction for the actuator based on the compensation term and the command for the end effector.
13. The surgical robotic system of claim 12 , the one or more processors configured to:
modify the compensation term in response to the sensor data, wherein the modified instruction is based on the modified compensation term.
14. A surgical robotic system, comprising:
an end effector of a surgical tool coupled to a tool driver;
an actuator of the tool driver, the actuator configured to drive the end effector; and
one or more processors configured to:
receive a position command describing a desired position for the end effector;
translate the desired position to a command for a joint associated with the end effector;
calculate a compensation term to compensate for a source of hysteresis for backlash or compliance, wherein the compensation term compensates for a relationship between an instruction for the actuator and a measured position for the end effector, wherein the relationship includes:
(i) a compliance region in which the source of hysteresis or recoil is substantially from compliance; or
(ii) a backlash region in which the source of hysteresis or recoil is substantially from backlash; and
send the instruction for the actuator based on the compensation term and the command for the end effector.
15. The surgical robotic system of claim 14 , wherein the joint is a closure joint and the desired position includes a closure angle.
16. The surgical robotic system of claim 15 , the one or more processors configured to:
determine whether the desired position corresponds to opening the closure joint or closing the closure joint.
17. The surgical robotic system of claim 16 , the one or more processors configured to:
access a first polynomial for translating the desired position to the command for the closure joint when the desired position corresponds to opening the closure joint; and
access a second polynomial for translating the desired position to the command for the closure joint when the desired position corresponds to closing the closure joint.
18. The surgical robotic system of claim 14 , wherein the joint is a roll joint and the desired position includes a roll angle.
19. The surgical robotic system of claim 18 , the one or more processors configured to:
determine whether the desired position corresponds to a clockwise rotation or a counter-clockwise rotation for the roll joint, wherein the compensation term is selected according to the clockwise rotation or the counter-clockwise rotation.
20. The surgical robotic system of claim 14 , wherein the source of hysteresis or recoil includes a gearbox, a driver interface, an internal gear mechanism, or a driving mechanism for the end effector.