System and method for force or torque limit compensation
A system and method of force or torque limit compensation includes a surgical instrument for use with a computer-assisted medical device. The surgical instrument includes an end effector located at a distal end of the instrument, a drive unit for operating a degree of freedom of the instrument, a shaft coupled to the drive unit, and one or more drive mechanisms in the shaft for coupling force or torque from the drive unit to the end effector and the articulated wrist. To control the degree of freedom, the instrument is configured to determine a current position of the degree of freedom, determine a force or torque limit compensation based on the current position, alter one or more force or torque limits based on the force or torque limit compensation, and adjust the degree of freedom subject to the one or more force or torque limits.
1. A computer-assisted device comprising:
an end effector located at a distal end of the computer-assisted device;
a drive unit for operating a degree of freedom of the computer-assisted device;
a shaft coupled to the drive unit;
one or more drive mechanisms in the shaft for coupling force or torque from the drive unit to the end effector; and
a control unit configured to:
determine a current position of the degree of freedom;
determine a force or torque limit compensation based on the current position;
alter one or more force or torque limits based on the force or torque limit compensation; and
adjust, using the drive unit, the degree of freedom subject to the one or more force or torque limits.
2. The computer-assisted device of claim 1 , wherein the degree of freedom is associated with:
an angle of gripping jaws of the end effector;
an amount of extension of a cutting blade of the end effector; or
a flex angle of an articulated wrist coupling the end effector to the shaft.
3. The computer-assisted device of claim 1 , wherein the one or more force or torque limits include an upper limit associated with a maximum force or torque that may be applied to adjust the degree of freedom.
4. The computer-assisted device of claim 1 , wherein the one or more force or torque limits include an upper limit and a lower limit specifying a range of forces or torques that may be applied to adjust the degree of freedom.
5. The computer-assisted device of claim 1 , wherein the current position is measured at the drive unit.
6. The computer-assisted device of claim 1 , wherein a relationship between the current position and the force or torque limit compensation is modeled using a compensation curve.
7. The computer-assisted device of claim 6 , wherein the compensation curve includes:
a transition region wherein the compensation curve has a first slope;
an operational region wherein the compensation curve has a second slope smaller than the first slope; and
a saturation region wherein the force or torque limit compensation is at a maximum value.
8. The computer-assisted device of claim 7 , wherein the compensation curve further includes a start-up region wherein the force or torque limit compensation is zero.
9. The computer-assisted device of claim 6 , wherein the compensation curve includes hysteresis.
10. The computer-assisted device of claim 6 , wherein the compensation curve is symmetric about a home position of the degree of freedom.
11. The computer-assisted device of claim 1 , wherein a relationship between the current position and the force or torque limit compensation is modeled using a lookup table of control points.
12. The computer-assisted device of claim 11 , wherein the lookup table and an interpolation are used to determine the force or torque limit compensation based on the current position.
13. The computer-assisted device of claim 1 , wherein the force or torque limit compensation compensates for a restraining or return to home force or torque applied to the degree of freedom.
14. The computer-assisted device of claim 1 , wherein the one or more force or torque limits are altered by adding the force or torque limit compensation to each of the one or more force or torque limits.