Patent Application
20240374332
The disclosure may relate to a robotic surgical system and a method of controlling a robotic surgical system, and more particularly to a robotic surgical system and a method of controlling a robotic surgical system in which a drive of a pair of jaw members is controlled based on a rotation angle of a motor.
In a related art, a robotic surgical system is known that includes a surgical instrument including a pair of jaw members that are opened and closed by cables. Such a robotic surgical system is disclosed in U.S. Pat. No. 9,014,856, for example.
The above-mentioned U.S. Pat. No. 9,014,856 discloses a robotic surgical system including a surgical instrument including a pair of jaw members that are opened and closed by cables. In this robotic surgical system, as the surgical instrument is used over time, the cables that drive the pair of jaw members stretch, which may cause the pair of jaw members to be unable to exert a desired gripping force. Accordingly, the system compensates for such cable stretch. Specifically, in this robotic surgical system, a motor is torque-controlled so as to drive the jaw members within a predetermined torque range between an upper limit torque and a lower limit torque.
In the robotic surgical system described in the above listed U.S. Pat. No. 9,014,856, the motor that drives the jaw members is controlled based on the torque; however, in some cases, it is effective to use the rotation angle to control the motor that drives the jaw members. For example, in a case in which a motor is torque-controlled, if a decelerator with a high reduction ratio is used, a behavior of a distal end side of the surgical instrument is less likely to be reflected as a change in the motor torque. In this case, it becomes difficult to detect the behavior of the distal end side of the surgical instrument by detecting changes in the torque of the motor. In order to solve this problem, it is effective to control the motor that drives the jaw members based on the rotation angle thereof. However, in a case in which the motor that drives the jaw members is controlled based on the rotation angle thereof, the method described in the above-mentioned U.S. Pat. No. 9,014,856 cannot be used. For this reason, it is desirable to suppress a decrease in the gripping force of the jaw members in a configuration in which the drive of the jaw members is controlled based on the rotation angle of the motor.
An embodiment of disclosure may provide a robotic surgical system and a method of controlling a robotic surgical system that are capable of suppressing a decrease in a gripping force of jaw members in a configuration in which a drive of the jaw members of a surgical instrument is controlled based on a rotation angle of a motor.
A robotic surgical system according to a first aspect may include a surgical instrument including a pair of jaw members configured to be opened and closed by an elongate element; a robotic arm which includes a motor configured to drive the elongate element and to which the surgical instrument is attached; a first storage that stores in advance a first value corresponding to a rotation angle of the motor when a predetermined current value is reached; and a controller that is configured to acquire a second value corresponding to the rotation angle of the motor when the predetermined current value is reached, and perform calibration to change, based on the acquired second value and the first value stored in the first storage, a command angle for a tightening operation of the jaw members.
According to the first aspect, the controller is provided that acquires the second value corresponding to the rotation angle of the motor when the predetermined current value is reached, and performs the calibration to change the command angle for the tightening operation of the jaw members based on the acquired second value and the first value stored in the first storage. Accordingly, in a configuration in which the drive of the jaw members of the surgical instrument is controlled according to the rotation angle of the motor, it is possible to perform the calibration to compensate for the stretch of the elongate element. Therefore, in the configuration in which the drive of the jaw members of the surgical instrument is controlled according to the rotation angle of the motor, the decrease in the gripping force of the jaw members can be suppressed.
A method of controlling a robotic surgical system according to a second aspect may be the method of controlling the robotic surgical system which includes: a surgical instrument including a pair of jaw members configured to be opened and closed by an elongate element; and a robotic arm which includes a motor configured to drive the elongate element and to which the surgical instrument is attached. The method may include: acquiring a second value corresponding to a rotation angle of the motor when a predetermined current value is reached; and performing calibration that changes, based on the acquired second value and a first value stored in advance that corresponding to the rotation angle of the motor when the predetermined current value is reached, a command angle for a tightening operation of the jaw members.
According to the second aspect, the method includes: acquiring the second value corresponding to the rotation angle of the motor when the predetermined current value is reached, the second value corresponding to the first value corresponding to the rotation angle of the motor when the predetermined current value is reached; and the step of performing calibration that changes, based on the acquired second value and the first value stored in advance, the command angle for the tightening operation of the jaw members. Accordingly, in a configuration in which the drive of the jaw members of the surgical instrument is controlled according to the rotation angle of the motor, it is possible to perform the calibration to compensate for the stretch of the elongate element. Therefore, it is possible to provide the method of controlling the robotic surgical system that is capable of suppressing the decrease in the gripping force of the jaw members in the configuration in which the drive of the jaw members of the surgical instrument is controlled according to the rotation angle of the motor.
Therefore, it is possible to provide a robotic surgical system and a method of controlling a robotic surgical system that are capable of suppressing a decrease in a gripping force of jaw members in a configuration in which a drive of the jaw members of a surgical instrument is controlled based on a rotation angle of a motor.
Descriptions are provided hereinbelow for embodiments based on the drawings. In the respective drawings referenced herein, the same constituents are designated by the same reference numerals and duplicate explanation concerning the same constituents is omitted. All of the drawings are provided to illustrate the respective examples only.
Descriptions are provided hereinbelow for an embodiment based on the drawings.
A configuration of a robotic surgical system 100 according to an embodiment is described with reference to
As illustrated in
The patient-side apparatus 20 constitutes an interface to perform a surgery for a patient P. The patient-side apparatus 20 is positioned beside an operation table 30 on which the patient P is laid. The patient-side apparatus 20 includes the plurality of robot arms 21a and 21b, an arm base 22, a positioner 23, the controller 24, a storage 25, and a temporary storage 26. An endoscope 50 is attached to one robot arm 21b among the plural robot arms 21a and 21b, and the surgical instruments 40 are attached to the other robot arms 21a. The robot arms 21a and 21b are commonly supported by the arm base 22. Each of the plural robot arms 21a and 21b includes plural joints. Each joint includes a driver including a servo-motor and a position detector such as an encoder or the like. The robot arms 21a and 21b are configured so that the medical equipment attached to each of the robot arms 21a and 21b is controlled by a driving signal given through the controller 24 and performs a desired movement.
The arm base 22 is supported by a positioner 23 placed on the floor of an operation room. The positioner 23 includes a vertical articulated robot. The positioner 23 is configured to move the position of the arm base 22 three-dimensionally. The controller 24 is a control circuit including an arithmetic unit such as a CPU and/or the like, and a memory such as a ROM, a RAM, and/or the like. The storage 25 is a data storage, and stores a threshold value θS1 which will be described later and a threshold value θS2 which will be described later. The temporary storage 26 stores a difference Δθ, which will be described later. The storage 25 and the temporary storage 26 are provided in a robot body 27 on which the robot arms 21a and 21b are provided. The temporary storage 26 is an example of a second storage. The threshold value θS1 is an example of a second threshold value. The threshold value θS2 is an example of a first threshold value.
The surgical instruments 40 as the medical equipment are detachably attached to the distal ends of the robot arms 21a. Each surgical instrument 40 includes: a housing 41 (see
To the distal end of the robot arm 21b, the endoscope 50 as the medical equipment is detachably attached. The endoscope 50 captures an image in a body cavity of the patient P. The captured image is outputted to the remote control apparatus 10. The endoscope 50 may be a 3D endoscope capable of capturing a three-dimensional image or a 2D endoscope. In surgeries using the patient-side apparatus 20, the robot arm 21b introduces the endoscope 50 into the body of the patient P through a trocar placed on the body surface of the patient P. The endoscope 50 is then located near the surgery site.
The remote control apparatus 10 constitutes an interface with the operator. The remote control apparatus 10 is an apparatus that allows the operator to operate the medical equipment attached to the robot arms 21a and 21b. Specifically, the remote control apparatus 10 is configured to transmit action mode instructions which are inputted by the operator and are to be executed by the surgical instruments 40 and the endoscope 50, to the patient-side apparatus 20 through the controller 24. The remote control apparatus 10 is installed beside the operation table 30 so that the operator can see the condition of the patient P very well while operating the remote control apparatus 10, for example. The remote control apparatus 10 may be configured to transmit the action mode instructions wirelessly and installed in a room different from the operation room where the operation table 30 is installed.
The action modes to be executed by the surgical instruments 40 include modes of actions to be taken by each surgical instrument 40 (a series of positions and postures) and actions to be executed by the function of each surgical instrument 40. When the surgical instrument 40 is a pair of grasping forceps, for example, the action modes to be executed by the surgical instrument 40 include roll and pitch positions of the wrist of the end effector 43 and actions to open and close the jaws. When the surgical instrument 40 is a high-frequency knife, the action modes to be executed by the surgical instrument 40 include vibration of the high-frequency knife, specifically, supply of current to the high-frequency knife. When the surgical instrument 40 is a snare wire, the action modes to be executed by the surgical instrument 40 include a capturing action and an action to release the captured object. Further, the action modes may include an action to supply current to a bipolar or monopolar instrument to burn off the surgery site.
The action modes to be executed by the endoscope 50 include the position and posture of the distal end of the endoscope 50 and setting of the zoom magnification, for example.
As illustrated in
The operation handles 11 are provided in order to remotely operate the medical equipment attached to the robot arms 21a and 21b. Specifically, the operation handles 11 accept operations by the operator for operating the medical equipment (the surgical instruments 40 and endoscope 50). The operation handles 11 are composed of two operation handles 11 arranged side by side in the horizontal direction. One of the two operation handles 11 is operated by the right hand of the operator while the other of the two operation handle 11 is operated by the left hand of the operator.
The operation handles 11 extend from the rear side of the remote control apparatus 10 toward the front side. The operation handles 11 are configured to move in a predetermined three-dimensional operation region. Specifically, the operation handles 11 are configured to be movable in a vertical direction, a horizontal direction, a front-rear direction, and a rotational direction.
As illustrated in
As illustrated in
The patient-side apparatus 20 controls the movement of the robot arms 21a in accordance with the set motion scaling ratio. When the motion scaling ratio is set to ½, for example, the end effectors 43 of the surgical instruments 40 move ½ of the movement distance of the operation handles 11. This allows for precise fine surgery.
The operation pedal section 12 includes plural pedals to execute medical equipment-related functions. The plural pedals include a coagulation pedal, a cutting pedal, a camera pedal, and a clutch pedal. The plural pedals are operated by a foot of the operator.
The coagulation pedal enables the surgical instrument 40 to coagulate a surgery site. Specifically, when the coagulation pedal is operated, voltage for coagulation is applied to the surgical instrument 40 to coagulate the surgery site. The cutting pedal enables the surgical instrument 40 to cut the surgery site. Specifically, the cutting pedal is operated to apply voltage for cutting to the surgical instrument 40 and cut a surgery site.
The camera pedal is used to control the position and orientation of the endoscope 50 that captures images within the body cavity. Specifically, the camera pedal enables operation of the endoscope 50 by the operation handles 11. That is, the position and orientation of the endoscope 50 are controllable by the operation handles 11 while the camera pedal is being pressed. The endoscope 50 is controlled by using both of the right and left operation handles 11, for example. Specifically, when the operator rotates the right and left operation handles 11 about the middle point between the right and left operation handles 11, the endoscope 50 is rotated. When the operator presses the right and left operation handles 11 together, the endoscope 50 goes forward into the body cavity. When the operator pulls the right and left operation handles 11 together, the endoscope 50 goes back. When the operator moves the right and left operation handles 11 together up, down, right, or left, the endoscope 50 moves up, down, right, or left, respectively.
The clutch pedal is used to temporarily disconnect operation-related connection between the robot arms 21a and the operation handles 11 to stop movement of the surgical instruments 40. Specifically, when the clutch pedal is being pressed, the robot arms 21a of the patient-side apparatus 20 do not work even if the operation handles 11 are operated. For example, when the operation handles 11 are operated and moved to the edge of the range of movement, the operator operates the clutch pedal to temporarily disconnect the operation-related connection and then returns the operation handles 11 to the center of the range of movement. When the operator stops operating the clutch pedal, the operation handles 11 are again connected to the robot arms 21a. The operator restarts the operation for the operation handles 11 around the center thereof.
The display 13 is configured to display images captured by the endoscope 50. The display 13 comprises a scope type display or a non-scope type display. (Note that
When the scope type display is attached, the scope type display displays 3D images captured by the endoscope 50 attached to the robot arm 21b of the patient-side apparatus 20. When the non-scope type display is attached, the non-scope type display also displays 3D images captured by the endoscope 50 provided for the patient-side apparatus 20. Here, when the non-scope type display is attached, 2D images captured by the endoscope 50 provided to the patient-side apparatus 20 may be displayed.
The touch panel 14 serves as an operation section and a display section. The touch panel 14 displays a screen for setting operations for the remote control apparatus 10 and receives setting operations for the remote control apparatus 10.
As illustrated in
When determining that the action mode instruction inputted by the operation handles 11 is to be executed by the endoscope 50, the controller 151 transmits the action mode instruction to the robot arm 21b through the controller 24. The robot arm 21b is thereby driven for control of movement of the endoscope 50 attached to the robot arm 21b.
The storage 152 stores control programs corresponding to the types of the surgical instrument 40, for example. The controller 151 reads the stored control programs according to the types of the attached surgical instruments 40.
The action mode instructions from the operation handles 11 and/or the operation pedal section 12 of the remote control apparatus 10 thereby cause the respective surgical instruments 40 to perform proper movements.
The image controller 153 transmits images acquired by the endoscope 50 to the display 13. The image controller 153 performs processing and modifying the images when needed.
With reference to
Here, the direction in which the surgical instrument 40 extends (the direction in which the shaft 42 extends) is defined as a Y direction, the distal side (the side toward the end effector 43) of the surgical instrument 40 along the Y direction is defined as a Y1 direction, and the opposite side of the Y1 direction is defined as a Y2 direction. The direction in which the surgical instrument 40 and the adaptor 60 are adjacent to each other is defined as a Z direction, the surgical instrument 40 side along the Z direction is defined as a Z1 direction, and the opposite side of the Z1 direction is defined as a Z2 direction. Further, the direction orthogonal to the Y direction and the Z direction is referred to as an X direction, one side along the X direction is referred as an X1 direction, and the other side along the X direction is referred to as an X2 direction.
As illustrated in
The surgical instrument 40 is attached to the Z1 side of the adaptor 60. The adaptor 60 is attached to the Z1 side of the robot arm 21a.
The robot arm 21a is used in a clean area and is covered with the drape 70. In operation rooms, clean technique is used in order to prevent surgical incision sites and medical equipment from being contaminated by pathogen, foreign matters, or the like. The clean technique defines a clean area and a contaminated area, which is outside the clean area. The surgery sites are located in the clean area. Members of the surgical team, including the operator, make sure that only sterile objects are placed in the clean area during surgery and perform sterilization for an object which is to be moved to the clean area from the contaminated area. Similarly, when an assistant, as one of the members of the surgical team including the operator, places their hands in the contaminated area, the members sterilize their hands before directly touching objects located in the clean area. Instruments used in the clean area are sterilized or are covered with the drapes 70 that are sterilized.
As illustrated in
As illustrated in
The driven members 44a to 44d are provided within the housing 41 and are rotatable about the respective rotation axes extending along the Z axis. The plural driven members 44a to 44d are provided to operate (drive) the end effector 43. The driven members 44b to 44d are connected to the end effector 43 via cables A, serving as elongate elements, passing through the inside of the shaft 42. With this, rotations of the driven members 44b to 44d drive the cables A, which operate (drive) the end effector 43. In addition, the driven member 44a is connected to the shaft 42 through gears 42a (see
To transmit driving forces from the robot arm 21a to the end effector 43, each of the driven members 44a to 44d includes a projection 441 or 442, which is engaged with a corresponding one of drive transmission members 61 of the adaptor 60. Each of the projections 441 and 442 is projected from the Z2 side surface of the corresponding driven member 44a to 44d toward the side of the adaptor 60 (the Z2 side). Each of the projections 441 and 442 includes plural projection portions that arranged in a straight line. The protrusions 441 provided to the driven members 44a and 44b have different shapes from that of the protrusions 442 provided to the driven members 44c and 44d.
As illustrated in
Each of the drive transmission members 61 includes an engagement recess 611 which is engaged with the projection 441 or 442 of the corresponding driven member 44a to 44d of the surgical instrument 40. The engagement recess 611 is located at the surgical instrument 40 side (the Z1 side) of the drive transmission member 61 and is recessed from the Z1 side surface of the drive transmission member 61, toward the Z2 direction, opposite to the surgical instrument 40. Each of the drive transmission members 61 includes an engagement recess, which is provided on the Z2 side surface thereof and is configured to be engaged with a corresponding engagement projection 213 of the robot arm 21a.
The robot arm 21a includes a frame 211, plural (four) drive parts 212, and plural engagement projections 213. The plural drive parts 212 are provided corresponding to the plural (four) driven members 44a to 44d of the surgical instrument 40 and corresponding to the plural (four) drive transmission members 61 of the adaptor 60. The drive part 212 is configured to drive the engagement projection 213 to rotate about a rotation axis thereof extending in the Z direction. The engagement projection 213 is engaged with the engagement recess provided on the Z2 side surface of the drive transmission member 61. The engagement projection 213 is projected from the Z1 side surface of the robot arm 21a toward the Z1 side (the adaptor 60 side). The drive parts 212 are configured to drive the drive transmission members 61 of the adaptor 60, engaged with the engagement projections 213, to rotate about the rotational axes extending in the Z direction, so as to drive the driven members 44a to 44d of the surgical instrument 40, engaged with the drive transmission members 61, to rotate about the rotational axes extending in the Z direction.
Next, with reference to
As illustrated in
The cable A3 is wound around the driven member 44b. Specifically, a first portion A3a of the cable A3 is wound in the clockwise direction around an upper portion of the driven member 44b, and a second portion A3b of the cable A3 is wound in the counterclockwise direction around a lower portion of the driven member 44b.
The cable A1 is wound around the driven member 44c of the surgical instrument 40. Specifically, a first portion A1a of the cable A1 is wound in the clockwise direction around an upper portion of the driven member 44c, and a second portion A1b of the cable A1 is wound in the counterclockwise direction around a lower portion of the driven member 44c.
The cable A2 is wound around the driven member 44d. Specifically, a first portion A2a of the cable A2 is wound in the clockwise direction around an upper portion of the driven member 44d, and a second portion A2b of the cable A1 is wound in the counterclockwise direction around a lower portion of the driven member 44d.
The cables A extend respectively from the driven members 44b to 44d through the shaft 42 to the end effector 43, are wound around the end effector 43, and return through the shaft 42 to the driven members 44b to 44d. In addition, the cables A are hung on pulleys 46. The pulleys 46 are retained by a pulley retainer 461.
As illustrated in
When the driven member 44d rotates about the rotary axis thereof, the rotation of the driven member 44d operates the jaw member 43b, which is one of the jaw members 43a and 43b of the end effector 43. Specifically, the driven member 44d is rotated by the drive part 212 to drive the cable A2. The cable A2 extends through the inside of the shaft 42 and connects the jaw member 43b and the driven member 44d. Specifically, the cable A2 is wound around a pulley 43e provided at the base of the jaw member 43b. When the driven member 44d is rotated in the C3 direction (see
By being rotated about the rotation axis thereof, the driven member 44b operates a wrist portion 43c of the end effector 43. Specifically, the driven member 44b is rotated by the drive part 212 to drive the cable A3. The cable A3 extends through the inside of the shaft 42 and connects the wrist portion 43c and the driven member 44b. When the driven member 44b is rotated in the C5 direction (see
When the drive part 212 rotates the driven member 44a about the rotation axis thereof with the gear portion 443 of the driven member 44a being engaged with a gear portion 42a connected to the proximal end of the shaft 42, the shaft 42 is driven to operate the end effector 43. Specifically, when the driven member 44a rotates in the C7 direction (see
Next, a configuration relating to opening and closing of the jaw members 43a and 43b will be described with reference to
As illustrated in
The controller 24 drives the motors 212a based on a signal from the operation handles 11. With this, the decelerator 212b, the engagement protrusion 213, the drive transmission member 61, and the driven members 44c, 44d are rotated, so as to drive the cables A1, A2. As a result, the jaw members 43a and 43b are opened and closed. The controller 24 drives the motor 212a such that the open angle between the jaw members 43a and 43b becomes an open angle that corresponds to a signal from the operation handles 11 (a target open angle). The controller 24 controls, based on the detection result of the rotation angle of the motor 212a detected by the position detector 212c, the rotation angle of the motor 212a such that the rotation angle corresponds to the target open angle. That is, the controller 24 controls the driving of the jaw members 43a and 43b by the rotation angle of the motor 212a.
For example, in the following cases, it is more effective to control the motor 212a that drives the jaw members 43a and 43b according to the rotation angle of the motor 212a rather than controlling the motor 212a that drives the jaw members 43a and 43b according to the torque. That is, in order to reduce the size of the robot arm 21a around the surgical field so as to ensure a working area, it is effective to reduce the size of the motor 212a. In order to reduce the size of the motor 212a, it is effective to use the decelerator 212b having a high reduction ratio. However, if the decelerator 212b having the high reduction ratio is used in a case in which the motor 212a is torque-controlled, the behavior of the distal end side of the surgical instrument 40 is less likely to be reflected as a change in the torque of the motor 212a. This makes it difficult to detect the behavior of the distal end side of the surgical instrument 40 by detecting the change in the torque of the motor 212a. In order to solve this problem, it is effective to control the rotation angle of the motor 212a that drives the jaw members 43a and 43b.
In addition, by further rotating the motor 212a in the closing direction of the jaw members 43a and 43b from a state in which the jaw members 43a and 43b are closed (i.e., a state in which the open angle is zero), a tightening force (gripping force) can be generated by the jaw members 43a and 43b. Hereinafter, a command angle by which the jaw members 43a and 43b are further closed from the state in which the open angle between the jaw members 43a and 43b is zero is referred to as a tightening angle. in the embodiment, the tightening angle is a negative value, but is not limited thereto. The tightening angle is an example of a value corresponding to the rotation angle of the motor 212a, and is calculated by the following formula (1).
θ=2×Rp×Rm×θm (1)
Here, θ, Rp, Rm and θm are as follows:
Here, the surgical instrument 40 is washed and sterilized after each surgery and is used multiple times. Therefore, as the surgical instrument 40 is used over time, lengths of the cables A1 and A2 that drive the jaw members 43a and 43b may become elongated. When the lengths of the cables A1, A2 become elongated, even if the motor 212a is controlled to a predetermined rotation angle, the jaw members 43a and 43b cannot be sufficiently tightened, and the gripping force of the jaw members 43a and 43b decreases.
Therefore, in the embodiment, as illustrated in
In the embodiment, the storage 45 stores the maximum tightening angle θ0 in advance. The maximum tightening angle θ0 is an example of a value corresponding to a maximum rotation angle of the motor 212a in the closing direction of the jaw members 43a and 43b. The controller 24 corrects the value θ0 based on the values θ2 and θ1. With this, it possible to correct the maximum tightening angle θ0 between the jaw members 43a and 43b, and therefore to increase the maximum rotation angle of the motor 212a which can rotate in the closing direction of the jaw members 43a and 43b. As a result, it is possible to reliably prevent the decrease in the gripping force of the jaw members 43a and 43b caused by the elongation of the cables A1 and A2.
Specifically, in the embodiment, the controller 24 corrects the value θ0 by adding the difference Δθ between the value θ2 and the value θ1 to the value θ0. This allows the value θ0 to be corrected simply by adding the difference Δθ between the values θ2 and θ1 to the value θ0, so that the calibration correction process can be performed by a simple process. The controller 24 performs the calibration that changes the value θ0 of the command angle to a value θ0+Ae.
More specifically, in the embodiment, the controller 24 corrects the value θ0 so that the jaw members 43a and 43b can close up to the tightening angle of (θ0+Δθ) obtained by adding the difference Δθ between the tightening angle values θ2 and θ1 to the tightening angle value θ0. This enables the jaw members 43a and 43b to be closed up to a tightening angle obtained by adding the difference Δθ between the tightening angle values θ2 and θ1 to the tightening angle value θ0 (i.e., the maximum tightening angle θ0+A8 taking into account the elongation of the cables A1, A2). Therefore, it is possible to more reliably suppress a decrease in the gripping force of the jaw members 43a and 43b caused by the elongation of the cables A1, A2 over time.
Here, the principle of calibration for compensating for the elongation of the cables A1 and A2 in the embodiment will be described. The storage 45 stores in advance, as initial values, the tightening angle value θ1 when the current value reaches the predetermined value I1, and a maximum tightening angle θ0. The values θ1 and θ0 are stored in advance in the storage 45 by an operator at the manufacturer before the surgical instrument 40 is shipped from the manufacturer. At the manufacturer, the values θ1 and θ0 are obtained taking into account the initial slack of the cables A1 and A2. The value θ0 is set to a value that enables the jaw members 43a and 43b to exert a predetermined gripping force. The absolute value of the value θ0 is greater than the absolute value of the value θ1.
The controller 24 starts the calibration from a state in which the jaw members 43a and 43b are closed (a state in which the open angle between the jaw members 43a and 43b is zero). The controller 24 drives the motor 212a to rotate to make the tightening angle the maximum tightening angle θ0. In addition, in the course of rotating the motor 212a to close the jaw members 43a and 43b to a point where the value corresponding to the rotation angle of the motor 212a becomes the value θ0 (as the target value), the controller 24 acquires the value θ2. As the jaw members 43a and 43b are further closed from the state the jaw members 43a and 43b are closed, the current value of the motor 212a increases. The current value of the motor 212a is detected (monitored) by the current detector 214. in the case in which the cables A1, A2 are stretched, even when the tightening angle of the jaw members 43a and 43b reaches the value θ1, the current value of the motor 212a reaches a value smaller than the predetermined current value I1. The controller 24 obtains the tightening angle value θ2 when the current value of the motor 212a reaches the predetermined current value I1 based on the detection result of the current detector 214. In addition, the controller 24 calculates the difference Δθ between the value θ2 and the value θ1. The difference Δθ between the value θ2 and the value θ1 corresponds to the elongation of the cables A1 and A2 due to use. Further, the controller 24 corrects the value θ0 so that the jaw members 43a and 43b are able to be closed up to a tightening angle θ0+A8 obtained by adding the difference Δθ between the values θ2 and θ1 to the initial maximum tightening angle value θ0. This can make the current response of the motor 212a in the state in which the cables A1 and A2 are elongated equivalent to the initial current response of the motor 212a, thereby suppressing a decrease in the gripping force of the jaw members 43a and 43b caused by the elongation of the cables A1 and A2. Note that the absolute value of the value θ0 is greater than the absolute value of the value θ2.
Further, in the embodiment, the controller 24 determines, based on the threshold value θS1, whether or not the value θ2 is within a predetermined range with respect to the value θ1. when it is determined that the value θ2 is within the predetermined range with respect to the value θ1, the controller 24 does not correct the value θ0. To the contrary, when it is determined that the value θ2 is out of the predetermined range with respect to the value θ1, the controller 24 corrects the value θ0. This makes it possible to avoid unnecessarily correcting the value θ0 when it is determined that the value θ2 is within the predetermined range relative to the value θ1 (that is, when the elongation of the cables A1 and A2 is small and thus the correction is not necessary). Further, when it is determined that the value θ2 is out of the predetermined range relative to the value θ1 (that is, when the extension of the cables A1 and A2 is large and thus the correction is necessary), the value θ0 is appropriately corrected.
Specifically, the controller 24 determines whether the value θ2 is within the range θ1±θS1. The threshold value θS1 is not particularly limited, and may be a value obtained by converting a value (such as Y Newtons) that determines the upper and lower limits of the range (such as X±Y Newtons) of the set gripping force of the jaw members 43a and 43b into a tightening angle using a conversion coefficient. Note that when the range of the set gripping force differs depending on the type of the jaw members 43a and 43b (i.e., the type of the end effector 43), the threshold value θS1 may be different for each type of the end effector 43. The threshold value θS1 is a positive value in the embodiment, and is stored in the storage 25 provided in the robot body 27.
Further, in the embodiment, the controller 24 determines whether the difference Δθ between the value θ2 and the value θ1 is within the normal range based on the threshold value θS2. When it is determined that the difference Δθ between the value θ2 and the value θ1 is within the normal range, the controller 24 corrects the value θ0. To the contrary, when it is determined that the difference Δθ between the value θ2 and the value θ1 is outside the normal range, the controller 24 reacquires the value θ2. As a result, when it is determined that the difference Δθ between the value θ2 and the value θ1 is within the normal range, the value θ0 is corrected so that the calibration can be performed appropriately. Further, when it is determined that the difference Δθ between the value θ2 and the value θ1 is outside the normal range, the value θ2 is acquired again, thereby making it possible to avoid acquiring an excessively large value θ2 (and difference Δθ). As a result, it is possible to prevent the value θ0 from being corrected to an excessively large value based on an excessively large θ2 (and the difference Δθ). With this, it possible to prevent the cables A1 and A2 from being damaged due to an excessive load being applied to the cables A1 and A2 caused by the value θ0 being corrected to an excessively large value.
Specifically, the controller 24 determines whether the difference Δθ between the value θ2 and the value θ1 is within the range of θ32<Δθ<0. The threshold value θS2 is not particularly limited, and may be a common value regardless of the type of the end effector 43. In the embodiment, the threshold value θS2 is a negative value and is obtained in advance by experiment or the like and stored in the storage 25 provided in the robot body 27.
In the embodiment, the storage 45 that stores the value θ1 is provided in the surgical instrument 40. This allows a different value θ1 for each surgical instrument 40 to be stored in advance in the storage 45 provided in the surgical instrument 40, so that an appropriate value θ1 for each surgical instrument 40 can be easily used when using the surgical instrument 40. In the embodiment, the storage 45 also stores the value θ0. As in the value θ1, this allows a different value θ0 for each surgical instrument 40 to be stored in advance in the storage 45 provided in the surgical instrument 40, so that an appropriate value θ0 for each surgical instrument 40 can be easily used when using the surgical instrument 40.
Further, in the embodiment, the temporary storage 26 that stores a correction value (Δθ) based on the value θ1 and the value θ2 is provided in the robot body 27. As a result, even when the surgical instrument 40 is removed from the robot arm 21a during surgery and then reattached to the robot arm 21a, there is no need to re-acquire the correction value (Δθ) since the correction value (Δθ) is stored in the temporary storage 26 provided in the robot body 27. As a result, it is possible to eliminate the need to re-acquire the correction value (Δθ) each time the surgical instrument 40 is attached to the robot arm 21a. The correction value (Δθ) stored in the temporary storage 26 is reset (deleted) for each surgery (for example, each time the power to the robot body 27 is turned off or restarted). Therefore, it is possible to obtain an appropriate value Δθ for each surgery.
Further, in the embodiment, the controller 24 starts the calibration at least one of the following times: when the surgical instrument 40 is attached to the robot arm 21a; and when a user interface (such as the operation handle 11 or the touch panel 14) that accepts an operation to execute the calibration is operated. As a result, in the case in which the calibration is started at the time when the surgical instrument 40 is attached to the robot arm 21a, the calibration is executed simply by attaching the surgical instrument 40 to the robot arm 21a, thereby saving the user effort. In the case in which the calibration is started at the timing when the user interface that accepts the operation to execute the calibration is operated, the calibration is executed at a timing desired by the user. The operation handle 11 or the touch panel 14 is an example of a user interface.
Further, in the case where the calibration is started at the timing when the surgical instrument 40 is attached to the robot arm 21a, the controller 24 determines whether or not the surgical instrument 40 is attached to the robot arm 21a for the first time during the surgery. When it is determined that the attachment of the surgical instrument 40 to the robot arm 21a is for the first time during the surgery, the controller 24 starts the calibration, and when it is determined that the attachment of the surgical instrument 40 to the robot arm 21a is not for the first time during the surgery, the controller 24 does not start the calibration. This allows the calibration to be started appropriately when it is determined that the surgical instrument 40 is attached to the robot arm 21a for the first time during the surgery (i.e., when the calibration has not been performed). Further, when it is determined that the attachment of the surgical instrument 40 to the robot arm 21a is not the first time during the surgery (i.e., when the calibration has already been performed), the calibration is not started, thereby preventing unnecessary calibration from being performed.
When the surgical instrument 40 is attached to the robot arm 21a, the controller 24 obtains the serial number of the surgical instrument 40 from the storage 45, and determines based on the obtained serial number of the surgical instrument 40 whether or not this is the first time that the surgical instrument 40 has been attached to the robot arm 21a during the surgery. Specifically, when the obtained serial number of the surgical instrument 40 is not stored in the storage 25 or the temporary storage 26, the controller 24 determines that this is the first time that the surgical instrument 40 has been attached to the robot arm 21a during the surgery. In addition, the controller 24 stores the obtained serial number of the surgical instrument 40 in the storage 25 or the temporary storage 26. When the obtained serial number of the surgical instrument 40 is stored in the storage 25 or the temporary storage 26, the controller 24 determines that this is not the first time that the surgical instrument 40 has been attached to the robot arm 21a during the surgery (that is, this is the second or subsequent time). When the controller 24 determines that it is not the first time that the surgical instrument 40 is attached to the robot arm 21a during the surgery, the controller 24 does not start calibration and corrects θ0 using the correction value (Δθ) at the time of the initial attachment.
Further, in the embodiment, the controller 24 corrects the value θ0 based on the value θ2, the value θ1, and the value θa corresponding to the rotation angle of the motor 212a that is determined in advance according to the number of times the surgical instrument 40 is used. This allows the value θ0 to be corrected not only based on the values θ2 and θ1 but also on the tightening angle θa that is determined in advance according to the number of times the surgical instrument 40 is used, thereby more reliably suppressing the decrease in the gripping force of the jaw members 43a and 43b caused by the elongation of the cables A1 and A2. The value θa is a fixed value determined according to the number of times the surgical instrument 40 is used, and is obtained in advance by experiment or the like. The value θa is an example of a fourth value.
(Control Process when Attaching Surgical Instrument)
Next, with reference to
As illustrated in
Then, in step S103, it is determined whether or not the surgical instrument 40 is attached to the robot arm 21a for the first time during surgery. When it is determined that the attachment of the surgical instrument 40 to the robot arm 21a is the first time during the surgery, the process proceeds to step S104. Then, in step S104, a calibration mode in which calibration is performed is started. When the process of step S104 is completed, the process proceeds to step S106. The calibration mode process will be described in detail later.
To the contrary, when it is determined in step S103 that the attachment of the surgical instrument 40 to the robot arm 21a is not the first time during the surgery, the process proceeds to step S105. Then, in step S105, a correction of the tightening angle is executed. That is, in step S105, in the calibration mode at the first time attachment, which will be described later, the tightening angle is corrected in accordance with the formula: θ0c=θ0+θa+Δθ (where θ0c is the maximum tightening angle after correction). Then, the process proceeds to step S106.
In step S106, a gripping force check mode is started. In the gripping force check mode, it is determined whether or not the predetermined gripping force can be output as the gripping force by the jaw members 43a and 43b. Then, when it is determined that the predetermined gripping force can be output as the gripping force by the jaw members 43a and 43b, the control process is terminated.
Next, a control process of the calibration mode will be described with reference to a flowchart illustrated in
As illustrated in
Then, in step S202, the rotation angle of the motor 212a when the current value reaches the predetermined value I1 is obtained. At this time, the current value of the motor 212a is obtained taking into consideration the friction and inertia of the motor 212a. Further, the rotation angle of the motor 212a that is detected by the position detector 212c when the current value reaches the predetermined value I1 is converted into the tightening angle of the jaw members 43a and 43b by the above described formula (1), thereby obtaining the tightening angle value θ2.
Then, in step S203 for the first time, it is determined, based on the threshold value θS1, whether or not the value θ2 is within the predetermined range with respect to the value θ1. Specifically, it is determined whether the value θ2 is within the range of θ1−θS1≤θ2−Δθ≤θ1+θS1 (where Δθ=0). When it is determined that the value θ2 is within the predetermined range with respect to the value θ1, it means that it is determined that the elongation of the cables A1 and A2 is small and no correction is necessary, so that no correction is performed and the control process is terminated. In this case, θ0 stored in advance in the storage 45 is used as the maximum tightening angle.
Further, when it is determined in step S203 for the first time that the value θ2 is not within the predetermined range with respect to the value θ1, it means that it is determined that the elongation of the cables A1 and A2 is large and the correction is necessary, and the process proceeds to step S204.
Then, in step S204, the difference Δθ between the value θ2 and the value θ1 is obtained as the correction value.
Then, in step S205, it is determined based on the threshold value θS2 whether or not the difference Δθ is within the normal range. Specifically, it is determined whether the difference Δθ is within the range of θS2<Δθ<0. When it is determined that the difference Δθ is within the normal range, the process proceeds to step S207.
Then, in step S207, the tightening angle correction is performed to correct the value θ0 based on the values θ1 and θ2. Specifically, the value θ0 is corrected by adding the difference Δθ between the value θ1 and the value θ2 to the value θ0. More specifically, the maximum tightening angle is corrected as expressed by the formula: θ0c=θ0+θa+Δθ (where θ0c is the corrected maximum tightening angle).
Then, in step S208, a re-tightening operation is performed that closes the jaw members 43a and 43b again. In the re-tightening operation, the jaw members 43a and 43b are driven to close up to the corrected maximum tightening angle θ0c. Then, the process proceeds to step S202. Then, in step S202, the tightening angle θ2 at which the current value becomes the predetermined value I1 is obtained again.
Then, in step S203 for the second time after step S208, it is determined whether θ2−Δθ (where Δθ=θ2−θ1) is within the range of θ1−θS1≤θ2−Δθ≤θ1+θS1. Here, (θ2−Δθ) is (θ2−θ2+θ1), which is θ1. Therefore, in step S203, it is determined that θ2−Δθ is within the range of θ1−θS1≤θ2−Δθ≤θ1+θS1, and the control process is terminated with the correction being performed.
When it is determined in step S205 that the difference Δθ is not within the normal range, the process proceeds to step S209.
Then, in step S209, it is determined whether the difference Δθ is determined to be outside the normal range for two consecutive times. When it is not determined that the difference Δθ is determined to be outside the normal range for two consecutive times, the process proceeds to step S201. Then, the processes of step S201 to step S205 are repeated. To the contrary, when it is determined that the difference Δθ is determined to be outside the normal range for two consecutive times, the process proceeds to step S210. Then, in step S210, an error message is displayed and the control process is terminated.
It should be understood that one or more embodiments described above are illustrated by way of example in every respect and do not limit the disclosure. The scope of the invention is indicated by claims, not by the explanation of the one or more embodiments described above, and includes equivalents to the claims and all alterations (modifications) within the same.
For example, in the embodiment described above, the case has been described in which the values corresponding to the rotation angles of the motor (θ1, θ2, θ0, etc.) are values that represent the tightening angles between the jaw members, but the invention is not limited to this. In the invention, the value corresponding to the rotation angle of the motor may represent a value other than the tightening angle between the jaw members. For example, the value corresponding to the rotation angle of the motor may be the rotation angle of the motor.
Further, in the embodiment described above, the case has been described in which the third value (θ0) is a value that corresponds to the maximum rotation angle of the motor in the closing direction of the jaw members, but the invention is not limited to this. In the invention, the third value may be a value having an absolute value greater than the value θ1 and corresponding to a rotation angle other than the maximum rotation angle of the motor in the closing direction of the jaw members.
In the embodiment described above, the case has been described in which it is determined whether or not the difference (Δθ) between the second value (θ2) and the first value (θ1) is within the normal range, but the invention is not limited to this. In the invention, it is not necessary to determine whether the difference between the second value and the first value is within the normal range.
In the embodiment described above, the case has been described in which it is determined whether the second value (θ2) is within the predetermined range with respective to the first value (θ1), but the invention is not limited to this. In the invention, it is not necessary to determine whether the second value is within the predetermined range with respective to the first value.
In the embodiment described above, the case has been described in which the first storage (45) that stores the first value (θ1) and the third value (θ0) is provided in the surgical instrument, and the second storage (26) that stores the correction value (Δθ) based on the first value and the second value (θ2) is provided in the robot body, but the invention is not limited to this. In the invention, the first storage may be provided in the robot body, and the second storage may be provided in the surgical instrument. Further, the second storage does not have to be a temporary storage.
In the embodiment described above, the case has been described in which it is determined whether or not the attachment of the surgical instrument to the robot arm is the first time during the surgery, but the invention is not limited to this. In the invention, the calibration may be started every time the surgical instrument is attached to the robot arm.
Further, in the embodiment described above, the case has been described in which the third value (θ0) is corrected based on the second value (θ2), the first value (θ1), and the fourth value (θa), but the invention is not limited to this. In the invention, the fourth value (θa) may not be used to correct the third value (θ0).
Further, in the embodiment described above, the case has been described in which the decrease in the gripping force of the jaw members caused by the elongation of the cables is suppressed in the configuration in which the drive of the jaw members of the surgical instrument is controlled according to the rotation angle of the motor. However, the invention is not limited to this. In the invention, a rod may be used as an elongate element, and a gear, a pulley, or a bearing may be used as a driven member, and the decrease in the gripping force of the jaw members caused by wear, seizure, galling, chipping, rust, etc., of the gear, pulley, bearing, and rod of the surgical instrument may be corrected.
Further, in the invention, the decrease in the gripping force due to wear of the jaw members may be corrected.
The functions of each of the elements disclosed herein may be carried out by a circuitry or a processing circuitry including a general purpose processor, a dedicated processor, an integrated circuit, an ASIC (application specific integrated circuit), a conventional circuit, or a combination of two or more of them, that is configured or programmed to perform the functions. A processor is considered as a processing circuitry or a circuitry because it contains transistors and other circuit elements. In the disclosure, a circuit, a unit, or a means may be either a hardware that is configured to perform the recited function(s) or a hardware that is programmed to perform the recited function(s). The hardware may be the hardware disclosed herein, or may be other known hardware that is programmed or configured to perform the recited function(s). If the hardware is a processor which is considered as a type of a circuit, a circuit, a means, or a unit is a combination of hardware and software, and the software is used to configure the hardware and/or the processor.
Further, in the embodiment described above, the case has been described in which the third value (θ0) as the command angle is corrected based on the second value (θ2) and the first value (θ1). However, a modified example illustrated in
| Number | Date | Country | Kind |
|---|---|---|---|
| 2022-030319 | Feb 2022 | JP | national |
This application is a continuation of International Application No. PCT/JP2023/004320, which is based upon and claims the benefit of priority from the prior Japanese Patent Application No. 2022-030319, filed on Feb. 28, 2022, the entire contents of all of which are incorporated herein by reference.
| Number | Date | Country | |
|---|---|---|---|
| Parent | PCT/JP2023/004320 | Feb 2023 | WO |
| Child | 18783977 | US |
