System and method for variable velocity surgical instrument
A system and method of variable velocity control of a surgical instrument in a computer-assisted medical device including an end effector located at a distal end of the instrument, an actuator, and drive mechanisms for coupling force or torque from the actuator to the end effector. To perform an operation with the instrument, the computer-assisted medical device sets a velocity set point of the actuator to an initial velocity, monitors force or torque applied by the actuator, reduces the velocity set point when the applied force or torque is above a first threshold, increases the velocity set point when the applied force or torque is below a second threshold, decreases the velocity set point to zero when the applied force or torque is above a maximum threshold, and drives the actuator based on the velocity set point. The first and second thresholds are lower than the maximum threshold.
1. A system comprising:
a computer-assisted device comprising one or more processors; and
an instrument for use with the computer-assisted device, the instrument comprising:
an end effector located at a distal end of the instrument;
an actuator; and
one or more drive mechanisms for coupling force or torque from the actuator to the end effector;
wherein to perform an operation with the instrument, the one or more processors are configured to:
set a velocity set point of the actuator to an initial velocity;
monitor force or torque applied by the actuator;
when the applied force or torque is above a first threshold, reduce the velocity set point;
when the applied force or torque is below a second threshold, increase the velocity set point;
when the applied force or torque is above a maximum threshold, decrease the velocity set point to zero; and
drive the actuator based on the velocity set point;
wherein the first and second thresholds are lower than the maximum threshold.
2. The system of claim 1 , wherein the operation comprises one or more of grasping, stapling, and cutting.
3. The system of claim 1 , wherein the velocity set point is reduced and increased according to a velocity profile.
4. The system of claim 1 , wherein the velocity set point is reduced and increased to velocity values computed based on the applied force or torque.
5. The system of claim 1 , wherein the first and second thresholds vary based on the applied force or torque.
6. The system of claim 1 , wherein when the applied force or torque is above the maximum threshold, the one or more processors are further configured to wait for a predetermined period of time before continuing the operation.
7. The system of claim 6 , wherein after the wait, the one or more processors are further configured to:
set the velocity set point to a non-zero value;
determine whether the applied force or torque continues to be above the maximum threshold; and
indicate a failure when the applied force or torque continues to be above the maximum threshold.
8. The system of claim 1 , wherein the one or more processors are further configured to indicate a success when a goal position is reached.
9. The system of claim 1 , wherein the velocity set point is reduced when the applied force or torque remains above the first threshold for a predetermined period of time.
10. The system of claim 1 , wherein to monitor the applied force or torque the one or more processors are further configured to average the applied force or torque.
11. A method of operating an instrument for use with a computer-assisted device, the method comprising:
setting, by one or more processors, a velocity set point of an actuator of the instrument to an initial velocity;
measuring, by the one or more processors, a force or torque applied by the actuator; when the applied force or torque is above a first threshold, reducing, by the one or more processors, the velocity set point;
when the applied force or torque is below a second threshold, increasing, by the one or more processors, the velocity set point;
when the applied force or torque is above a maximum threshold, decreasing, by the one or more processors, the velocity set point to zero; and
driving, by the one or more processors, one or more degrees of freedom of an end effector located at a distal end of the instrument using the actuator;
wherein one or more drive mechanisms of the instrument couple force or torque from the actuator to the end effector; and
wherein the first and second thresholds are lower than the maximum threshold.
12. The method of claim 11 , further comprising using the actuator to perform one or more of grasping, stapling, and cutting.
13. The method of claim 11 , wherein the velocity set point is reduced and increased according to a velocity profile.
14. The method of claim 11 , wherein the velocity set point is reduced and increased to velocity values computed based on the applied force or torque.
15. The method of claim 11 , further comprising indicating a success when a goal position is reached.
16. A non-transitory machine-readable medium comprising a plurality of machine-readable instructions which when executed by one or more processors associated with a computer-assisted device are adapted to cause the one or more processors to perform a method comprising:
setting a velocity set point of an actuator of an instrument to an initial velocity;
measuring a force or torque applied by the actuator;
when the applied force or torque is above a first threshold, reducing the velocity set point;
when the applied force or torque is below a second threshold, increasing the velocity set point;
when the applied force or torque is above a maximum threshold, decreasing the velocity set point to zero; and
driving one or more degrees of freedom located at a distal end of an end effector of the instrument using the actuator;
wherein one or more drive mechanisms of the instrument couple force or torque from the actuator to the end effector; and
wherein the first and second thresholds are lower than the maximum threshold.
17. The non-transitory machine-readable medium of claim 16 , wherein the method further comprises using the actuator to perform one or more of grasping, stapling, and cutting.
18. The non-transitory machine-readable medium of claim 16 , wherein the velocity set point is reduced and increased according to a velocity profile.
19. The non-transitory machine-readable medium of claim 16 , wherein the velocity set point is reduced and increased to velocity values computed based on the applied force or torque.
20. The non-transitory machine-readable medium of claim 16 , wherein the method further comprises indicating a success when a goal position is reached.