Robotic surgical system, control device of robotic surgical system, and control method of robotic surgical system
A robotic surgical system includes a controller configured or programmed to calculate an operation speed signal, to calculate a first filtered signal, to calculate a limited signal, to calculate a second filtered signal, and calculate an output position signal based on the second filtered signal.
1. A robotic surgical system comprising:
a patient-side apparatus including a manipulator arm to which a surgical instrument is attached to a tip end side of the manipulator arm;
an operator-side apparatus including a manipulator to receive an operation for operating the surgical instrument; and
a controller configured or programmed to output an output position signal indicating a position of the surgical instrument based on an input position signal indicating the position of the surgical instrument corresponding to the received operation, the controller being configured or programmed to control operation of the surgical instrument; wherein
the controller is configured or programmed to:
calculate an operation speed signal that is a signal relating to an operation speed of the surgical instrument based on the input position signal of the operator-side apparatus;
apply an inverse notch filter that amplifies a component of a first frequency band corresponding to vibrational movements of the manipulator of the calculated operation speed signal to the operation speed signal to calculate a first filtered signal;
limit the first filtered signal to calculate a limited signal;
apply a notch filter that reduces the component of the first frequency band to the limited signal to calculate a second filtered signal; and
calculate the output position signal based on the second filtered signal.
2. The robotic surgical system according to claim 1 , wherein the controller is configured or programmed to apply a linear filter that reduces a component of a second frequency band that is smaller than the first frequency band to the component of the second frequency band.
3. The robotic surgical system according to claim 2 , wherein
the second frequency band is a frequency band corresponding to a natural frequency of the patient-side apparatus.
4. The robotic surgical system according to claim 1 , wherein the controller is configured or programmed to calculate an acceleration signal as the operation speed signal by differentiating the input position signal.
5. The robotic surgical system according to claim 4 , wherein
the controller is configured or programmed to:
calculate a speed signal and a jerk signal as the operation speed signal based on the input position signal;
apply the inverse notch filter to the calculated acceleration signal to calculate a first filtered acceleration signal; and
calculate an upper limit and a lower limit of a limit for the first filtered acceleration signal based on the calculated speed signal and jerk signal.
6. The robotic surgical system according to claim 5 , wherein the controller is configured or programmed to calculate the upper limit and the lower limit of the limit according to a change in an amplitude of the acceleration signal.
7. The robotic surgical system according to claim 4 , wherein
the controller is configured or programmed to:
calculate a second filtered speed signal and the output position signal based on a second filtered acceleration signal to which the second filter has been applied; and
feed back the second filtered speed signal and the output position signal.
8. A control device of a robotic surgical system, the robotic surgical system including a patient-side apparatus including a manipulator arm to which a surgical instrument is attached to a tip end side of the manipulator arm, and an operator-side apparatus including a manipulator to receive an operation for operating the surgical instrument, the control device comprising:
a controller configured or programmed to output an output position signal indicating a position of the surgical instrument based on an input position signal indicating the position of the surgical instrument corresponding to the received operation, the controller being configured or programmed to control operation of the surgical instrument; wherein
the controller is configured or programmed to:
calculate an operation speed signal that is a signal relating to an operation speed of the surgical instrument based on the input position signal of the operator-side apparatus;
apply an inverse notch filter that amplifies a component of a first frequency band corresponding to vibrational movements of the manipulator of the calculated operation speed signal to the operation speed signal to calculate a first filtered signal;
limit the first filtered signal to calculate a limited signal;
apply a notch filter that reduces the component of the first frequency band to the limited signal to calculate a second filtered signal; and
calculate the output position signal based on the second filtered signal.
9. The control device of the robotic surgical system according to claim 8 , wherein the controller is configured or programmed to apply a linear filter that reduces a component of a second frequency band that is smaller than the first frequency band to the component of the second frequency band.
10. The control device of the robotic surgical system according to claim 9 , wherein
the second frequency band is a frequency band corresponding to a natural frequency of the patient-side apparatus.
11. The control device of the robotic surgical system according to claim 8 , wherein the controller is configured or programmed to calculate an acceleration signal as the operation speed signal by differentiating the input position signal.
12. The control device of the robotic surgical system according to claim 11 , wherein
the controller is configured or programmed to:
calculate a speed signal and a jerk signal as the operation speed signal based on the input position signal;
apply the inverse notch filter to the calculated acceleration signal to calculate a first filtered acceleration signal; and
calculate an upper limit and a lower limit of a limit for the first filtered acceleration signal based on the calculated speed signal and jerk signal.
13. The control device of the robotic surgical system according to claim 12 , wherein the controller is configured or programmed to calculate the upper limit and the lower limit of the limit according to a change in an amplitude of the acceleration signal.
14. A control method of a robotic surgical system, the robotic surgical system including a patient-side apparatus including a manipulator arm to which a surgical instrument is attached to a tip end side of the manipulator arm, an operator-side apparatus including a manipulator to receive an operation for operating the surgical instrument, and a controller, the control method comprising:
receiving an operation on the surgical instrument;
calculating an operation speed signal that is a signal relating to an operation speed of the surgical instrument based on an input position signal indicating a position of the surgical instrument corresponding to the received operation;
applying an inverse notch filter that amplifies a component of a first frequency band of the calculated operation speed signal to the operation speed signal to calculate a first filtered signal;
limiting the first filtered signal to calculate a limited signal;
applying a second filter that reduces the component of the first frequency band to the limited signal to calculate a second filtered signal; and
calculating an output position signal indicating the position of the surgical instrument based on the second filtered signal.
15. The control method of the robotic surgical system according to claim 14 , wherein the controller is configured or programmed to apply a linear filter that reduces a component of a second frequency band that is smaller than the first frequency band to the component of the second frequency band.
16. The control method of the robotic surgical system according to claim 15 , wherein
the first frequency band is a frequency band corresponding to movements of the manipulator; and
the second frequency band is a frequency band corresponding to a natural frequency of the patient-side apparatus.
17. The control method of the robotic surgical system according to claim 14 , wherein the controller is configured or programmed to calculate an acceleration signal as the operation speed signal by differentiating the input position signal.
18. The control method of the robotic surgical system according to claim 17 , wherein
the controller is configured or programmed to:
calculate a speed signal and a jerk signal as the operation speed signal based on the input position signal;
apply the inverse notch filter to the calculated acceleration signal to calculate a first filtered acceleration signal; and
calculate an upper limit and a lower limit of a limit for the first filtered acceleration signal based on the calculated speed signal and jerk signal.
19. The control method of the robotic surgical system according to claim 18 , wherein the controller is configured or programmed to calculate the upper limit and the lower limit of the limit according to a change in an amplitude of the acceleration signal.
20. The control method of the robotic surgical system according to claim 17 , wherein
the controller is configured or programmed to:
calculate a second filtered speed signal and the output position signal based on a second filtered acceleration signal to which the second filter has been applied; and
feed back the second filtered speed signal and the output position signal.