The present application claims priority to JP2021-126022, which is incorporated herein by reference.
The present disclosure relates to a robotic surgical system, an operator-side apparatus, and a control method of a robotic surgical system, and more particularly, it relates to a robotic surgical system and an operator-side apparatus each including an operation unit to receive an operation of an operator, and a control method of the robotic surgical system.
Conventionally, a robotic surgical system including an operation unit to receive an operation of an operator is known. For example, a technology that controls movement of a surgical instrument provided on an articulated robot arm as a slave based on the amount of operation received by an operation unit provided in a master control device is disclosed in U.S. Patent Application Publication No. 2004/0243110. In U.S. Patent Application Publication No. 2004/0243110, a tool moves within the patient's body, which is a surgical site.
In U.S. Patent Application Publication No. 2004/0243110, the operation unit provided in the master control device includes an articulated arm including a plurality of links. The articulated arm is suspended from above while being bent in an L shape. The articulated arm includes a motor. The motor located in the articulated arm generates a torque to resist the gravity. Even when an operator does not support the operation unit by hand, the torque generated by the motor maintains the L-shaped bent state of the articulated arm.
In U.S. Patent Application Publication No. 2004/0243110, the motor generates a force according to an operation speed at which the operator operates the operation unit. The force generated by the motor assists the operation of the operator on the operation unit. The operation on the operation unit is assisted such that a force required to operate the operation unit becomes small.
When the operation on the operation unit is assisted as in the U.S. Patent Application Publication No. 2004/0243110, the appropriate amount of force that assists the operation on the operation unit varies depending on the operator. In the U.S. Patent Application Publication No. 2004/0243110, the amount of assisting force may not be appropriate for the operator.
The present disclosure is intended to solve the above problem. The present disclosure aims to provide a robotic surgical system, an operator-side apparatus, and a control method of a robotic surgical system each capable of appropriately assisting an operation on an operation unit according to an operator.
In order to attain the aforementioned object, a robotic surgical system according to a first aspect of the present disclosure includes 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. 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.
In the robotic surgical system according to the first aspect of the present disclosure, as described above, the controller 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 received by the level change receiver. 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 can be appropriately assisted according to the operator.
An operator-side apparatus according to a second aspect of the present disclosure operates a patient-side apparatus including a manipulator arm having a tip end to which a surgical instrument is attached, and includes 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. 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.
In the operator-side apparatus according to the second aspect of the present disclosure, as described above, the controller 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, it is possible to provide the operator-side apparatus capable of appropriately assisting an operation on the operation unit according to the operator.
A control method of a robotic surgical system that includes 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 according to a third aspect of the present invention includes 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.
As described above, the control method of the robotic surgical system according to the third aspect of the present invention 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, and exerting at least one of the operation start assisting force, the in-operation assisting force, or the braking force corresponding to the changed level. 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, it is possible to provide the control method of the robotic surgical system capable of appropriately assisting an operation on the operation unit according to the operator.
According to the present disclosure, the operation on the operation unit can be appropriately assisted according to the operator.
The foregoing and other objects, features, aspects and advantages of the present disclosure will become more apparent from the following detailed description of the present disclosure when taken in conjunction with the accompanying drawings.
Embodiments of the present disclosure are hereinafter described with reference to the drawings.
The configuration of a surgical system 100 according to a first embodiment is now described with reference to
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
As shown in
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.
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.
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.
As shown in
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.
As shown in
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.
As shown in
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.
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.
The medical manipulator 1 shown in
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.
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.
As shown in
As shown in
As shown in
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.
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.
As shown in
The configuration of the manipulator arms 60 is now described in detail.
As shown in
As shown in
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
As shown in
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.
As shown in
As shown in
As shown in
As shown in
The mode indicator 84a also serves as a pivot position indicator that indicates that the pivot position PP has been set.
As shown in
As shown in
As shown in
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.
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.
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.
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.
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.
As shown in
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.
As shown in
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.
As shown in
As shown in
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.
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.
In the first embodiment, as shown in
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.
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.
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
In the first embodiment, as shown in
In the first embodiment, as shown in
Specifically, as shown in
The controller 110 multiplies the gain-multiplied acceleration a1 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 a1 is multiplied by a multiplying factor α. When the level selector 23b2 is pressed, the gain-multiplied acceleration a1 is multiplied by a multiplying factor β. When the level selector 23b3 is pressed, the gain-multiplied acceleration a1 is multiplied by a multiplying factor γ. When the level selector 23b4 is pressed, the gain-multiplied acceleration a1 is multiplied by a multiplying factor 1. It should be noted that α, β, γ, and 1 have a relationship of 0≤α≤β<γ<1. The gain-multiplied acceleration a1 having been multiplied by the multiplying factor is hereinafter referred to as a multiplying factor-multiplied acceleration a2.
The controller 110 limits the multiplying factor-multiplied acceleration a2 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 a2 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 a2 limited between the upper limit value and the lower limit value is hereinafter referred to as a limited acceleration a3.
The controller 110 applies the LPF to the limited acceleration a3. Thus, high-frequency noise can be removed from the limited acceleration a3. In particular, the limited acceleration a3 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 a3 becomes large. The limited acceleration a3 to which the LPF has been applied is hereinafter referred to as a post-LPF acceleration a4. The controller 110 adds the post-LPF acceleration a4 as the operation start compensation value to the gravity compensation value.
In
In-Operation Assisting Force
In the first embodiment, as shown in
In the first embodiment, as shown in
Specifically, as shown in
The controller 110 multiplies the gain-multiplied speed ω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 ω1 is multiplied by the multiplying factor α. When the level selector 23b2 is pressed, the gain-multiplied speed ω1 is multiplied by the multiplying factor β. When the level selector 23b3 is pressed, the gain-multiplied speed ω1 is multiplied by the multiplying factor γ. When the level selector 23b is pressed, the gain-multiplied speed ω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 ω1 multiplied by the multiplying factor is hereinafter referred to as a multiplying factor-multiplied speed ω2.
The controller 110 limits the multiplying factor-multiplied speed ω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 ω2 is limited, and thus an excessive increase in the in-operation assisting force is significantly reduced or prevented. The multiplying factor-multiplied speed ω2 limited between the upper limit value and the lower limit value is hereinafter referred to as a limited speed ω3.
The controller 110 applies the LPF to the limited speed ω3. The limited speed ω3 to which the LPF has been applied is hereinafter referred to as a post-LPF speed ω4. The controller 110 adds the post-LPF speed ω4 as the in-operation compensation value to the gravity compensation value.
In
Braking Force
As shown in
Specifically, as shown in
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
In the first embodiment, as shown in
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 ωa1, sets the braking parameter τ to constant Ta when the operation speed ω is equal to or greater than the threshold ωa1 and is less than a threshold ωa2, decreases the braking parameter τ as the operation speed ω increases when the operation speed ω is equal to or greater than the threshold CUa2 and is less than a threshold ωa3, and sets the braking parameter τ to zero when the operation speed ω is equal to or greater than the threshold ω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 −ωa1, sets the braking parameter τ to constant −τa when the operation speed ω is equal to or greater than a threshold −ωa2 and is less than the threshold −ωa1, decreases the braking parameter τ as the operation speed ω increases when the operation speed ω is equal to or greater than a threshold −ωa3 and is less than the threshold −ωa2, and sets the braking parameter τ to zero when the operation speed ω is equal to or less than the threshold −ωa3. The threshold ωa1 and the threshold −ωa1 are examples of a first acceleration threshold. The threshold ωa2 and the threshold −ωa2 are examples of a second acceleration threshold. The threshold ωa3 and the threshold −ωa3 are examples of a third acceleration threshold.
The negative operation speed ω indicates that the servomotor rotates in a reverse direction.
When the operation speed ω is between the threshold −ωa1 and the threshold ωa1, the braking parameter τ increases linearly. When the operation speed ω is between the threshold ωa2 and the threshold ωa3, the braking parameter τ decreases linearly. When the operation speed ω is between the threshold −ωa2 and the threshold −ωa3, the braking parameter τ increases linearly. When the operation speed ω is 0, the braking parameter τ is 0.
In the first embodiment, as shown in
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 ωa1, for example.
In
As shown in
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.
Specifically, when the operation is decelerated, the controller 110 sets the braking parameter τ to constant τb when the operation speed ω is greater than a threshold ωb, and decreases the braking parameter τ as the operation speed ω decreases when the operation speed ω is equal to or less than the threshold ωb. When the operation is decelerated, the controller 110 sets the braking parameter τ to constant −τb when the operation speed ω is less than a threshold −ωb, and increases the braking parameter τ as the operation speed ω increases when the operation speed ω is equal to or greater than the threshold −ωb. The threshold ωb and the threshold −ωb are examples of a deceleration threshold.
More specifically, when the operation speed ω is between the threshold ωb and 0, the braking parameter τ decreases linearly. When the operation speed ω is between the threshold −ωb and 0, the braking parameter τ increases linearly. When the operation speed ω is 0, the braking parameter τ is 0.
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 ωb and the threshold −ωb. For example, the threshold ωb and the threshold −ωb are changed to a threshold ωb1 and a threshold −ωb1, respectively, such that the maximum value of the braking parameter τ is increased from τb to ατb. The maximum of the absolute value of the braking parameter τ is changed to any of τb, ατb, βτb, and γτb. It should be noted that α, β, and γ have a relationship of 1<α<β<γ. The maximums of the absolute values of the braking parameters τ, which are γτb, βτb, ατb, τb, correspond to the level selectors 23b4, 23b3, 23b2, and 23b1, respectively.
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 ωb, for example.
In
As shown in
As shown in
A control flow of the surgical system 100 is now described with reference to
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
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.
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 τ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 τ2.
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 τ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 τ3.
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.
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.
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.
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.
The braking force acting when the operator tries to stop the operation unit 120 is now described.
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 ω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.
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.
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. 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.
According to the first embodiment, the following advantages are achieved.
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.
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.
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.
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.
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.
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.
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 τ.
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.
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.
According to the first embodiment, as described above, the controller 110 is configured or programmed to determine the values of the operation start parameters τ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 τ2. Accordingly, using the operation start parameters τ2, the servomotors M6a, M6b, M6c, and M6e can easily exert the operation start assisting forces.
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 τ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 τ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 τ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 τ2 that has been changed in magnitude.
According to the first embodiment, as described above, the controller 110 is configured or programmed to determine the values of the in-operation parameters τ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 τ3. Accordingly, using the in-operation parameters τ3, the servomotors M6e and M6f can easily exert the in-operation assisting forces.
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 τ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 τ3 based on the level change operation of the operator. Accordingly, the magnitude of the in-operation parameter τ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 τ3 that has been changed in magnitude.
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.
A braking parameter τ according to a second embodiment is now described with reference to
In the second embodiment, as shown in
When the operation speed ω is between the threshold value ωc3 and the threshold ωc2 and between the threshold −ωc3 and the threshold −ωc2, the absolute value of the braking parameter τ increases linearly. When the operation speed ω is between the threshold ωc1 and 0 and between the threshold −ω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
For example, as shown in
A braking parameter τ according to a third embodiment is now described with reference to
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
As shown in
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.
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.
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.
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.
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.
While when the operation is accelerated, the braking parameter τ is set to zero when the operation speed ω is greater than the threshold ωa3 or less than the threshold −ω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 ωa3 or less than the threshold −ωa3.
While the braking parameter τ becomes constant when the operation speed ω is between the threshold ωa1 and the threshold ωa2 and between the threshold −ωa1 and the threshold −ω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 ωa1, and the braking parameter τ may alternatively be increased when the operation speed ω becomes less than the threshold −ωa1.
While the braking parameter τ becomes constant when the operation speed ω is between the threshold ωc1 and the threshold ωc2 and between the threshold −ωc1 and the threshold −ω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 ωc1, and the braking parameter τ may alternatively be increased when the operation speed ω becomes less than the threshold −ωc1.
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.
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.
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
Similarly, the operation start parameter τ2 may have a hysteresis. Specifically, as shown in
In each of the aforementioned first to third embodiments, before and after switching of control cycles, the operation start parameter τ2, the in-operation parameter τ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 τ2, the in-operation parameter τ3, and the braking parameter τ.
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.
While the operation start parameter τ2 and the in-operation parameter τ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 τ2 and the in-operation parameter τ3 may alternatively change sinusoidally.
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.
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.
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.
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.
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.
Number | Date | Country | Kind |
---|---|---|---|
2021-126022 | Jul 2021 | JP | national |
Number | Name | Date | Kind |
---|---|---|---|
20040243110 | Niemeyer | Dec 2004 | A1 |
20090247993 | Kirschenman | Oct 2009 | A1 |
20180250086 | Grubbs | Sep 2018 | A1 |
20190059985 | Shelton, IV | Feb 2019 | A1 |
20200237456 | Prisco | Jul 2020 | A1 |
20220110705 | Hourtash | Apr 2022 | A1 |
20230149105 | Thornycroft | May 2023 | A1 |
Number | Date | Country |
---|---|---|
2021-023705 | Feb 2021 | JP |
Number | Date | Country | |
---|---|---|---|
20230034631 A1 | Feb 2023 | US |