Closed loop feedback control of motor velocity of a surgical stapling and cutting instrument based on magnitude of velocity error measurements
A motorized surgical instrument is disclosed. The surgical instrument includes a displacement member. A motor is coupled to the displacement member and a control circuit. A position sensor is coupled to the control circuit and a timer circuit to measure elapsed time. The control circuit is configured to determine a position of the displacement member, determine an error between directed and actual velocity and adjust the directed velocity based on the error in comparison to one or more thresholds. The control circuit also is configured to adjust the rate of change of the directed velocity based on the one or more thresholds. The control circuit also is configured to determine a zone in which the displacement member is located and set the directed velocity based on the zone in which the displacement member is located.
1. A surgical instrument, comprising:
a displacement member configured to translate within the surgical instrument over a plurality of predefined zones;
a motor coupled to the displacement member to translate the displacement member;
a control circuit coupled to the motor;
a position sensor coupled to the control circuit, the position sensor configured to measure a position of the displacement member; and
a timer/counter circuit coupled to the control circuit, the timer/counter circuit configured to measure elapsed time;
wherein the control circuit is configured to:
determine a position of the displacement member;
determine a zone in which the displacement member is located; and
set a different directed velocity of the displacement member based on each one of the plurality of predefined zones in which the displacement member is located.
2. The surgical instrument of claim 1 , wherein the control circuit is configured to:
receive the position of the displacement member from the position sensor;
receive elapsed time from the timer/counter circuit; and
set duty cycle of the motor based on the zone in which the displacement member is located.
3. The surgical instrument of claim 2 , wherein the control circuit is configured to determine an actual velocity of the displacement member.
4. The surgical instrument of claim 3 , wherein the control circuit is configured to determine an error between the directed velocity of the displacement member and the actual velocity of the displacement member.
5. The surgical instrument of claim 4 , wherein the control circuit is configured to set a new directed velocity of the displacement member based on the error.
6. The surgical instrument of claim 4 , wherein the error is based on at least one of a short term error (S), wherein the short term error represents a difference between actual velocity and the directed velocity at a displacement, cumulative error (C), wherein the cumulative error represents error deviation between actual velocity and the directed velocity accumulated over time, rate of change error (R), wherein the rate of change error represents a rate at which actual velocity is approaching the directed velocity, and number of overshoots error (N), wherein the number of overshoots N represents a number of times actual velocity overshoots or undershoots the directed velocity.
7. The surgical instrument of claim 1 , comprising an end effector, wherein the displacement member is configured to translate within the end effector.
8. A surgical instrument, comprising:
a displacement member configured to translate within the surgical instrument over a plurality of predefined zones;
a motor coupled to the displacement member to translate the displacement member;
a control circuit coupled to the motor;
a position sensor coupled to the control circuit, the position sensor configured to measure a position of the displacement member; and
a timer/counter circuit coupled to the control circuit, the timer/counter circuit configured to measure elapsed time;
wherein the control circuit is configured to:
set a directed velocity of the displacement member;
determine a position of the displacement member;
determine a zone in which the displacement member is located;
determine an actual velocity of the displacement member;
compare the directed velocity of the displacement member to the actual velocity of the displacement member;
determine an error between the directed velocity of the displacement member to the actual velocity of the displacement member; and
adjust the directed velocity of the displacement member based on the error and based on the zone in which the displacement member is located.
9. The surgical instrument of claim 8 , wherein the control circuit is configured to compare the error to an error threshold.
10. The surgical instrument of claim 9 , wherein the control circuit is configured to maintain the directed velocity of the displacement member when the error is within the error threshold.
11. The surgical instrument of claim 9 , wherein the control circuit is configured to adjust the directed velocity of the displacement member to change the directed velocity when the error exceeds the error threshold.
12. The surgical instrument of claim 8 , wherein the actual velocity of the displacement member is given by the following expression:
V
DM
=
A
·
S
+
B
·
∑
C
+
D
·
Δ
R
Δ
t
where A, B, and D are coefficients and S is a short term error, C is a cumulative error, and R is a rate of change error.
13. The surgical instrument of claim 8 , comprising an end effector, wherein the displacement member is configured to translate within the end effector.
14. A surgical instrument, comprising:
a displacement member configured to translate within the surgical instrument;
a motor coupled to the displacement member to translate the displacement member;
a control circuit coupled to the motor;
a position sensor coupled to the control circuit, the position sensor configured to measure a position of the displacement member; and
a timer/counter circuit coupled to the control circuit, the timer/counter circuit configured to measure elapsed time;
wherein the control circuit is configured to:
set a directed velocity of the displacement member;
determine a position of the displacement member;
determine an actual velocity of the displacement member;
compare the directed velocity of the displacement member to the actual velocity of the displacement member;
determine an error between the directed velocity of the displacement member to the actual velocity of the displacement member; and
adjust a rate of change of the directed velocity of the displacement member based on the error.
15. The surgical instrument of claim 14 , wherein the control circuit is configured to compare the error to multiple error thresholds.
16. The surgical instrument of claim 15 , wherein the control circuit is configured to adjust the directed velocity of the displacement member at multiple rates of change based on the error.
17. The surgical instrument of claim 15 , wherein the control circuit is configured to:
compare the error to a first error threshold; and
maintain the directed velocity when the error is within the first error threshold.
18. The surgical instrument of claim 17 , wherein the control circuit is configured to:
compare the error to a second error threshold; and
adjust the directed velocity at a first rate of change when the error exceeds the first error threshold and is within the second error threshold.
19. The surgical instrument of claim 17 , wherein the control circuit is configured to:
compare the error to a second error threshold; and
adjust the directed velocity at a second rate of change when the error exceeds both the first error threshold and the second error threshold.
20. The surgical instrument of claim 14 , wherein the error is based on at least one of a short term error (S), wherein the short term error represents a difference between actual velocity and the directed velocity at a displacement, cumulative error (C), wherein the cumulative error represents error deviation between actual velocity and the directed velocity accumulated over time, rate of change error (R), wherein the rate of change error represents a rate at which actual velocity is approaching the directed velocity, and number of overshoots error (N), wherein the number of overshoots N represents a number of times actual velocity overshoots or undershoots the directed velocity.