ROBOTIC SURGICAL SYSTEM, OPERATOR-SIDE APPARATUS, AND CONTROL METHOD OF ROBOTIC SURGICAL SYSTEM
20230034631 · 2023-02-02
Assignee
Inventors
- Yusuke TAKANO (Kobe-shi, JP)
- Takeshi KURIHARA (Kobe-shi, JP)
- Masataka TANABE (Kobe-shi, JP)
- Shinji KAJIHARA (Kobe-shi, JP)
Cpc classification
B25J13/06
PERFORMING OPERATIONS; TRANSPORTING
G05B2219/45123
PHYSICS
International classification
A61B34/00
HUMAN NECESSITIES
Abstract
In a robotic surgical system, a controller is configured or programmed to change at least one of a level of an operation start assisting force, a level of an in-operation assisting force, or a level of a braking force based on a level change operation of an operator received by a level change receiver.
Claims
1. A robotic surgical system comprising: a patient-side apparatus including a manipulator arm having a tip end to which a surgical instrument is attached; an operator-side apparatus including an operation unit to receive an operation of an operator; a controller; and a level change receiver to receive a level change operation of the operator; wherein the operation unit includes a drive to assist the operation of the operator; the controller is configured or programmed to control the drive to exert at least one of an operation start assisting force exerted when the operation unit starts to be operated, an in-operation assisting force exerted when the operation unit is being operated, or a braking force exerted when the operation unit is stopped; and the controller is configured or programmed to change at least one of a level of the operation start assisting force, a level of the in-operation assisting force, or a level of the braking force based on the level change operation of the operator received by the level change receiver.
2. The robotic surgical system according to claim 1, wherein the controller is configured or programmed to: control the drive to exert all of the operation start assisting force exerted when the operation unit starts to be operated, the in-operation assisting force exerted when the operation unit is being operated, and the braking force exerted when the operation unit is stopped; and change all of the level of the operation start assisting force, the level of the in-operation assisting force, and the level of the braking force based on the level change operation of the operator.
3. The robotic surgical system according to claim 1, wherein the level change receiver receives at least one of a change in the level of the operation start assisting force, a change in the level of the in-operation assisting force, or a change in the level of the braking force.
4. The robotic surgical system according to claim 3, wherein at least one of the operation start assisting force, the in-operation assisting force, or the braking force has a plurality of levels; and the level change receiver includes a plurality of level selectors corresponding to the plurality of levels.
5. The robotic surgical system according to claim 4, wherein the level change receiver further includes a level change target selector for the operator to select a target to be changed in level from among the operation start assisting force, the in-operation assisting force, and the braking force; and the plurality of level selectors receive a level change for the target selected through the level change target selector.
6. The robotic surgical system according to claim 3, wherein the level change receiver is arranged on the operator-side apparatus.
7. The robotic surgical system according to claim 1, wherein the controller is configured or programmed to: determine a value of a braking parameter of the drive based on an operation acceleration and an operation speed with respect to the operation unit; and control the drive to exert the braking force using the determined value of the braking parameter.
8. The robotic surgical system according to claim 7, wherein the controller is configured or programmed to, when the operation is decelerated, maintain the braking parameter constant when an absolute value of the operation speed is greater than a deceleration threshold, decrease an absolute value of the braking parameter as the absolute value of the operation speed decreases when the absolute value of the operation speed is equal to or less than the deceleration threshold, and change the level of the braking force by changing an upper limit of the absolute value of the braking parameter based on the level change operation of the operator.
9. The robotic surgical system according to claim 7, wherein the controller is configured or programmed to, when the operation is accelerated, increase an absolute value of the braking parameter as an absolute value of the operation speed increases when the absolute value of the operation speed is less than a first acceleration threshold, maintain the braking parameter constant when the absolute value of the operation speed is equal to or greater than the first acceleration threshold and is less than a second acceleration threshold, decrease the absolute value of the braking parameter as the absolute value of the operation speed increases when the absolute value of the operation speed is equal to or greater than the second acceleration threshold and is less than a third acceleration threshold, set the braking parameter to zero when the absolute value of the operation speed is equal to or greater than the third acceleration threshold, and change the level of the braking force by changing an upper limit of the absolute value of the braking parameter based on the level change operation of the operator.
10. The robotic surgical system according to claim 1, wherein the controller is configured or programmed to: determine a value of an operation start parameter of the drive based on an operation acceleration with respect to the operation unit; and control the drive to exert the operation start assisting force using the determined value of the operation start parameter.
11. The robotic surgical system according to claim 10, wherein the controller is configured or programmed to: linearly increase an absolute value of the operation start parameter as an absolute value of the operation acceleration increases; and change the level of the operation start assisting force by changing a magnitude of the operation start parameter with respect to the operation acceleration based on the level change operation of the operator.
12. The robotic surgical system according to claim 1, wherein the controller is configured or programmed to: determine a value of an in-operation parameter of the drive based on an operation speed with respect to the operation unit; and control the drive to exert the in-operation assisting force using the determined value of the in-operation parameter.
13. The robotic surgical system according to claim 12, wherein the controller is configured or programmed to: linearly increase an absolute value of the in-operation parameter as an absolute value of the operation speed increases; and change the level of the in-operation assisting force by changing a magnitude of the in-operation parameter based on the level change operation of the operator.
14. The robotic surgical system according to claim 1, wherein the operation unit includes a plurality of rotation axes and a plurality of drives including the drive and provided so as to correspond to the plurality of rotation axes, respectively; and the controller is configured or programmed to exert at least one of the operation start assisting force, the in-operation assisting force, or the braking force on at least one of the plurality of drives.
15. An operator-side apparatus to operate a patient-side apparatus including a manipulator arm having a tip end to which a surgical instrument is attached, the operator-side apparatus comprising: an operation unit to receive an operation of an operator; a controller; and a level change receiver to receive a level change operation of the operator; wherein the operation unit includes a drive to assist the operation of the operator; the controller is configured or programmed to control the drive to exert at least one of an operation start assisting force exerted when the operation unit starts to be operated, an in-operation assisting force exerted when the operation unit is being operated, or a braking force exerted when the operation unit is stopped; and the controller is configured or programmed to change at least one of a level of the operation start assisting force, a level of the in-operation assisting force, or a level of the braking force based on the level change operation of the operator received by the level change receiver.
16. A control method of a robotic surgical system, the robotic surgical system comprising a patient-side apparatus including a manipulator arm having a tip end to which a surgical instrument is attached and an operator-side apparatus including an operation unit to receive an operation of an operator, the control method comprising: receiving at least one of a change in a level of an operation start assisting force exerted when the operation unit starts to be operated, a change in a level of an in-operation assisting force exerted when the operation unit is being operated, or a change in a level of a braking force exerted when the operation unit is stopped; and exerting at least one of the operation start assisting force, the in-operation assisting force, or the braking force corresponding to a changed level.
17. The control method of the robotic surgical system according to claim 16, wherein the receiving of the change in the level includes receiving all of the change in the level of the operation start assisting force exerted when the operation unit starts to be operated, the change in the level of the in-operation assisting force exerted when the operation unit is being operated, and the change in the level of the braking force exerted when the operation unit is stopped.
18. The control method of the robotic surgical system according to claim 16, wherein the receiving of at least one of the changes in the levels includes receiving at least one of the change in the level of the operation start assisting force, the change in the level of the in-operation assisting force, or the change in the level of the braking force by a level change receiver.
19. The control method of the robotic surgical system according to claim 18, wherein at least one of the operation start assisting force, the in-operation assisting force, or the braking force has a plurality of levels; and the level change receiver includes a plurality of level selectors corresponding to the plurality of levels.
20. The control method of the robotic surgical system according to claim 19, wherein the level change receiver further includes a level change target selector for the operator to select a target to be changed in level from among the operation start assisting force, the in-operation assisting force, and the braking force; and the plurality of level selectors receive a level change for the target selected through the level change target selector.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0016]
[0017]
[0018]
[0019]
[0020]
[0021]
[0022]
[0023]
[0024]
[0025]
[0026]
[0027]
[0028]
[0029]
[0030]
[0031]
[0032]
[0033]
[0034]
[0035]
[0036]
[0037]
[0038]
[0039]
[0040]
[0041]
[0042]
[0043]
[0044]
[0045]
[0046]
[0047]
[0048]
[0049]
DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0050] Embodiments of the present disclosure are hereinafter described with reference to the drawings.
First Embodiment
[0051] The configuration of a surgical system 100 according to a first embodiment is now described with reference to
[0052] The remote control apparatus 2 is arranged inside or outside the operating room, for example. The remote control apparatus 2 includes an operation unit 120 including arms 121 shown in
[0053] As shown in
[0054] The operation unit 120 includes the substantially L-shaped arms 121. The arms 121 each have a first link 121a, a second link 121b, and a third link 121c. The upper end side of the first link 121a is attached to a main body of the remote control apparatus 2 such that the first link 121a is rotatable about an A1 axis along a vertical direction. The upper end side of the second link 121b is attached to the lower end side of the first link 121a such that the second link 121b is rotatable about an A2 axis along a horizontal direction. A first end side of the third link 121c is attached to the lower end side of the second link 121b such that the third link 121c is rotatable about an A3 axis along the horizontal direction. The operation handle 21 is attached to a second end side of the third link 121c such that the operation handle 21 is rotatable about an A4 axis.
[0055] The arms 121 each support the operation handle 21 such that the operation handle 21 is movable within a predetermined three-dimensional operation range. Specifically, the arm 121 supports the operation handle 21 such that the operation handle 21 is movable in an upward-downward direction, a right-left direction, and a forward-rearward direction. Manipulator arms 60 are moved three-dimensionally so as to correspond to the three-dimensional operations of the arms 121.
[0056] The operation handle 21 operates a surgical instrument 4. Furthermore, the operation handle 21 receives an operation amount for the surgical instrument 4. The operation handle 21 includes an operation handle 21L located on the left side as viewed from the operator such as a doctor and operated by the operator's left hand, and an operation handle 21R located on the right side and operated by the operator's right hand.
[0057] As shown in
[0058] In the operation handle 21, the movement amounts of a manipulator arm 60 and the surgical instrument 4 are changed with respect to an operation amount received by the operation handle 21. This change is called scaling. For example, when the scale factor of the movement amounts is set to ½ times, the surgical instrument 4 is controlled to move ½ of the movement distance of the operation handle 21. Thus, fine surgery can be performed accurately.
[0059] As shown in
[0060] The switching pedal 22a switches a manipulator arm 60 to be operated by the operation handle 21. The clutch pedal 22b performs a clutch operation to temporarily disconnect an operation connection between the manipulator arm 60 and the operation handle 21. While the clutch pedal 22b is being pressed by the operator, an operation by the operation handle 21 is not transmitted to the manipulator arms 60. While the camera pedal 22c is being pressed by the operator, the operation handle 21 can operate a manipulator arm 60 to which an endoscope 6 is attached. While the incision pedal 22d or the coagulation pedal 22e is being pressed by the operator, an electrosurgical device is activated.
[0061] As shown in
[0062] The medical cart 3 includes a controller 31 that controls the operation of the medical manipulator 1 and a storage 32 that stores programs or the like to control the operation of the medical manipulator 1. The controller 31 of the medical cart 3 controls the operation of the medical manipulator 1 based on the command input to the remote control apparatus 2.
[0063] The medical cart 3 includes an input 33. The input 33 receives operations to move a positioner 40, an arm base 50, and a plurality of manipulator arms 60 or change their postures mainly in order to prepare for surgery before the surgery.
[0064] The medical manipulator 1 shown in
[0065] The positioner 40 includes a 7-axis articulated robot, for example. The positioner 40 is arranged on the medical cart 3. The positioner 40 moves the arm base 50. Specifically, the positioner 40 moves the position of the arm base 50 three-dimensionally.
[0066] The positioner 40 includes a base 41 and a plurality of links 42 coupled to the base 41. The plurality of links 42 are coupled to each other by joints 43.
[0067] As shown in
[0068] As shown in
[0069] As shown in
[0070] The pair of forceps 4b is attached to the first support 4e so as to rotate about the JT11 axis. The second support 4f supports the first support 4e such that the first support 4e is rotatable about the JT10 axis. That is, the first support 4e is attached to the second support 4f so as to rotate about the JT10 axis. A portion of the first support 4e on the Z1 direction side, which is the tip end side, has a U-shape. TCP1 is set as a tool center point at the center of the tip end of the U-shaped portion of the first support 4e in the JT11 axis.
[0071] The pair of forceps 4b as the surgical instrument 4 includes a JT9 axis as a rotation axis of the shaft 4c and a JT12 axis as an opening/closing axis of the pair of forceps 4b. The rotation axis of the shaft 4c is an axis along the direction in which the shaft 4c extends. A plurality of servomotors M2 are provided in the holder 71 of the manipulator arm 60, and rotary bodies of the driven unit 4a are driven by the plurality of servomotors M2. Thus, the surgical instrument 4 is driven around the JT9 axis to the JT12 axis. For example, four servomotors M2 are provided.
[0072] As shown in
[0073] The configuration of the manipulator arms 60 is now described in detail.
[0074] As shown in
[0075] As shown in
[0076] The translation mechanism 70 is provided at the tip end of the arm portion 61, and the surgical instrument 4 is attached thereto. The translation mechanism 70 translates the surgical instrument 4 in a direction in which the surgical instrument 4 is inserted into the patient P. Furthermore, the translation mechanism 70 translates the surgical instrument 4 relative to the arm portion 61. Specifically, the translation mechanism 70 includes the holder 71 that holds the surgical instrument 4. The servomotors M2 shown in
[0077] As shown in
[0078] The switch unit 83 includes a switch 83a to move the surgical instrument 4 in the direction in which the surgical instrument 4 is inserted into the patient P, along the longitudinal direction of the surgical instrument 4, and a switch 83b to move the surgical instrument 4 in a direction opposite to the direction in which the surgical instrument 4 is inserted into the patient P. Both the switch 83a and the switch 83b are push-button switches.
[0079] As shown in
[0080] As shown in
[0081] As shown in
[0082] As shown in
[0083] The mode indicator 84a also serves as a pivot position indicator that indicates that the pivot position PP has been set.
[0084] As shown in
[0085] As shown in
[0086] As shown in
[0087] The positioner 40 includes a plurality of servomotors M4, encoders E4, and speed reducers so as to correspond to a plurality of joints 43 of the positioner 40. The encoders E4 detect the rotation angles of the servomotors M4. The speed reducers slow down rotation of the servomotors M4 to increase the torques.
[0088] The medical cart 3 includes servomotors M5 to drive a plurality of front wheels of the medical cart 3, respectively, encoders E5, and speed reducers. The encoders E5 detect the rotation angles of the servomotors M5. The speed reducers slow down rotation of the servomotors M5 to increase the torques.
[0089] The controller 31 of the medical cart 3 includes an arm controller 31a to control movement of the plurality of manipulator arms 60 based on commands, and a positioner controller 31b to control movement of the positioner 40 and driving of the front wheels of the medical cart 3 based on commands. Servo controllers C1 that control the servomotors M1 to drive the manipulator arm 60 are electrically connected to the arm controller 31a. The encoders E1 that detect the rotation angles of the servomotors M1 are electrically connected to the servo controllers C1.
[0090] Servo controllers C2 that control the servomotors M2 to drive the surgical instrument 4 are electrically connected to the arm controller 31a. The encoders E2 that detect the rotation angles of the servomotors M2 are electrically connected to the servo controllers C2. A servo controller C3 that controls the servomotor M3 to translate the translation mechanism 70 is electrically connected to the arm controller 31a. The encoder E3 that detects the rotation angle of the servomotor M3 is electrically connected to the servo controller C3.
[0091] An operation command input to the remote control apparatus 2 is input to the arm controller 31a. The arm controller 31a generates position commands based on the input operation command and the rotation angles detected by the encoders E1 to E3, and outputs the position commands to the servo controllers C1 to C3. The servo controllers C1 to C3 generate current commands based on the position commands input from the arm controller 31a and the rotation angles detected by the encoders E1 to E3, and output the current commands to the servomotors M1 to M3. Thus, the manipulator arm 60 is moved according to the operation command input to the remote control apparatus 2.
[0092] As shown in
[0093] The arm controller 31a of the controller 31 operates the manipulator arm 60 based on an input signal from the switch unit 83 of the arm operation unit 80. Specifically, the arm controller 31a generates a position command based on an operation command, which is the input signal input from the switch unit 83, and the rotation angle detected by the encoders E1 or the encoder E3, and outputs the position command to the servo controllers C1 or the servo controller C3. The servo controllers C1 or the servo controller C3 generates a current command based on the position command input from the arm controller 31a and the rotation angle detected by the encoders E1 or the encoder E3, and outputs the current command to the servomotors M1 or the servomotor M3. Thus, the manipulator arm 60 is moved according to the operation command input to the switch unit 83.
[0094] As shown in
[0095] An operation command related to setting a preparation position, for example, is input from the input 33 to the positioner controller 31b. The positioner controller 31b generates position commands based on the operation command input from the input 33 and the rotation angles detected by the encoders E4, and outputs the position commands to the servo controllers C4. The servo controllers C4 generate current commands based on the position commands input from the positioner controller 31b and the rotation angles detected by the encoders E4, and output the current commands to the servomotors M4. Thus, the positioner 40 is moved according to the operation command input to the input 33. Similarly, the positioner controller 31b moves the medical cart 3 based on an operation command from the input 33.
[0096] As shown in
[0097] As shown in
[0098] The controller 110 generates a torque on at least one of the rotation axes A1 to A7 of the servomotors M6a to M6g according to an operation on the operation unit 120, and controls at least one of the servomotors M6a to M6g to assist the operation of the operator. Specifically, in the first embodiment, the controller 110 controls at least one of the servomotors M6a to M6g to exert at least one of an operation start assisting force exerted when the operation unit 120 starts to be operated, an in-operation assisting force exerted when the operation unit 120 is being operated, or a braking force exerted when the operation unit 120 is stopped. The operation start assisting force refers to a force that assists in reducing a force required to operate the operation unit 120 at the initial stage of the movement in which the operation on the operation unit 120 is accelerated. The in-operation assisting force refers to a force that assists in reducing a force required to operate the operation unit 120 while the operation unit 120 is being operated at an operation speed ω after the operation unit 120 starts to move. The braking force refers to a force that increases a force required to operate the operation unit 120 when the operation unit 120 is stopped. In the first embodiment, the controller 110 controls at least one of the servomotors M6a to M6g to exert all of the operation start assisting force, the in-operation assisting force, and the braking force.
[0099] In the first embodiment, the controller 110 changes at least one of the level of the operation start assisting force, the level of the in-operation assisting force, or the level of the braking force based on a level changing operation of the operator. In the first embodiment, the controller 110 changes all of the level of the operation start assisting force, the level of the in-operation assisting force, and the level of the braking force based on the level changing operation of the operator. The level is changed such that the load given when the operation unit 120 is operated is changed.
[0100] In the first embodiment, as shown in
[0101] In the first embodiment, at least one of the operation start assisting force, the in-operation assisting force, or the braking force has a plurality of levels. The level change receiver 23a includes level selectors 23b1 to 23b4 corresponding to the plurality of levels. In the first embodiment, the operation start assisting force, the in-operation assisting force, and the braking force each have four levels. The level selectors 23b1 to 23b4 correspond to a small level, a slightly small level, a slightly large level, and a large level, respectively.
[0102] In the first embodiment, the level change receiver 23a includes a level change target selector 23c for the operator to select a target to be changed in level from among the operation start assisting force, the in-operation assisting force, and the braking force. The level selectors 23b1 to 23b4 receive a level change for the target selected through the level change target selector 23c. For example, when a START OPERATING button of the level change target selector 23c is pressed, the level selectors 23b1 to 23b4 receive a change in the level of the operation start assisting force. When an IN OPERATION button of the level change target selector 23c is pressed, the level selectors 23b1 to 23b4 receive a change in the level of the in-operation assisting force. When a STOP OPERATING button of the level change target selector 23c is pressed, the level selectors 23b1 to 23b4 receive a change in the level of the braking force. The operation of the operator to press the level selectors 23b1 to 23b4 is hereinafter referred to as a level change operation of the operator.
[0103] In the first embodiment, the level change receiver 23a is arranged on the remote control apparatus 2. For example, the level change receiver 23a is displayed on the touch panel 23 of the remote control apparatus 2. The level selectors 23b1 to 23b4 and the level change target selector 23c are touch buttons.
Operation Start Assisting Power
[0104] In the first embodiment, as shown in
[0105] In the first embodiment, as shown in
[0106] Specifically, as shown in
[0107] The controller 110 multiplies the gain-multiplied acceleration a.sub.1 by the multiplying factor of a level r corresponding to any of the level selectors 23b1 to 23b4 pressed by the operator. For example, when the level selector 23b1 is pressed, the gain-multiplied acceleration a.sub.1 is multiplied by a multiplying factor α. When the level selector 23b2 is pressed, the gain-multiplied acceleration a.sub.1 is multiplied by a multiplying factor β. When the level selector 23b3 is pressed, the gain-multiplied acceleration a.sub.1 is multiplied by a multiplying factor γ. When the level selector 23b4 is pressed, the gain-multiplied acceleration a.sub.1 is multiplied by a multiplying factor 1. It should be noted that α, β, γ, and 1 have a relationship of 0≤α≤β <γ<1. The gain-multiplied acceleration a.sub.1 having been multiplied by the multiplying factor is hereinafter referred to as a multiplying factor-multiplied acceleration a.sub.2.
[0108] The controller 110 limits the multiplying factor-multiplied acceleration a.sub.2 between the upper limit value and the lower limit value. Thus, action of an excessive operation start assisting force is significantly reduced or prevented. For example, the operation unit 120 may be hit or the operation units 120 may come into contact with each other. In this case, the operation start assisting force becomes excessively large. The multiplying factor-multiplied acceleration a.sub.2 is limited between the upper limit value and the lower limit value such that excessive movement of the operation unit 120 can be significantly reduced or prevented. The multiplying factor-multiplied acceleration a.sub.2 limited between the upper limit value and the lower limit value is hereinafter referred to as a limited acceleration a.sub.3.
[0109] The controller 110 applies the LPF to the limited acceleration a.sub.3. Thus, high-frequency noise can be removed from the limited acceleration a.sub.3. In particular, the limited acceleration a.sub.3 is calculated by differentiation of the speed, and thus high-frequency noise tends to be large, and the ratio of high-frequency noise to the components of the limited acceleration a.sub.3 becomes large. The limited acceleration a.sub.3 to which the LPF has been applied is hereinafter referred to as a post-LPF acceleration a.sub.4. The controller 110 adds the post-LPF acceleration a.sub.4 as the operation start compensation value to the gravity compensation value.
[0110] In
In-Operation Assisting Force
[0111] In the first embodiment, as shown in
[0112] In the first embodiment, as shown in
[0113] Specifically, as shown in
[0114] The controller 110 multiplies the gain-multiplied speed ω.sub.1 by the multiplying factor of the level r corresponding to any of the level selectors 23b1 to 23b4 pressed by the operator. For example, when the level selector 23b1 is pressed, the gain-multiplied speed ω.sub.1 is multiplied by the multiplying factor α. When the level selector 23b2 is pressed, the gain-multiplied speed ω.sub.1 is multiplied by the multiplying factor β. When the level selector 23b3 is pressed, the gain-multiplied speed ω.sub.1 is multiplied by the multiplying factor γ. When the level selector 23b is pressed, the gain-multiplied speed ω.sub.1 is multiplied by the multiplying factor 1. It should be noted that α, β, γ, and 1 have a relationship of 0≤α<β<γ<1. The gain-multiplied speed ω.sub.1 multiplied by the multiplying factor is hereinafter referred to as a multiplying factor-multiplied speed ω.sub.2.
[0115] The controller 110 limits the multiplying factor-multiplied speed ω.sub.2 between the upper limit value and the lower limit value. Thus, when the operation unit 120 is operated at a speed at which the operation unit 120 is not moved in normal operation, the multiplying factor-multiplied speed ω.sub.2 is limited, and thus an excessive increase in the in-operation assisting force is significantly reduced or prevented. The multiplying factor-multiplied speed ω.sub.2 limited between the upper limit value and the lower limit value is hereinafter referred to as a limited speed ω.sub.3.
[0116] The controller 110 applies the LPF to the limited speed ω.sub.3. The limited speed ω.sub.3 to which the LPF has been applied is hereinafter referred to as a post-LPF speed ω.sub.4. The controller 110 adds the post-LPF speed ω.sub.4 as the in-operation compensation value to the gravity compensation value.
[0117] In
Braking Force
[0118] As shown in
[0119] Specifically, as shown in
[0120] The controller 110 controls the servomotors M6a, M6b, and M6c to exert the braking force when an operation on the operation unit 120 is decelerated and/or accelerated. Specifically, as shown in
[0121] In the first embodiment, as shown in
[0122] Specifically, when the operation is accelerated, the controller 110 increases the braking parameter τ as the operation speed ω increases when the operation speed ω is less than a threshold ω.sub.a1, sets the braking parameter τ to constant T.sub.a when the operation speed ω is equal to or greater than the threshold ω.sub.a1 and is less than a threshold ω.sub.a2, decreases the braking parameter τ as the operation speed ω increases when the operation speed ω is equal to or greater than the threshold C.sub.Ua2 and is less than a threshold ω.sub.a3, and sets the braking parameter τ to zero when the operation speed ω is equal to or greater than the threshold ω.sub.a3. When the operation is accelerated, the controller 110 increases the braking parameter τ as the operation speed ω increases when the operation speed ω is greater than a threshold −ω.sub.a1, sets the braking parameter τ to constant −τ.sub.a when the operation speed ω is equal to or greater than a threshold −ω.sub.a2 and is less than the threshold −ω.sub.a1, decreases the braking parameter τ as the operation speed ω increases when the operation speed ω is equal to or greater than a threshold −ω.sub.a3 and is less than the threshold −ω.sub.a2, and sets the braking parameter τ to zero when the operation speed ω is equal to or less than the threshold −ω.sub.a3. The threshold ω.sub.a1 and the threshold −ω.sub.a1 are examples of a first acceleration threshold. The threshold ω.sub.a2 and the threshold −ω.sub.a2 are examples of a second acceleration threshold. The threshold ω.sub.a3 and the threshold −ω.sub.a3 are examples of a third acceleration threshold.
[0123] The negative operation speed ω indicates that the servomotor rotates in a reverse direction.
[0124] When the operation speed ω is between the threshold −ω.sub.a1 and the threshold ω.sub.a1, the braking parameter τ increases linearly. When the operation speed ω is between the threshold ω.sub.a2 and the threshold ω.sub.a3, the braking parameter τ decreases linearly. When the operation speed ω is between the threshold −ω.sub.a2 and the threshold −ω.sub.a3, the braking parameter τ increases linearly. When the operation speed ω is 0, the braking parameter τ is 0.
[0125] In the first embodiment, as shown in
[0126] Even when the maximum value of the braking parameter τ is changed, the slope of the braking parameter τ is not changed. The slope is the rate of increase of the braking parameter τ with respect to the rate of increase of the operation speed ω in a case in which the operation speed ω is between 0 and the threshold ω.sub.a1, for example.
[0127] In
[0128] As shown in
[0129] In the first embodiment, when the operation is decelerated, the controller 110 maintains the braking parameter τ constant when the absolute value of the operation speed ω is greater than a deceleration threshold. The controller 110 decreases the absolute value of the braking parameter τ as the absolute value of the operation speed ω decreases when the absolute value of the operation speed ω is equal to or less than the deceleration threshold.
[0130] Specifically, when the operation is decelerated, the controller 110 sets the braking parameter τ to constant τ.sub.b when the operation speed ω is greater than a threshold ω.sub.b, and decreases the braking parameter τ as the operation speed ω decreases when the operation speed ω is equal to or less than the threshold ω.sub.b. When the operation is decelerated, the controller 110 sets the braking parameter τ to constant −τ.sub.b when the operation speed ω is less than a threshold −ω.sub.b, and increases the braking parameter τ as the operation speed ω increases when the operation speed ω is equal to or greater than the threshold −ω.sub.b. The threshold ω.sub.b and the threshold −ω.sub.b are examples of a deceleration threshold.
[0131] More specifically, when the operation speed ω is between the threshold ω.sub.b and 0, the braking parameter τ decreases linearly. When the operation speed ω is between the threshold −ω.sub.b and 0, the braking parameter τ increases linearly. When the operation speed ω is 0, the braking parameter τ is 0.
[0132] In the first embodiment, the controller 110 changes the level of the braking force by changing the upper limit of the absolute value of the braking parameter τ based on the level change operation of the operator. Specifically, the controller 110 changes the upper limit of the absolute value of the braking parameter τ by changing the threshold ω.sub.b and the threshold −ω.sub.b. For example, the threshold ω.sub.b and the threshold −ω.sub.b are changed to a threshold ω.sub.b1 and a threshold −ω.sub.b1, respectively, such that the maximum value of the braking parameter τ is increased from τ.sub.b to ατ.sub.b. The maximum of the absolute value of the braking parameter τ is changed to any of τ.sub.b, ατ.sub.b, βτ.sub.b, and γτ.sub.b. It should be noted that α, β, and γ have a relationship of 1<α<β<γ. The maximums of the absolute values of the braking parameters τ, which are γτ.sub.b, βτ.sub.b, ατ.sub.b, τ.sub.b, correspond to the level selectors 23b4, 23b3, 23b2, and 23b1, respectively.
[0133] Even when the maximum value of the braking parameter τ is changed, the slope of the braking parameter τ is not changed. The slope is the rate of increase of the braking parameter τ with respect to the rate of increase of the operation speed ω in a case in which the operation speed ω is between 0 and the threshold ω.sub.b, for example.
[0134] In
[0135] As shown in
[0136] As shown in
[0137] A control flow of the surgical system 100 is now described with reference to
[0138] In step S1, at least one of a change in the level of the operation start assisting force, a change in the level of the in-operation assisting force, or a change in the level of the braking force is received. In the first embodiment, all of a change in the level of the operation start assisting force, a change in the level of the in-operation assisting force, and a change in the level of the braking force are received. As shown in
[0139] In step S2, an operation on the operation unit 120 is received. Thus, the rotation positions x of the servomotors M6a to M6g of the operation unit 120 are input to the controller 110.
[0140] In step S3, the controller 110 calculates the operation acceleration a based on the rotation positions x. The controller 110 determines the value of the operation start parameter τ.sub.2 corresponding to the changed level based on the operation acceleration a. The controller 110 determines the operation start compensation value based on the determined operation start parameter τ.sub.2.
[0141] In step S4, the controller 110 calculates the operation speed ω based on the rotation positions x. The controller 110 determines the value of the in-operation parameter τ.sub.3 corresponding to the changed level based on the operation speed ω. The controller 110 determines the in-operation compensation value based on the determined in-operation parameter τ.sub.3.
[0142] In step S5, the controller 110 calculates the operation speed ω and the operation acceleration a based on the rotation positions x. The controller 110 determines whether the current operation corresponds to acceleration or deceleration based on the operation speed ω and the operation acceleration a. Specifically, when the operation speed ω is positive and the acceleration is positive, the controller 110 determines that the current operation corresponds to acceleration. When the operation speed ω is positive and the acceleration is 0, the controller 110 determines that the current operation corresponds to acceleration. The operation acceleration a of 0 indicates a constant speed. When the operation speed ω is positive and the acceleration is negative, the controller 110 determines that the current operation corresponds to deceleration. When the operation speed ω is 0 and the operation acceleration a is positive, the controller 110 determines that the current operation corresponds to acceleration. When the operation speed ω is 0 and the operation acceleration a is 0, the controller 110 determines that the current operation corresponds to acceleration. When the operation speed ω is 0 and the operation acceleration a is negative, the controller 110 determines that the current operation corresponds to deceleration. When the operation speed ω is negative and the operation acceleration a is positive, the controller 110 determines that the current operation corresponds to deceleration. When the operation speed ω is negative and the operation acceleration a is 0, the controller 110 determines that the current operation corresponds to deceleration. When the operation speed ω is negative and the operation acceleration a is negative, the controller 110 determines that the current operation corresponds to acceleration.
[0143] When determining in step S5 that the current operation corresponds to acceleration, the controller 110 advances to step S6. In step S6, the controller 110 determines the braking parameter τ corresponding to the changed level. The controller 110 determines the braking force value based on the determined braking parameter τ. Then, the controller 110 advances to step S8.
[0144] When determining in step S5 that the current operation corresponds to deceleration, the controller 110 advances to step S7. In step S7, the controller 110 determines the braking parameter τ corresponding to the changed level. The controller 110 determines the braking force value based on the determined braking parameter τ. Then, the controller 110 advances to step S8.
[0145] In step S8, the controller 110 outputs a current command value to exert at least one of the operation start assisting force, the in-operation assisting force, or the braking force corresponding to the changed level. In the first embodiment, the controller 110 exerts all of the operation start assisting force, the in-operation assisting force, and the braking force. The operations in step S2 to step S8 described above are performed in each control cycle of the controller 110, for example.
[0146] The braking force acting when the operator tries to stop the operation unit 120 is now described.
[0147] First, when the operator tries to stop the operation unit 120, the operation speed ω is decreased. In this case, the braking force during deceleration acts on the operation unit 120. When the operation speed ω becomes equal to or less than the threshold ω.sub.b, the braking force decreases as the operation speed ω decreases. Then, the operation unit 120 is stopped. In this manner, the braking force acts during deceleration, and thus overshoot caused by the inertia of the operation unit 120 when the operator tries to stop the operation unit 120 suddenly is significantly reduced or prevented.
[0148] Even when the operator tries to make their hand operating the operation unit 120 stationary, their hand may move unintentionally. For example, their hand may move unintentionally due to spasms of the operator's hand muscles or the operator's breathing. When the operation unit 120 advances beyond a position at which the operator tries to stop the operation unit 120 due to inertia, the operator may unintentionally try to return the operation unit 120 to a desired position. In such a case, the operation unit 120 is in an accelerated state. During acceleration, the braking force acts so as to increase as the operation speed ω increases such that it is possible to significantly reduce or prevent unintentional movement of the operation unit 120 as described above.
[0149] The relationship between the operation start assisting force and the braking force is now described. The operation start assisting force depends on the acceleration, and the braking force depends on the speed. Therefore, in an operation start region, i.e., a region in which the operation unit 120 is accelerating but the speed is near zero, the braking force is small, and the influence of the operation start assisting force is large.
[0150] However, as the speed increases, the braking force increases to some extent, and thus the braking force influences the operation start assisting force. On the other hand, during deceleration, the influence of the braking force is increased by setting a dead zone described below to reduce the operation start assisting force.
Advantages of First Embodiment
[0151] According to the first embodiment, the following advantages are achieved.
[0152] According to the first embodiment, as described above, the controller 110 is configured or programmed to change at least one of the level of the operation start assisting force, the level of the in-operation assisting force, or the level of the braking force based on the level change operation of the operator. Accordingly, the operator can change at least one of the level of the operation start assisting force, the level of the in-operation assisting force, or the level of the braking force to a desired level by the level change operation. Therefore, an operation on the operation unit 120 can be appropriately assisted according to the operator.
[0153] According to the first embodiment, as described above, the controller 110 is configured or programmed to change all of the level of the operation start assisting force, the level of the in-operation assisting force, and the level of the braking force based on the level change operation of the operator. Accordingly, as compared with a case in which only one or two of the level of the operation start assisting force, the level of the in-operation assisting force, and the level of the braking force are changed, an operation on the operation unit 120 can be more appropriately assisted according to the operator. The braking force acts when the operation unit 120 is stopped such that overshoot caused by the inertia of the operation unit 120 when the operator tries to stop the operation unit 120 suddenly is significantly reduced or prevented. The braking force acts such that movement of the operation unit 120 due to a reaction caused when the operation unit 120 is suddenly stopped, for example, is significantly reduced or prevented. Overshoot is significantly reduced or prevented, and the movement of the operation unit 120 due to a reaction, for example, is significantly reduced or prevented such that the operation unit 120 of the remote control apparatus 2 can be stopped at an appropriate position. The overshoot indicates that the operation unit 120 overshoots the appropriate stop position.
[0154] According to the first embodiment, as described above, the level change receiver 23a is provided to receive at least one of a change in the level of the operation start assisting force, a change in the level of the in-operation assisting force, or a change in the level of the braking force. Accordingly, the controller 110 can easily change at least one of the level of the operation start assisting force, the level of the in-operation assisting force, or the level of the braking force to a desired level based on the operation received by the level change receiver 23a.
[0155] According to the first embodiment, as described above, the level change receiver 23a includes a plurality of level selectors 23b1 to 23b4 corresponding to a plurality of levels. Accordingly, the operator can change the level by operating any of the plurality of level selectors 23b1 to 23b4.
[0156] According to the first embodiment, as described above, the plurality of level selectors 23b1 to 23b4 receive a level change for the target selected through the level change target selector 23c. Accordingly, the plurality of level selectors 23b1 to 23b4 are provided in common for the level of the operation start assisting force, the level of the in-operation assisting force, and the level of the braking force, and thus the configuration of the level change receiver 23a is simplified.
[0157] According to the first embodiment, as described above, the level change receiver 23a is arranged on the remote control apparatus 2. Accordingly, the level change receiver 23a is arranged in the vicinity of the operator who operates the remote control apparatus 2, and thus the operator can easily operate the level change receiver 23a.
[0158] According to the first embodiment, as described above, the controller 110 is configured or programmed to determine the values of the braking parameters τ of the servomotors M6a, M6b, and M6c based on the operation acceleration a and the operation speed ω with respect to the operation unit 120, and control the servomotors M6a, M6b, and M6c to exert the braking forces using the determined values of the braking parameters τ.
[0159] Accordingly, the level of the braking force can be easily changed according to the level of the braking parameter τ. According to the first embodiment, as described above, the controller 110 is configured or programmed to decrease the absolute value of the braking parameter τ as the absolute value of the operation speed ω decreases when the absolute value of the operation speed ω is equal to or less than the deceleration threshold. Accordingly, it is possible to significantly reduce a sense of discomfort in operation due to switching between positive and negative braking parameters τ when the operation speed ω is near zero. Furthermore, the controller 110 changes the level of the braking force by changing the upper limit of the absolute value of the braking parameter τ based on the level change operation of the operator. Thus, the maximum value of the braking force during deceleration can be easily changed by changing the upper limit of the absolute value of the braking parameter τ during deceleration.
[0160] According to the first embodiment, as described above, the controller 110 is configured or programmed to increase the absolute value of the braking parameter τ as the absolute value of the operation speed ω increases when the absolute value of the operation speed ω is less than the first acceleration threshold. Accordingly, it is possible to significantly reduce a sense of discomfort in operation due to switching between positive and negative braking parameters τ when the operation speed ω is near zero. Furthermore, the controller 110 changes the level of the braking force by changing the upper limit of the absolute value of the braking parameter τ based on the level change operation of the operator. Thus, the maximum value of the braking force during acceleration can be easily changed by changing the upper limit of the absolute value of the braking parameter τ during acceleration.
[0161] According to the first embodiment, as described above, the controller 110 is configured or programmed to determine the values of the operation start parameters τ.sub.2 of the servomotors M6a, M6b, M6c, and M6e based on the operation acceleration a with respect to the operation unit 120, and control the servomotors M6a, M6b, M6c, and M6e to exert the operation start assisting forces using the determined values of the operation start parameters τ.sub.2. Accordingly, using the operation start parameters τ.sub.2, the servomotors M6a, M6b, M6c, and M6e can easily exert the operation start assisting forces.
[0162] According to the first embodiment, as described above, the controller 110 is configured or programmed to linearly increase the absolute value of the operation start parameter τ.sub.2 as the absolute value of the operation acceleration a increases, and change the level of the operation start assisting force by changing the magnitude of the operation start parameter τ.sub.2 with respect to the operation acceleration a based on the level change operation of the operator. Accordingly, the magnitude of the operation start parameter τ.sub.2 is changed according to the level change operation of the operator, and thus the level of the operation start assisting force can be changed using the operation start parameter τ.sub.2 that has been changed in magnitude.
[0163] According to the first embodiment, as described above, the controller 110 is configured or programmed to determine the values of the in-operation parameters τ.sub.3 of the servomotors M6e and M6f based on the operation speed ω with respect to the operation unit 120, and control the servomotors M6e and M6f to exert the in-operation assisting forces using the determined values of the in-operation parameters τ.sub.3. Accordingly, using the in-operation parameters τ.sub.3, the servomotors M6e and M6f can easily exert the in-operation assisting forces.
[0164] According to the first embodiment, as described above, the controller 110 is configured or programmed to linearly increase the absolute value of the in-operation parameter τ.sub.3 as the absolute value of the operation speed ω increases, and change the level of the in-operation assisting force by changing the magnitude of the in-operation parameter τ.sub.3 based on the level change operation of the operator. Accordingly, the magnitude of the in-operation parameter τ.sub.3 is changed according to the level change operation of the operator, and thus the level of the in-operation assisting force can be changed using the in-operation parameter τ.sub.3 that has been changed in magnitude.
[0165] According to the first embodiment, as described above, the controller 110 is configured or programmed to exert at least one of the operation start assisting force, the in-operation assisting force, or the braking force on at least one of a plurality of servomotors M6a to M6g. Accordingly, at least one of the level of the operation start assisting force, the level of the in-operation assisting force, or the level of the braking force for at least one of a plurality of rotation axes A1 to A7 can be changed to a desired level.
Second Embodiment
[0166] A braking parameter τ according to a second embodiment is now described with reference to
[0167] In the second embodiment, as shown in
[0168] When the operation speed ω is between the threshold value ω.sub.c3 and the threshold ω.sub.c2 and between the threshold −ω.sub.c3 and the threshold −ω.sub.c2, the absolute value of the braking parameter τ increases linearly. When the operation speed ω is between the threshold ω.sub.c1 and 0 and between the threshold −ω.sub.c1 and 0, the absolute value of the braking parameter τ decreases linearly. When the operation speed ω is 0, the braking parameter τ is 0. The braking parameter τ during acceleration according to the second embodiment is similar to the braking parameter τ according to the first embodiment shown in
[0169] For example, as shown in
Third Embodiment
[0170] A braking parameter τ according to a third embodiment is now described with reference to
[0171] In the third embodiment, a controller 110 changes the level of a braking force by changing the upper limit of the absolute value of the braking parameter τ based on the level change operation of an operator. Specifically, as shown in
[0172] As shown in
Modified Examples
[0173] The embodiments disclosed this time must be considered as illustrative in all points and not restrictive. The scope of the present disclosure is not shown by the above description of the embodiments but by the scope of claims for patent, and all modifications or modified examples within the meaning and scope equivalent to the scope of claims for patent are further included.
[0174] For example, while all of the level of the operation start assisting force, the level of the in-operation assisting force, and the level of the braking force are changed based on the level change operation of the operator in each of the aforementioned first to third embodiments, the present disclosure is not limited to this. For example, one or two of the level of the operation start assisting force, the level of the in-operation assisting force, and the level of the braking force may alternatively be changed.
[0175] While the level change receiver 23a is arranged on the remote control apparatus 2 in each of the aforementioned first to third embodiments, the present disclosure is not limited to this. The level change receiver 23a may alternatively be arranged on an apparatus other than the remote control apparatus 2.
[0176] While the level change receiver 23a includes a touch panel in each of the aforementioned first to third embodiments, the present disclosure is not limited to this. For example, the level change receiver 23a may alternatively include a keyboard, a trackball, a mouse, a lever, a dial, a joystick, a foot switch, a push-button switch, and/or a combination thereof.
[0177] While the level selectors 23b1 to 23b4 are arranged in common for the operation start assisting force, the in-operation assisting force, and the braking force in each of the aforementioned first to third embodiments, the present disclosure is not limited to this. For example, the level selectors 23b1 to 23b4 may alternatively be arranged individually for each of the operation start assisting force, the in-operation assisting force, and the braking force.
[0178] While when the operation is accelerated, the braking parameter τ is set to zero when the operation speed ω is greater than the threshold ω.sub.a3 or less than the threshold −ω.sub.a3 in each of the aforementioned first to third embodiments, the present disclosure is not limited to this. For example, the braking parameter τ may alternatively be set to a value other than 0 when the operation speed ω is greater than the threshold ω.sub.a3 or less than the threshold −ω.sub.a3.
[0179] While the braking parameter τ becomes constant when the operation speed ω is between the threshold ω.sub.a1 and the threshold ω.sub.a2 and between the threshold −ω.sub.a1 and the threshold −ω.sub.a2 in each of the aforementioned first to third embodiments, the present disclosure is not limited to this. For example, the braking parameter τ may alternatively be decreased when the operation speed ω becomes greater than the threshold ω.sub.a1, and the braking parameter τ may alternatively be increased when the operation speed ω becomes less than the threshold −ω.sub.a1.
[0180] While the braking parameter τ becomes constant when the operation speed ω is between the threshold ω.sub.c1 and the threshold ω.sub.c2 and between the threshold −ω.sub.c1 and the threshold −ω.sub.c2 in the aforementioned second embodiment, the present disclosure is not limited to this. For example, the braking parameter τ may alternatively be decreased when the operation speed ω becomes greater than the threshold ω.sub.c1, and the braking parameter τ may alternatively be increased when the operation speed ω becomes less than the threshold −ω.sub.c1.
[0181] While the maximum of the absolute value of the braking parameter τ during deceleration of the operation is increased to greater than the maximum of the absolute value of the braking parameter τ during acceleration of the operation in each of the aforementioned first to third embodiments, the present disclosure is not limited to this. For example, the maximum of the absolute value of the braking parameter τ during deceleration of the operation may alternatively be the same as the maximum of the absolute value of the braking parameter τ during accelerating of the operation.
[0182] While the controller 110 of the remote control apparatus 2 performs a control to exert the operation start assisting force, the in-operation assisting force, and the braking force in each of the aforementioned first to third embodiments, the present disclosure is not limited to this. For example, a controller other than the controller 110 of the remote control apparatus 2 may alternatively perform a control to exert the operation start assisting force, the in-operation assisting force, and the braking force.
[0183] While a change in the braking parameter τ is the same when the operation speed ω decreases and when the operation speed ω increases in each of the aforementioned first to third embodiments, the present disclosure is not limited to this. For example, the hysteresis as shown in
[0184] Similarly, the operation start parameter τ.sub.2 may have a hysteresis. Specifically, as shown in
[0185] In each of the aforementioned first to third embodiments, before and after switching of control cycles, the operation start parameter τ.sub.2, the in-operation parameter τ.sub.3, and the braking parameter τ may not be changed to a predetermined value or more. Thus, it is possible to significantly reduce a sense of discomfort in operation such as vibration due to large changes in the magnitudes of the operation start parameter τ.sub.2, the in-operation parameter τ.sub.3, and the braking parameter τ.
[0186] While the number of levels of operation start assisting force, the number of levels of in-operation assisting force, and the number of levels of braking force are each four in each of the aforementioned first to third embodiments, the present disclosure is not limited to this. The number of levels of operation start assisting force, the number of levels of in-operation assisting force, and the number of levels of braking force may alternatively be other than four.
[0187] While the operation start parameter τ.sub.2 and the in-operation parameter τ.sub.3 change linearly in each of the aforementioned first to third embodiments, the present disclosure is not limited to this. For example, the operation start parameter τ.sub.2 and the in-operation parameter τ.sub.3 may alternatively change sinusoidally.
[0188] While four manipulator arms 60 are provided in each of the aforementioned first to third embodiments, the present disclosure is not limited to this. In the present disclosure, the number of manipulator arms 60 may alternatively be any number as long as at least one manipulator arm 60 is provided.
[0189] While each of the arm portion 61 and the positioner 40 includes a 7-axis articulated robot in each of the aforementioned first to third embodiments, the present disclosure is not limited to this. For example, each of the arm portion 61 and the positioner 40 may alternatively include an articulated robot having an axis configuration other than the 7-axis articulated robot. The axis configuration other than the 7-axis articulated robot refers to six axes or eight axes, for example.
[0190] While the medical manipulator 1 includes the medical cart 3, the positioner 40, and the arm base 50 in each of the aforementioned first to third embodiments, the present disclosure is not limited to this. For example, the medical manipulator 1 may not include the medical cart 3, the positioner 40, or the arm base 50, but may include only the manipulator arms 60.
[0191] While the operation handle 21 includes two operation handles including the operation handle 21L arranged on the left side and the operation handle 21R arranged on the right side in each of the aforementioned first to third embodiments, the present disclosure is not limited to this. For example, the operation handle 21 may alternatively include one or three or more operation handles.
[0192] The functionality of the elements disclosed herein may be implemented using circuitry or processing circuitry that includes general purpose processors, special purpose processors, integrated circuits, application specific integrated circuits (ASICs), conventional circuitry and/or combinations thereof that are configured or programmed to perform the disclosed functionality. Processors are considered processing circuitry or circuitry as they include transistors and other circuitry therein. In the present disclosure, the circuitry, units, or means are hardware that carries out or is programmed to perform the recited functionality. The hardware may be hardware disclosed herein or other known hardware that is programmed or configured to carry out the recited functionality. When the hardware is a processor that may be considered a type of circuitry, the circuitry, means, or units are a combination of hardware and software, and the software is used to configure the hardware and/or processor.