DETECTION OF DISENGAGEMENT IN CABLE DRIVEN TOOL
The disclosed embodiments relate to systems and methods for a surgical tool or a surgical robotic system. One example system for detecting disengagement of a surgical tool, includes an end effector connected to and driven by cables of a tool driver, sensors configured to detect forces associated with the cables, and one or more processors. The one or more processors identify cable tensions derived from forces detected by the sensors, compare the tension to a threshold tension value, calculate a velocity norm value based on a vector including the velocity value for each of the cables, compare the velocity norm value to a statistic velocity threshold, and identify a disengagement of at least one of the cables based on the first comparison and the second comparison.
1 . An apparatus for detecting disengagement of a surgical tool, the apparatus comprising:
an end effector connected to and driven by a plurality of cables of a tool driver;
a plurality of sensors configured to detect forces associated with the plurality of cables; and
one or more processors configured to:
identify a tension of at least one of the plurality of cables derived from at least one of the forces detected by the plurality of sensors;
identify a velocity value for each of the plurality of cables; and
detect a disengagement of at least one of the plurality of cables or associated components based on the tension of at least one of the plurality of cables and the velocity value for each of the plurality of cables.
2 . The apparatus of claim 1 , one or more processors configured to:
calculate a velocity threshold; and
compare the velocity threshold to the velocity value for each of the plurality of cables.
3 . The apparatus of claim 2 , wherein the velocity threshold is based on a commanded velocity.
4 . The apparatus of claim 3 , wherein the velocity threshold is calculated, in part, from a Bayesian filter based on a commanded velocity.
5 . The apparatus of claim 3 , wherein the velocity threshold is calculated, in part, from a standard deviation of a time series of data.
6 . The apparatus of claim 5 , one or more processors configured to:
calculate a chi squared value for the time series of data.
7 . The apparatus of claim 1 , one or more processors configured to:
identify a tension threshold; and
compare the tension of at least one of the plurality of cables to the tension threshold.
8 . The apparatus of claim 1 , one or more processors configured to:
calculate the tension of at least one of the plurality of cables from an inverse kinematics model for the surgical tool.
9 . The apparatus of claim 8 , wherein the inverse kinematics model includes a relationship between torque detected at respective motors and the tension of the at least one of the plurality of cables according to an inverse kinematics matrix.
10 . The apparatus of claim 1 , further comprising:
a plurality of motors coupled to the plurality of cables, respectively, wherein the plurality of sensors detect torque at respective ones of the plurality of motors.
11 . The apparatus of claim 1 , one or more processors configured to:
calculate the velocity value for each of the plurality of cables from an inverse kinematics model.
12 . The apparatus of claim 1 , one or more processors configured to:
generate a message in response to the disengagement of at least one of the plurality of cables or associated components.
13 . The apparatus of claim 12 , wherein the message is a user alert with instructions for a user of the surgical tool.
14 . The apparatus of claim 12 , wherein the message dispatches services for the surgical tool.
15 . The apparatus of claim 12 wherein the message is an error command that disables the surgical tool.
16 . A method for detecting disengagement of a surgical tool, the method comprising:
identifying a tension of at least one of a plurality of cables derived from at least one force detected by a plurality of sensors;
identifying a velocity value for each of the plurality of cables; and
detecting a disengagement of at least one of the plurality of cables or associated components based on the tension of at least one of the plurality of cables and the velocity value for each of the plurality of cables.
17 . The method of claim 16 , further comprising:
calculating a velocity threshold; and
comparing the velocity threshold to the velocity value for each of the plurality of cables.
18 . The method of claim 17 , wherein the velocity threshold is based on a commanded velocity.
19 . The method of claim 16 , further comprising:
identifying a tension threshold; and
comparing the tension of at least one of the plurality of cables to the tension threshold.
20 . An apparatus comprising:
a memory configured to store a threshold tension value and a statistic velocity threshold; and
a controller configured to identify a tension of at least one of a plurality of cables derived from at least one force detected by a plurality of sensor, identify a velocity value for each of the plurality of cables, and detect a disengagement of at least one of the plurality of cables or associated components based on the tension of at least one of the plurality of cables and the velocity value for each of the plurality of cables.