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 angle for the end effector;
translate the angle to a command for the actuator with a compensation term,
wherein the compensation term is based on a source of hysteresis for backlash or compliance; and
send the command with the compensation term to the actuator.
2. The surgical robotic system of claim 1 , the one or more processors configured to:
access a first polynomial for translating the desired angle to the command when the desired angle corresponds to opening a joint associated with the end effector; and
access a second polynomial for translating the desired angle to the command when the desired angle corresponds to closing the joint associated with the end effector.
3. The surgical robotic system of claim 2 , wherein the first polynomial or the second polynomial includes the compensation term.
4. The surgical robotic system of claim 1 , the one or more processors configured to:
determine whether the desired angle corresponds to a clockwise rotation or a counter-clockwise rotation for a joint associated with the end effector, wherein the compensation term is selected according to the clockwise rotation or the counter-clockwise rotation.
5. The surgical robotic system of claim 1 , wherein the compensation term compensates for a plurality of regions in a relationship between the actuator and a measured position for the end effector.
6. The surgical robotic system of claim 5 , wherein the plurality of regions includes a compliance region in which a hysteresis or recoil is substantially from compliance, or wherein the plurality of regions includes a backlash region in which the hysteresis or recoil is substantially from backlash.
7. The surgical robotic system of claim 5 , wherein the plurality of regions includes a combination region in which a hysteresis or recoil is from backlash and compliance.
8. 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 angle for the end effector;
translate the angle to a command for the actuator with a compensation term; and
send the command with the compensation term to the actuator,
wherein the compensation term compensates for a plurality of regions in a relationship between the actuator and a measured position for the end effector, wherein the plurality of regions includes a compliance region in which a hysteresis or recoil is substantially from compliance, or wherein the plurality of regions includes a backlash region in which the hysteresis or recoil is substantially from backlash.
9. 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 angle for the end effector;
translate the angle to a command for the actuator with a compensation term; and
send the command with the compensation term to the actuator, wherein the compensation term compensates for a plurality of regions in a relationship between the actuator and a measured position for the end effector, wherein the plurality of regions includes a combination region in which a hysteresis or recoil is from backlash and compliance.