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 plurality of 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;
perform a first comparison of the tension of the at least one of the plurality of cables to a threshold tension value;
identify a velocity value for each of the plurality of cables;
calculate a velocity norm value based on a vector including the velocity value for each of the plurality of cables;
perform a second comparison of the velocity norm value to a statistic velocity threshold; and
identify a disengagement of at least one of the plurality of cables or associated components based on the first comparison and the second comparison.
2. The apparatus of claim 1 , wherein the velocity norm value is a magnitude of the vector including the velocity value for each of the plurality of cables.
3. The apparatus of claim 2 , one or more processors configured to:
calculate the statistic velocity threshold, in part, from a commanded velocity.
4. The apparatus of claim 3 , wherein the statistic velocity threshold is calculated, in part, from a Bayesian filter.
5. The apparatus of claim 3 , wherein the statistic velocity threshold is calculated, in part, from an average of the velocity norm value at a first time and the velocity norm value at a second time.
6. The apparatus of claim 5 , wherein the statistic velocity threshold is calculated, in part, from a standard deviation of a time series of data including the velocity norm value at the first time and the velocity norm value at the second time.
7. The apparatus of claim 6 , one or more processors configured to:
calculate a chi squared value for the time series of data.
8. 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.
9. The apparatus of claim 8 , 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.
10. The apparatus of claim 9 , wherein the inverse kinematics model includes a relationship between the torque detected at respective ones of the plurality of motors and the tension of the at least one of the plurality of cables according to an inverse kinematics matrix.
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 connected to and driven by a plurality of cables, the method comprising:
identifying a tension of at least one of the plurality of cables derived from at least one force detected by a plurality of sensors;
performing a first comparison of the tension of the at least one of the plurality of cables to a threshold tension value;
identifying a velocity value for each of the plurality of cables;
calculating a velocity norm value based on a vector including the velocity value for each of the plurality of cables;
performing a second comparison of the velocity norm value to a statistic velocity threshold; and
identifying a disengagement based on the first comparison and the second comparison.
17. The method of claim 16 , wherein the velocity norm value is a magnitude of the vector including the velocity value for each of the plurality of cables.
18. The method of claim 16 , wherein the statistic velocity threshold is based, at least in part, on a commanded velocity.
19. The method of claim 16 , wherein the statistic velocity threshold is based, at least in part, on the velocity norm value at a first time and the velocity norm value at a second time.
20. An apparatus comprising:
a memory configured to store a threshold tension value and a statistic velocity threshold; and
a controller configured to perform a first comparison of a tension of at least one of a plurality of cables connected to an end effector of a surgical tool to the threshold tension value and perform a second comparison of a velocity norm value to the statistic velocity threshold, wherein a disengagement of at least one cable of the plurality of cables is determined based on the first comparison and the second comparison, wherein the velocity norm value is based on a vector for the plurality of cables.