WO2023162066A1 - エンドルミナルデバイスシステム、制御装置および制御方法 - Google Patents

エンドルミナルデバイスシステム、制御装置および制御方法 Download PDF

Info

Publication number
WO2023162066A1
WO2023162066A1 PCT/JP2022/007493 JP2022007493W WO2023162066A1 WO 2023162066 A1 WO2023162066 A1 WO 2023162066A1 JP 2022007493 W JP2022007493 W JP 2022007493W WO 2023162066 A1 WO2023162066 A1 WO 2023162066A1
Authority
WO
WIPO (PCT)
Prior art keywords
wire
endluminal
tension
wires
relaxation
Prior art date
Application number
PCT/JP2022/007493
Other languages
English (en)
French (fr)
Inventor
紀明 山中
Original Assignee
オリンパスメディカルシステムズ株式会社
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by オリンパスメディカルシステムズ株式会社 filed Critical オリンパスメディカルシステムズ株式会社
Priority to PCT/JP2022/007493 priority Critical patent/WO2023162066A1/ja
Priority to US18/219,318 priority patent/US20240099553A1/en
Publication of WO2023162066A1 publication Critical patent/WO2023162066A1/ja

Links

Images

Classifications

    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B1/00Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor
    • A61B1/00002Operational features of endoscopes
    • A61B1/00004Operational features of endoscopes characterised by electronic signal processing
    • A61B1/00006Operational features of endoscopes characterised by electronic signal processing of control signals
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B1/00Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor
    • A61B1/005Flexible endoscopes
    • A61B1/0051Flexible endoscopes with controlled bending of insertion part
    • A61B1/0052Constructional details of control elements, e.g. handles
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B1/00Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor
    • A61B1/005Flexible endoscopes
    • A61B1/0051Flexible endoscopes with controlled bending of insertion part
    • A61B1/0057Constructional details of force transmission elements, e.g. control wires
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B1/00Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor
    • A61B1/005Flexible endoscopes
    • A61B1/009Flexible endoscopes with bending or curvature detection of the insertion part
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B2560/00Constructional details of operational features of apparatus; Accessories for medical measuring apparatus
    • A61B2560/02Operational features
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B2560/00Constructional details of operational features of apparatus; Accessories for medical measuring apparatus
    • A61B2560/04Constructional details of apparatus
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B2562/00Details of sensors; Constructional details of sensor housings or probes; Accessories for sensors
    • A61B2562/02Details of sensors specially adapted for in-vivo measurements

Definitions

  • the present invention relates to an endluminal device system, control device and control method.
  • the endluminal device has an elongated flexible section, a movable section connected to the distal end of the flexible section, and a power transmission member such as a wire for driving the movable section.
  • a power transmission member such as a wire for driving the movable section.
  • Patent Documents 1 and 2 a sensor is used to detect the shape of the flexible portion, and the movable portion is controlled based on the detected shape.
  • a magnetic sensor (UPD) placed outside the endluminal device is used, and in US Pat.
  • the movable part is previously operated in a plurality of operation patterns in various shape patterns of the flexible part, and the control parameters are set in association with the tension information of the power transmission member at that time.
  • the tension information is a time integral value of tension, a rate of change, or a predetermined threshold. Then, tension information is acquired in an intraoperative calibration operation, and control parameters based on the acquired tension information are acquired.
  • JP 2015-154814 A Japanese Patent No. 6701232 Japanese Patent No. 6278747
  • Patent Document 1 it is necessary to add a device including UPD, and the whole system becomes large-scale.
  • UPD can detect the shape of the flexible part only within the sensing area, there is a limit to the length of the flexible part that can be applied.
  • the shape of the entire flexible part cannot be detected, and as a result, it is difficult to accurately control the movable part.
  • Patent Document 2 an operation of inserting and removing the shape sensor into and out of the flexible portion is required, and the size of the system is increased by the stroke of the shape sensor. In addition, it takes time to acquire shape data.
  • the shape of the flexible portion corresponding to the tension information and control parameters such as the time integral value, rate of change or predetermined threshold value is not unique. Therefore, if the shape of the flexible part during surgery differs from the preset shape pattern, there is a possibility that appropriate control parameters cannot be obtained based on the tension information. In particular, when the flexibility of the shape of the flexible section is high, such as when the external portion of the flexible section placed outside the body is long, it is difficult to determine appropriate control parameters based on the tension information as described above.
  • the present invention has been made in view of the circumstances described above, and provides an endluminal device system, control device, and control method that can set appropriate control parameters according to the shape of the flexible portion with a simple configuration. intended to
  • One aspect of the present invention is an elongate flexible endluminal device, a first wire disposed longitudinally within the endluminal device, and detecting tension in the first wire.
  • a first sensor a driving device capable of pulling the first wire
  • at least one processor causes the driving device to relax the first wire being pulled. to obtain the tension of the first wire during the relaxing motion detected by the first sensor, and adjust a control parameter of the endluminal device based on the tension during the relaxing motion. device system.
  • Another aspect of the present invention is a control apparatus for an endluminal device system, the endluminal device system comprising an elongate flexible endluminal device and a length of the endluminal device within the endluminal device.
  • a first wire arranged in a direction; a first sensor for detecting the tension of the first wire; and a driving device capable of pulling the first wire;
  • a processor causes the driving device to perform a relaxing operation to relax the first wire being pulled, obtains the tension of the first wire during the relaxing operation detected by the first sensor, and performs the relaxing operation.
  • a controller that adjusts a control parameter of the endluminal device based on the tension therein.
  • Another aspect of the present invention is a method of controlling an endoluminal device, wherein a first wire is disposed in the endoluminal device longitudinally of the endoluminal device to relax the first wire being pulled.
  • a control method comprising performing a relaxation movement, obtaining the tension of the first wire during the relaxation movement, and adjusting a control parameter of the endluminal device based on the tension during the relaxation movement.
  • FIG. 1 is an external view showing the overall configuration of an endluminal device system according to a first embodiment
  • FIG. 1 is a schematic configuration diagram of an endluminal device system according to a first embodiment
  • FIG. 4 is a flow chart of a control method according to the first embodiment
  • FIG. 4 is a diagram showing the shape of a wire with loops formed at the tip (upper), central (middle), and base (lower).
  • FIG. 5 is a graph showing changes in tension over time during the relaxation motion at the proximal and distal ends of the wires of each shape of FIG. 4
  • FIG. FIG. 4 is a diagram showing an example of tension distribution from the proximal end to the distal end of the wire;
  • FIG. 10 is a diagram showing another example of tension distribution from the proximal end to the distal end of the wire; It is a figure which shows an example of the shape of a wire.
  • FIG. 11 is another schematic configuration diagram of the endluminal device system according to the second embodiment; 15 is a schematic configuration diagram of another modification of the endluminal device system of FIG. 14; FIG. 4 is a graph showing an example of spring characteristics of a measurement wire; FIG. 11 is a schematic configuration diagram of an endluminal device system according to a third embodiment; FIG. 4 is a schematic configuration diagram of an endluminal device system according to another embodiment;
  • FIG. 1 shows an external view of one configuration example of an endluminal device system 100 according to this embodiment.
  • the control device 5 controls the driving device 2 based on the operation input to the operating device 6 , thereby electrically driving the movable portion 11 of the endluminal device 1 .
  • the endoluminal device 1 is a long and flexible device that is inserted into a body cavity through an opening such as the mouth or anus for observation or treatment within the body cavity, and is, for example, an endoscope or a manipulator.
  • FIG. 1 shows, by way of example, a system 100 in which the endoluminal device 1 is an endoscope.
  • Reference numeral 7 denotes an image processor for processing endoscopic images acquired by the endoscope 1
  • reference numeral 8 denotes a display device for displaying endoscopic images.
  • the flexible portion 13 of the electrically driven endluminal device 1 includes, in addition to the elongated body portion 13a to be inserted into the body, a length that connects the proximal end of the body portion 13a and the driving device 2, which is placed outside the body. It has a shaku extracorporeal portion 13b.
  • the soft portion 13 having such flexibility can take various curved shapes. In particular, since the shape of the extracorporeal portion 13b is determined by the arrangement of the driving device 2 and the operating table 9, the width of the shape change is large.
  • the power transmission characteristics of the wire 12 in the endluminal device 1 may change according to the shape of the flexible portion 13, and accordingly the responsiveness of the movable portion 11 to the operation input to the operating device 6 may also change.
  • the endluminal device system 100 has a function of controlling the endluminal device 1 so that the responsiveness of the movable portion 11 is constant by controlling the driving device 2 according to the shape of the flexible portion 13 . have.
  • FIG. 2 shows a schematic configuration of an endluminal device.
  • the endluminal device system 100 includes an endluminal device 1 having a movable portion 11, one or more flexible wires (first wires) 12 provided in the endluminal device 1, A driving device 2 that drives the movable part 11 by pulling and relaxing the wires 12, one or more tension sensors (first sensors) 3 that detect the tension of each wire 12, and 1 that detects the displacement of each wire 12.
  • the displacement sensor (second sensor) 4 described above and the control device 5 that controls the driving device 2 are provided.
  • the endluminal device 1 has an elongated and flexible soft portion 13 .
  • a proximal end of the flexible portion 13 is connected to the driving device 2 .
  • the movable portion 11 is connected to the tip of the flexible portion 13 .
  • the movable portion 11 is a bending portion that can bend in a direction intersecting the longitudinal direction of the flexible portion 13 .
  • the wire 12 has the function of transmitting the power given by the driving device 2 from the proximal end to the distal end to operate the movable part 11 and the function of acquiring the shape information of the flexible part 13 .
  • the wire having the function of transmitting the power given from the driving device 2 from the proximal end to the distal end to operate the movable portion 11 is called the driving wire
  • the wire having the function of acquiring the shape information of the flexible portion 13 is called the measuring wire.
  • four wires 12 are provided for bending the bending portion 11 upward, downward, left, and right, respectively. In this embodiment, each of these four wires 12 has both a function as a drive wire and a function as a measurement wire.
  • the wire 12 is arranged inside the flexible section 13 along the longitudinal direction of the flexible section 13 , the distal end of the wire 12 is fixed to the distal end of the bending section 11 , and the proximal end of the wire 12 is connected to the driving device 2 .
  • the driving device 2 has one or more actuators 2 a that drive the wire 12 by retracting and advancing the proximal end of the wire 12 in the longitudinal direction of the wire 12 .
  • the actuator 2a pulls the wire 12 by retracting the proximal end of the wire 12, and relaxes the wire 12 by advancing the proximal end of the wire 12. As shown in FIG.
  • the driving device 2 bends the bending portion 11 by operating the actuator 2a according to a control signal (described later) from the control device 5 .
  • the tension sensor 3 is provided at the proximal end of the wire 12 and detects tension at the proximal end of the wire 12 .
  • the displacement sensor 4 detects displacement of the proximal end of the wire 12 in the longitudinal direction of the wire 12 .
  • the displacement sensor 4 is an angle sensor that is provided in the actuator 2a and detects the rotation angle of the motor of the actuator 2a as the displacement of the wire 12.
  • FIG. The position of the proximal end of the wire 12 when the tension of the wire 12 is zero is the origin. position. Thus, displacement increases with wire 12 traction and decreases with wire 12 relaxation.
  • the control device 5 comprises at least one processor 5a, such as a central processing unit, and a storage unit 5b.
  • the processor 5 a receives an operation signal based on the input operation from the operation device 6 , generates a control signal based on the operation signal, and transmits the control signal to the driving device 2 .
  • the processor 5 a thereby controls the drive 2 and thereby the bending portion 11 of the endluminal device 1 .
  • the storage unit 5b includes a memory such as RAM and a non-volatile recording medium such as ROM or HDD.
  • the recording medium is a computer-readable non-transitory recording medium.
  • the recording medium stores a control program for causing the processor 5a to execute a control method for controlling the endluminal device 1 according to the shape of the flexible portion 13.
  • the control method consists of a step S1 of receiving a trigger, a step S2 of executing a relaxing action to relax the wire 12 being pulled, and step S3 of obtaining the tension and displacement of 12, step S4 of adjusting the control parameters of the endluminal device 1 based on the tension and displacement during the relaxation movement, and step S5 of restoring the wire 12 to its initial state.
  • the trigger is input to the control device 5 by the operator using, for example, an input device (not shown).
  • the operator can input a trigger to the control device 5 at any desired timing when he/she wants to adjust the control parameters. For example, after inserting the flexible portion 13 into the body cavity, the operator inputs a trigger just before performing a treatment or other work that requires precise movements of the bending portion 11 .
  • Processor 5a executes steps S2 to S5 in response to accepting the input trigger (YES in step S1).
  • the wire 12 and the bend 11 are placed in a predetermined initial state.
  • the initial state is, for example, a state in which a predetermined initial tension is applied to all wires 12 and the bending portion 11 is arranged in a straight line.
  • the processor 5a causes the driving device 2 to perform a pulling operation to pull the wire 12, and then causes the driving device 2 to perform a relaxing operation to loosen the wire 12 being pulled.
  • the wire 12 that is pulled and relaxed is any one wire 12 .
  • the processor 5a causes, for example, the driving device 2 to pull the wire 12 by a predetermined amount so that the wire 12 is applied with a predetermined target tension.
  • the predetermined target tension is within a range that does not hinder the bending of the flexible portion 13 along the shape of the body cavity. It is in a state of
  • the displacement of the proximal end of the wire 12 decreases over time, and the tension of the proximal end of the wire 12 decreases over time (see, for example, FIG. 5).
  • the changing tension and displacement of the wire 12 are continuously detected by the sensors 3, 4, for example at predetermined sampling intervals.
  • the area where the tension is reduced spreads from the proximal end of the wire 12 to the distal side. That is, during the relaxation motion, a change in tension (a decrease in tension) is transmitted sequentially from the proximal end of wire 12 to the distal end.
  • the processor 5a causes the drive 2 to perform a relaxation operation at least until a change in tension is transmitted to the tip of the wire 12.
  • the processor 5a sequentially obtains the current tension or displacement from the sensors 3, 4 during the relaxation operation, and based on the current tension or displacement determines that the overall relaxation of the wire 12 is complete, and that the relaxation is complete. Relaxation may be terminated at times. Relaxation is determined to be complete when the current tension is less than or equal to a predetermined value or when the current displacement is less than or equal to a predetermined value. When the tension change reaches the tip of the wire 12, there may appear a change point where the tension change rate changes. The processor 5a may terminate the relaxation movement when a tension change point is detected.
  • step S3 the processor 5a stores the tension and displacement detected by the sensors 3 and 4 during the relaxation motion in time series in the storage unit 5b. Thereby, the processor 5a obtains data of each of tension and displacement during the relaxation operation.
  • FIG. 5 shows the wire 12 during relaxation in three shapes of patterns 1, 2, 3 of flexible sections 13 with loops formed at the distal, central and proximal ends, respectively, as shown in FIG. Figure 2 shows temporal changes in tension at the distal and proximal ends of the .
  • the change in tension during periods I, II, and III until the change in tension reaches the tip of wire 12 differs depending on the shape of flexible portion 13 . That is, the change in tension during the relaxation action contains shape information of the flexible portion 13 .
  • step S4 the processor 5a uses the tension and displacement data obtained in step S3 to calculate the rate of change in tension with respect to displacement during the relaxation motion, and adjusts the control parameters based on the rate of change.
  • the rate of change in tension is the rate of change in tension at each displacement from the maximum tension at the start of relaxation.
  • the control parameters are the amount of pulling and loosening of the wire 12 for transmitting the tension change to the tip of the wire 12 . More specifically, the control parameter is the amount of displacement of the proximal end of the wire 12 during periods I, II, and III shown in FIG. In other words, as shown in FIG. 6A, the control parameter is the amount of displacement of the proximal end of the wire 12 corresponding to the tension change ⁇ T at the proximal end required for the tension change to be transmitted to the distal end of the wire 12. be.
  • the change in tension at displacement ⁇ x1 contains the shape information of portion P1.
  • the change in tension at displacement ⁇ x2 contains shape information for portions P1 and P2. Therefore, the shape of the portion Pi can be estimated from the rate of change Ti/Tp of the tension with respect to the displacement xi in order from the proximal end of the wire 12, and the shape of the entire flexible portion 13 can be estimated based on the rate of change Ti/Tp. can determine the control parameters according to
  • the processor 5a continues to progressively reduce the tension at the proximal end by continuing to advance the proximal end of the wire 12 during the relaxation motion until a change in tension is transmitted to the distal end. For example, if the relaxation of the wire 12 is terminated before the change in tension reaches the distal end and the wire 12 is pulled again, the tension of the wire 12 does not monotonically decrease from the proximal end to the distal end, as shown in FIG. 6B. In this case, extract the relationship between displacement and tension when the maximum displacement is updated.
  • step S5 the processor 5a causes the drive device 2 to perform an initializing operation for returning the tension of the wire 12 to the initial tension.
  • the wire 12 and the bending portion 11 return to their initial states.
  • the processor 5a generates a control signal based on the operation signal from the operating device 6 and the control parameters adjusted in step S4, and transmits the control signal to the driving device 2. Thereby, regardless of the shape of the flexible portion 13, the bending portion 11 can be controlled with good responsiveness.
  • the change in the tension of the wire 12 during the relaxation operation differs depending on the curved shape of the flexible portion 13, and the shape of the flexible portion 13 corresponding to the change in the tension of the wire 12 is Unique. Therefore, it is possible to set appropriate control parameters according to the shape of the flexible portion 13 based on changes in the tension of the wire 12 . Also, with a simple configuration using the wires 12 and the sensors 3 and 4, acquisition of necessary data and setting of control parameters can be performed.
  • the wire 12 has a function as a drive wire and a function as a measurement wire.
  • the wire 12 has a function as a drive wire and a function as a measurement wire.
  • the optimum control parameters corresponding to the shape of the flexible portion 13 at that time can be reliably set. and the bending portion 11 can be accurately moved according to the operation input to the operation device 6 .
  • the processor 5a may cause the drive device 2 to perform pulling and relaxing operations without movement of the bending section 11 by selecting wires 12 to pull and relax. Specifically, as shown in FIG. 9, the processor 5a pulls the bending portion 11 of the plurality of wires 12 for bending before executing the pulling operation and the relaxing operation in step S2.
  • the wire 12 being driven is recognized based on the operation signal from the operation device 6 (step S6).
  • the wire 12 being driven may be recognized, for example, based on a control signal sent from the control device 5 to the drive device 2 or the tension detected by the tension sensor 3 .
  • step S2 of the first example of the control method in FIG. 9 the processor 5a selects the wire 12 being driven and another wire 12 opposing the wire 12 being driven.
  • the opposed wire 12 is a wire 12 for bending the bending portion 11 in the direction opposite to the bending direction of the bending portion 11 by the wire 12 being driven.
  • the driving wire 12 is an upward bending wire
  • the opposing wire 12 is a downward bending wire.
  • the processor 5a then controls the drive device 2 to simultaneously pull and relax the two selected wires 12 in a pulling and relaxing operation.
  • the relaxation operation at this time is performed until the tension of the wire 12 being driven returns to the tension before the pulling operation.
  • the processor 5a acquires tension and displacement data of at least one of the two wires 12 during the relaxation operation, and adjusts the control parameters based on the acquired data. According to this configuration, the bending direction and bending angle of the bending portion 11 are kept constant because the moment applied to the bending portion 11 is balanced during the pulling operation and the relaxing operation. Therefore, tension and displacement data can be obtained without causing the bending portion 11 to move.
  • the processor 5a selects any one wire 12 other than the wire 12 being driven, that is, selects one of the wires 12 that are not being driven. For example, one of the wires 12 other than the wire 12 being driven and the wire 12 opposing it is selected. Specifically, if the wire 12 being driven is for an upward or downward bend, the wire 12 for left or right bend is selected. If the wire 12 being driven is for a leftward or rightward bend, the wire 12 for an upward or downward bend is selected. The processor 5a then controls the drive device 2 to pull and relax the selected one wire 12 in a pulling and relaxing operation. This configuration also allows tension and displacement data to be obtained without causing movement of the bending portion 11 during traction and relaxation.
  • the movable portion 11 is a curved portion, but the movable portion 11 is not limited to this, and may have other forms.
  • the movable part 11 may be a joint, or may be an end effector having functions such as grasping.
  • FIG. 10 shows an endluminal device 1 with an end effector as movable part 11 .
  • the end effector 11 has a pair of jaws that open and close with each other, and the wire 12 is driven to open and close the pair of jaws.
  • the processor 5a executes the control method in response to a trigger input by the operator, but instead of this, the control method may be executed automatically.
  • the processor 5a may repeatedly perform steps S2 to S5 at predetermined time intervals.
  • the acquisition of data and the adjustment of control parameters are repeatedly and automatically performed without requiring the input of a trigger by the operator.
  • the shape of the flexible section 13 continues to change. In such a scene, by sequentially updating the control parameters in accordance with the change in the shape of the flexible portion 13, it is possible to maintain good responsiveness of the movable portion 11.
  • the processor 5a may estimate the shape of the flexible portion 13 based on tension and displacement data (step S7).
  • the processor 5a may adjust the control parameter based on the rate of change of the tension as described above, or may adjust the control parameter based on the shape of the flexible portion 13.
  • FIG. 12 explains a method of estimating the shape of the flexible portion 13 from the tension and displacement of the wire 12, and shows the tension distribution from the proximal end to the distal end of the wire 12.
  • shape information such as bending radius, bending angle and length along the main axis of the flexible portion 13 can be calculated.
  • Element 1 includes the proximal end of wire 12 and element n includes the distal end of wire 12 .
  • the tension in wire 12 decreases exponentially from proximal to distal due to the effect of friction acting on wire 12 .
  • tension change decrease in tension is transmitted sequentially from the proximal end to the distal end.
  • the proximal tension drops from the initial maximum tension Tp to tension Tr_(i-1) and the tension change is transmitted to element i-1. That is, in the motion area [1:i ⁇ 1], the tension decreases and the elongation of elements 1, 2, . . . , i ⁇ 1 within the motion area [1:i ⁇ 1] changes (decreases).
  • the proximal tension drops from the maximum tension Tp to tension Tr_i and a tension change is transmitted to element i.
  • FIG. 13 shows the procedure for calculating the shape of the wire 12 (that is, the shape of the flexible portion 13).
  • steps S12 to S16 while incrementing i (steps S11 and S17), the bending angle ⁇ i, length Li and bending radius Ri of element i are calculated in order from the base end. do.
  • the calculated bending angle ⁇ i, length Li and bending radius Ri are stored in the storage unit 5b and used to calculate the bending angle ⁇ i+1, length Li+1 and bending radius Ri+1 of the next element i+1.
  • Steps S12 to S16 are repeated until the sum of the lengths Li reaches the total length of the wire 12, thereby obtaining the shapes ⁇ i, Li, Ri of all elements i.
  • step S12 the proximal tension of wire 12 is reduced from Tr_(i ⁇ 1) to Tr_i by decreasing the proximal displacement of wire 12 by dxi, and wire 12 relaxes to element i, i. Advance to i.
  • step S13 the tension Ti of the element i is calculated.
  • the maximum tension Tp at the proximal end is expressed by the following equation (1) using the tension Ti of each element i according to Euler's belt equation.
  • is the coefficient of friction and ⁇ i is the angle of curvature of element i.
  • the tension Ti of the element i can be calculated from the following equation (2) using the tension Tr_i of the proximal end of the wire 12 detected by the tension sensor 3.
  • the rate of change in tension is calculated as the ratio of the tension Tr_i acquired by the tension sensor 3 at each displacement xi to the initial maximum tension Tp.
  • step S14 the bending angle ⁇ i of the element i is calculated.
  • the bending angle ⁇ i is obtained from the following equation (3).
  • step S15 the change amount dlk of the elongation of each element k within the range of motion area [1, i ⁇ 1] is calculated.
  • the amount of change dlk in elongation of the element k can be calculated from Hooke's law using the tension difference dTk between when the element k is pulled and when it is relaxed, as shown in the following equation (4).
  • EA is the stiffness of the wire 12;
  • dlk Lk/EA x dTk (4)
  • dl(i-1) is obtained from step S15.
  • step S16 the length Li and curvature radius Ri of element i are calculated.
  • the driving displacement dxi of the wire 12 is the sum of the amounts of change in elongation dl1, dl2, . Therefore, as shown in the following formula (5), the change amount dli of the element i is the difference between the displacement dxi and the sum of the change amounts dl1, dl2, . calculated as
  • a plurality of tension data may be weighted. Multiple data are obtained by performing multiple pulling and relaxing motions on a single wire 12, or by performing pulling and relaxing motions on multiple wires 12. is obtained.
  • the highly reliable data is, for example, data acquired using a wire 12 with a highly linear spring constant, data with a large tension, or data with a slow driving speed of the wire 12 in the relaxation operation.
  • the greater the tension the greater the amount of change in tension in the relaxation motion, so the reliability of the data increases.
  • the slower the driving speed the higher the data density, and the higher the reliability of the data.
  • an endluminal device system 200 differs from the first embodiment in that a measurement wire 14 separate from the drive wire 17 is provided.
  • a measurement wire 14 separate from the drive wire 17 is provided.
  • configurations different from those of the first embodiment will be described, and configurations common to those of the first embodiment will be denoted by the same reference numerals, and description thereof will be omitted.
  • the endluminal device system 200 includes an endluminal device 10 having a movable portion 11 and one or more drive wires (second wires) 17, measurement wires (first wires) 14 provided in the endluminal device 10, and a drive device. 2 , a tension sensor (first sensor) 3 that detects tension of the wires 14 and 17 , a displacement sensor (second sensor) 4 that detects displacement of the measurement wire 14 , and a control device 5 .
  • the movable portion 11 is a curved portion. As shown in FIG. 16, the movable part 11 may be an end effector or a joint.
  • the flexible drive wire 17 has the same configuration as the wire 12 of the first embodiment, but functions differently. That is, the drive wire 17 of the present embodiment is arranged in the flexible portion 13 along the longitudinal direction of the flexible portion 13, the distal end of the driving wire 17 is fixed to the distal end of the bending portion 11, and the proximal end of the driving wire 17 is It is connected to the drive device 2 .
  • the drive wire 17 of this embodiment has the function of transmitting the power given from the drive device 2 from the proximal end to the distal end to operate the movable part 11, and the flexible part 13 It does not have a function to acquire the shape information of
  • four wires 17 are provided for bending the bending portion 11 upward, downward, left, and right, respectively.
  • these four wires 17 are configured to be capable of functioning as driving wires, but do not function as measuring wires.
  • a flexible measurement wire 14 is arranged in the flexible section 13 in the longitudinal direction of the flexible section 13, and the tip of the measurement wire 14 is not connected to the movable section 11 but is fixed to the tip of the flexible section 13 for measurement.
  • a proximal end of the wire 14 is connected to the driving device 2 .
  • the measurement wire 14 has the function of acquiring the shape information of the flexible portion 13 , but does not have the function of transmitting the power given from the driving device 2 from the proximal end to the distal end to operate the movable portion 11 .
  • the driving device 2 has an actuator 2a that retracts and advances the proximal ends of the wires 14, 17 in the longitudinal direction of the wires 14, 17, respectively.
  • the tension sensor 3 is provided at the proximal ends of the wires 14 and 17 and detects the tension at the proximal ends of the wires 14 and 17 .
  • the displacement sensor 4 detects displacement of the proximal end portion of the measurement wire 14 in the longitudinal direction of the measurement wire 14 .
  • an endluminal device system 200 comprises a tubular first sheath 15 with a measurement wire 14 inserted therein and a tubular second sheath 16 with a drive wire 17 inserted therein.
  • Each wire 14,17 is longitudinally movable within the sheath 15,16.
  • the coefficient of friction between measurement wire 14 and first sheath 15 is greater than the coefficient of friction between drive wire 17 and second sheath 16 .
  • Other means of differentiating the friction coefficients of the wires 14, 17 paths may include lubricants, stranded/solid wires or surface treatments. That is, the type of lubricant applied to the wires 14 and 17 may be selected such that the coefficient of friction of the route of the measurement wire 14 is greater than the coefficient of friction of the route of the drive wire 17 .
  • a single wire may be used as the drive wire 17 and a stranded wire may be used as the measurement wire 14 .
  • the outer surface of the measurement wire 14 may be subjected to a surface treatment that increases the coefficient of friction, such as a surface roughening treatment that forms an uneven structure.
  • the processor 5a pulls and relaxes the measuring wire 14 in the pulling motion and the relaxing motion (step S2), and acquires tension and displacement data of the measuring wire 14 during the relaxing motion (step S3 ), and adjust the control parameters for the drive wire 17 based on the data (step S4).
  • the measurement wire 14 separate from the drive wire 17 is used, and the friction acting on the measurement wire 14 is greater than the friction acting on the drive wire 17 .
  • the friction coefficient of the path of the measurement wire 14 is set to be greater than the friction coefficient of the path of the drive wire 17.
  • the spring constant of the measurement wire 14 may It may be smaller than the spring constant of the wire 17 .
  • the spring constant of the measurement wire 14 smaller than the spring constant of the drive wire 17, the responsiveness of the movable portion 11 can be enhanced, and the sensitivity of the displacement to the shape of the flexible portion 13 can be enhanced. It is possible to improve the estimation accuracy of the shape of and the adjustment accuracy of the control parameters.
  • the measurement wire 14 may be pulled and relaxed in the linear region of the spring characteristics of the measurement wire 14 .
  • FIG. 17 shows an example of the spring characteristics of the measurement wire 14, where the horizontal axis represents the displacement of the measurement wire 14 and the vertical axis represents the tension of the measurement wire 14.
  • the spring characteristics may include a region of linear tension variation (the region enclosed by the dashed ellipse) and a non-linear tension variation region.
  • the linear region of the measurement wire 14 by using the linear region of the measurement wire 14, calculations for calculating the shape of the flexible portion 13 and adjusting the control parameters can be simplified. Further, calculation of the shape of the flexible portion 13 and adjustment of control parameters can be performed more accurately.
  • the measurement wire 14 consisting of a single wire
  • the measurement wire 14 has a spring characteristic in which the tension changes linearly over substantially the entire range of displacement. Therefore, when using a single wire as the measurement wire 14, the measurement wire 14 may be pulled and relaxed in any linear region.
  • the endluminal device system 300 differs from the first and second embodiments in that the endluminal device 20 has a plurality of movable parts 11A and 11B.
  • the present embodiment configurations different from those in the first and second embodiments will be described, and configurations common to those in the first and second embodiments will be denoted by the same reference numerals, and description thereof will be omitted.
  • the endluminal device system 300 includes an endluminal device 20 having two movable parts 11A, 11B and two or more wires (first wires) 12A, 12B, and the movable parts 11A, 11B by pulling and relaxing the wires 12A, 12B. 11B, a tension sensor (first sensor) 3 for detecting the tension of each wire 12A and 12B, a displacement sensor (second sensor) 4 for detecting displacement of each wire 12A and 12B, and a control a device 5;
  • the movable parts 11A and 11B are, for example, bending parts, joints, and end effectors.
  • the movable part 11A is an end effector
  • the movable part 11B is a joint arranged between the end effector 11A and the tip of the flexible part 13.
  • the movable part 11A is an end effector
  • the movable part 11B is a joint arranged between the end effector 11A and the tip of the flexible part 13.
  • the wires 12A and 12B are drive wires for operating the corresponding movable parts 11A and 11B, and are also measurement wires, like the wires 12 of the first embodiment.
  • the distal ends of the wires 12A and 12B are fixed to the corresponding movable parts 11A and 11B, respectively, and the proximal ends of the wires 12A and 12B are connected to the driving device 2. As shown in FIG.
  • the driving device 2 has two or more actuators 2a for retracting and advancing the proximal end of each wire 12A, 12B in the longitudinal direction of the wires 12A, 12B.
  • the tension sensor 3 is provided at the proximal end of each wire 12A, 12B and detects the tension at the proximal end of each wire 12A, 12B.
  • the displacement sensor 4 detects displacement of the proximal ends of the wires 12A, 12B in the longitudinal direction of the wires 12A, 12B.
  • the processor 5a executes the control method and adjusts the control parameters of the movable parts 11A and 11B when operating either one of the movable parts 11A and 11B. For example, the processor 5a acquires data on the tension and displacement of the wire 12B during the loosening operation of the wire 12B accompanying the operation of the movable portion 11B, and based on the acquired data, controls parameters for both the movable portions 11A and 11B. to adjust. As described above, according to the present embodiment, when one of the movable parts 11A and 11B performs an operation necessary for work such as treatment, the control parameters for the other movable parts 11A and 11B can also be adjusted. .
  • the processor 5a may execute the control method in response to a trigger, or may repeatedly execute the control method at predetermined time intervals.
  • the processor 5a may select any one wire from the predetermined plurality of wires 12A, 12B, and pull and relax the selected wire in the pulling and relaxing operations.
  • the processor 5a may calculate the shape of the flexible portion 13 and adjust the control parameters based on a plurality of tension data. Multiple data are acquired by performing multiple pulling and relaxing motions for one measuring wire 12 or by performing pulling and relaxing motions for multiple measuring wires 12 . According to this configuration, it is possible to improve the accuracy of calculating the shape of the flexible portion 13 and adjusting the control parameters. Also in the above-described first and second embodiments, the processor 5a may calculate the shape of the flexible portion 13 and adjust the control parameters based on a plurality of tension data.
  • the endluminal devices 1, 10, 20 have movable parts 11, 11A, 11B, but as shown in FIG. It does not have to have a section.
  • the tip of the measurement wire 14 is fixed to the tip of the flexible portion 13 .
  • the processor 5a may calculate the shape of the flexible portion 13 after acquiring the tension and displacement data of the measurement wire 14, and may omit the adjustment of the control parameters.

Abstract

エンドルミナルデバイスシステム(100)は、長尺かつ可撓性のエンドルミナルデバイス(1)と、エンドルミナルデバイス(1)内にエンドルミナルデバイス(1)の長手方向に配置されるワイヤ(12)と、ワイヤ(12)の張力を検出するセンサ(3)と、ワイヤ(12)を牽引可能な駆動装置(2)と、少なくとも1つのプロセッサ(5a)と、を備える。プロセッサ(5a)は、ワイヤ(12)を弛緩させる弛緩動作を駆動装置(2)に実行させ、センサ(3)によって検出された弛緩動作中のワイヤ(12)の張力を取得し、ワイヤ(12)の張力に基づいてエンドルミナルデバイス(1)の制御パラメータを調整する。

Description

エンドルミナルデバイスシステム、制御装置および制御方法
 本発明は、エンドルミナルデバイスシステム、制御装置および制御方法に関するものである。
 従来、口または肛門等から管腔内に挿入され管腔内において観察または処置等を行う、マニピュレータまたは内視鏡のようなエンドルミナルデバイスが知られている(例えば、特許文献1から3参照。)。エンドルミナルデバイスは、長尺の軟性部と、軟性部の先端に接続された可動部と、可動部を駆動するためのワイヤのような動力伝達部材とを有する。このようなエンドルミナルデバイスにおいて、軟性部の形状に応じて動力伝達部材の動力の伝達特性が変化し、それにより可動部の動作特性が変化するという不都合がある。特許文献1から3では、この不都合を解決するための手段が提案されている。
 具体的には、特許文献1,2において、センサを使用して軟性部の形状が検出され、検出された形状に基づいて可動部が制御される。特許文献1では、エンドルミナルデバイスの外部に配置される磁気センサ(UPD)が使用され、特許文献2では、エンドルミナルデバイスの内部に挿入される形状センサが使用される。
 特許文献3において、軟性部の様々な形状パターンにおいて可動部を複数の動作パターンで事前に動作させ、そのときの動力伝達部材の張力情報と関連付けて制御パラメータが設定される。張力情報は、張力の時間積分値、変化率または予め決められた閾値である。そして、術中のキャリブレーション動作において張力情報が取得され、取得された張力情報に基づく制御パラメータが取得される。
特開2015-154814号公報 特許第6701232号公報 特許第6278747号公報
 特許文献1の場合、UPDを含む装置の追加が必要であり、システム全体が大掛かりなものになる。また、UPDは、センシングエリア内においてのみ軟性部の形状を検出することができるので、適用することができる軟性部の長さに制限がある。例えば、センシングエリアからはみ出す長い軟性部の場合、軟性部全体の形状を検出することができず、その結果、可動部を精度良く制御することが難しい。
 特許文献2の場合、形状センサを軟性部内に挿入および抜去する操作が必要となり、形状センサのストロークの分だけシステムが大きくなる。また、形状のデータの取得に時間を要する。
 特許文献3の場合、時間積分値、変化率または予め決められた閾値のような張力情報および制御パラメータに対応する軟性部の形状は、一意ではない。したがって、術中の軟性部の形状が事前に設定された形状パターンとは異なる場合、張力情報に基づいて適切な制御パラメータを得られない可能性がある。特に、体外に配置される軟性部の体外部分が長い場合等、軟性部の形状の自由度が高い場合、上記のような張力情報に基づいて適切な制御パラメータを決定することが難しい。
 本発明は、上述した事情に鑑みてなされたものであって、軟性部の形状に応じた適切な制御パラメータを簡易な構成で設定することができるエンドルミナルデバイスシステム、制御装置および制御方法を提供することを目的とする。
 本発明の一態様は、長尺かつ可撓性のエンドルミナルデバイスと、該エンドルミナルデバイス内に該エンドルミナルデバイスの長手方向に配置される第1ワイヤと、該第1ワイヤの張力を検出する第1センサと、前記第1ワイヤを牽引可能な駆動装置と、少なくとも1つのプロセッサと、を備え、該少なくとも1つのプロセッサが、牽引されている前記第1ワイヤを弛緩させる弛緩動作を前記駆動装置に実行させ、前記第1センサによって検出された前記弛緩動作中の前記第1ワイヤの張力を取得し、前記弛緩動作中の前記張力に基づいて前記エンドルミナルデバイスの制御パラメータを調整する、エンドルミナルデバイスシステムである。
 本発明の他の態様は、エンドルミナルデバイスシステムの制御装置であって、前記エンドルミナルデバイスシステムが、長尺かつ可撓性のエンドルミナルデバイスと、該エンドルミナルデバイス内に該エンドルミナルデバイスの長手方向に配置される第1ワイヤと、該第1ワイヤの張力を検出する第1センサと、前記第1ワイヤを牽引可能な駆動装置と、を備え、少なくとも1つのプロセッサを備え、該少なくとも1つのプロセッサが、牽引されている前記第1ワイヤを弛緩させる弛緩動作を前記駆動装置に実行させ、前記第1センサによって検出された前記弛緩動作中の前記第1ワイヤの張力を取得し、前記弛緩動作中の前記張力に基づいて前記エンドルミナルデバイスの制御パラメータを調整する、制御装置である。
 本発明の他の態様は、エンドルミナルデバイスの制御方法であって、該エンドルミナルデバイス内に該エンドルミナルデバイスの長手方向に第1ワイヤが配置され、牽引されている前記第1ワイヤを弛緩させる弛緩動作を実行し、前記弛緩動作中の前記第1ワイヤの張力を取得し、前記弛緩動作中の前記張力に基づいて前記エンドルミナルデバイスの制御パラメータを調整する、制御方法である。
 本発明によれば、軟性部の形状に応じた適切な制御パラメータを簡易な構成で設定することができるという効果を奏する。
第1実施形態に係るエンドルミナルデバイスシステムの全体構成を示す外観図である。 第1実施形態に係るエンドルミナルデバイスシステムの概略構成図である。 第1実施形態に係る制御方法のフローチャートである。 先端部(上段)、中央部(中段)および基端部(下段)にループが形成されたワイヤの形状を示す図である。 図4の各形状のワイヤの基端および先端における、弛緩動作中の張力の時間変化を示すグラフである。 ワイヤの基端から先端までの張力の分布の例を示す図である。 ワイヤの基端から先端までの張力の分布の他の例を示す図である。 ワイヤの形状の一例を示す図である。 弛緩動作におけるワイヤの変位と張力との関係を示すグラフである。 図3の制御方法の変形例のフローチャートである。 図2のエンドルミナルデバイスシステムの他の変形例の概略構成図である。 図3の制御方法の他の変形例のフローチャートである。 軟性部の形状を推定する方法を説明する図である。 軟性部の形状を推定する手順を示すフローチャートである。 第2実施形態に係るエンドルミナルデバイスシステムの概略構成図である。 第2実施形態に係るエンドルミナルデバイスシステムの他の概略構成図である。 図14のエンドルミナルデバイスシステムの他の変形例の概略構成図である。 計測ワイヤのばね特性の一例を示すグラフである。 第3実施形態に係るエンドルミナルデバイスシステムの概略構成図である。 他の実施形態に係るエンドルミナルデバイスシステムの概略構成図である。
(第1実施形態)
 本発明の第1実施形態に係るエンドルミナルデバイスシステム、制御装置および制御方法について図面を参照して説明する。
 図1は、本実施形態に係るエンドルミナルデバイスシステム100の一構成例の外観図を示している。エンドルミナルデバイスシステム100において、操作装置6に入力された操作に基づいて制御装置5が駆動装置2を制御することによって、エンドルミナルデバイス1の可動部11が電動駆動される。
 エンドルミナルデバイス1は、口または肛門等の開口部から体腔内に挿入され体腔内において観察または処置等を行う長尺かつ可撓性のデバイスであり、例えば、内視鏡またはマニピュレータである。図1には、一例として、エンドルミナルデバイス1が内視鏡であるシステム100が示されている。符号7は、内視鏡1によって取得された内視鏡映像を処理する映像プロセッサを示し、符号8は、内視鏡映像を表示する表示装置を示している。
 モータ等を内蔵する駆動装置2は、一例として手術台9の脇に載置される。したがって、電動駆動式のエンドルミナルデバイス1の軟性部13は、体内に挿入される長尺の体内部分13aに加えて、体外に配置され体内部分13aの基端と駆動装置2とを接続する長尺の体外部分13bを有する。このような可撓性を有する軟性部13は、様々な湾曲形状を取り得る。特に、体外部分13bの形状は駆動装置2と手術台9の配置によって決まるものであるから、形状の変化の幅が大きい。軟性部13の形状に応じてエンドルミナルデバイス1内のワイヤ12の動力伝達特性が変化し、それにより操作装置6に入力された操作に対する可動部11の応答性も変化し得る。後述するように、エンドルミナルデバイスシステム100は、軟性部13の形状に応じて駆動装置2を制御することによって、可動部11の応答性が一定となるようにエンドルミナルデバイス1を制御する機能を有する。
 図2は、エンドルミナルデバイスの概略構成を示している。図2に示されるように、エンドルミナルデバイスシステム100は、可動部11を有するエンドルミナルデバイス1と、エンドルミナルデバイス1に設けられた1以上の可撓性のワイヤ(第1ワイヤ)12と、ワイヤ12を牽引および弛緩させることによって可動部11を駆動する駆動装置2と、各ワイヤ12の張力を検出する1以上の張力センサ(第1センサ)3と、各ワイヤ12の変位を検出する1以上の変位センサ(第2センサ)4と、駆動装置2を制御する制御装置5と、を備える。
 エンドルミナルデバイス1は、長尺かつ可撓性の軟性部13を有する。軟性部13の基端は駆動装置2に接続されている。
 可動部11は、軟性部13の先端に接続されている。本実施形態において、可動部11は、軟性部13の長手方向に交差する方向に湾曲可能である湾曲部である。
 ワイヤ12は、駆動装置2から与えられた動力を基端から先端へ伝達し可動部11を動作させる機能を有し、かつ、軟性部13の形状情報を取得する機能を有する。以降、駆動装置2から与えられた動力を基端から先端へ伝達し可動部11を動作させる機能を有するワイヤを駆動ワイヤ、軟性部13の形状情報を取得する機能を有するワイヤを計測ワイヤと呼ぶ。例えば、湾曲部11を上、下、左、右にそれぞれ湾曲させるための4本のワイヤ12が設けられている。本実施形態においては、これらの4本のワイヤ12がそれぞれ駆動ワイヤとしての機能と、計測ワイヤとしての機能の両方を備えている。
 ワイヤ12は、軟性部13内に軟性部13の長手方向に沿って配置され、ワイヤ12の先端は湾曲部11の先端に固定され、ワイヤ12の基端は駆動装置2に接続されている。このように軟性部13の全長にわたって延びる可撓性のワイヤ12は、軟性部13の湾曲に伴って、軟性部13と同一の形状に湾曲する。
 駆動装置2は、ワイヤ12の基端部をワイヤ12の長手方向に後退および前進させることによってワイヤ12を駆動する1以上のアクチュエータ2aを有する。アクチュエータ2aは、ワイヤ12の基端部を後退させることによってワイヤ12を牽引し、ワイヤ12の基端部を前進させることによってワイヤ12を弛緩させる。駆動装置2は、制御装置5からの制御信号(後述)に従ってアクチュエータ2aを作動させることによって湾曲部11を湾曲させる。
 張力センサ3は、ワイヤ12の基端部に設けられ、ワイヤ12の基端部の張力を検出する。
 変位センサ4は、ワイヤ12の長手方向におけるワイヤ12の基端部の変位を検出する。例えば、変位センサ4は、アクチュエータ2aに設けられ、ワイヤ12の変位としてアクチュエータ2aのモータの回転角度を検出する角度センサである。ワイヤ12の張力がゼロである状態でのワイヤ12の基端部の位置が原点であり、変位センサ4によって検出されるワイヤ12の基端部の変位は、原点に対するワイヤ12の基端部の位置である。したがって、変位は、ワイヤ12の牽引によって増加し、ワイヤ12の弛緩によって減少する。
 制御装置5は、中央演算処理装置のような少なくとも1つのプロセッサ5aと、記憶部5bとを備える。
 プロセッサ5aは、入力された操作に基づく操作信号を操作装置6から受信し、操作信号に基づいて制御信号を生成し、制御信号を駆動装置2に送信する。これにより、プロセッサ5aは、駆動装置2を制御し、それによりエンドルミナルデバイス1の湾曲部11を制御する。
 記憶部5bは、RAMのようなメモリと、ROMまたはHDDのような不揮発性の記録媒体とを含む。記録媒体は、コンピュータ読み取り可能な非一時的な記録媒体である。記録媒体には、軟性部13の形状に応じてエンドルミナルデバイス1を制御する制御方法をプロセッサ5aに実行させるための制御プログラムが記憶されている。
 次に、制御装置5が実行するエンドルミナルデバイス1の制御方法について図3を参照して説明する。
 図3に示されるように、制御方法は、トリガを受け付けるステップS1と、牽引されているワイヤ12を弛緩させる弛緩動作を実行するステップS2と、センサ3,4によって検出された弛緩動作中のワイヤ12の張力および変位を取得するステップS3と、弛緩動作中の張力および変位に基づいてエンドルミナルデバイス1の制御パラメータを調整するステップS4と、ワイヤ12を初期状態に復元するステップS5と、を含む。
 トリガは、例えば入力装置(図示略)を使用して、操作者によって制御装置5に入力される。操作者は、制御パラメータの調整を実行したい任意のタイミングでトリガを制御装置5に入力することができる。例えば、軟性部13を体腔内に挿入した後、操作者は、湾曲部11の精緻な動作が要求される処置等の作業の直前に、トリガを入力する。
 プロセッサ5aは、入力されたトリガを受け付けたことに応答して(ステップS1のYES)、ステップS2からS5を実行する。
 ステップS2の前、ワイヤ12および湾曲部11は、所定の初期状態に配置される。初期状態は、例えば、全てのワイヤ12に所定の初期張力がかかり湾曲部11が直線状に配置される状態である。
 ステップS2において、プロセッサ5aは、ワイヤ12を牽引する牽引動作を駆動装置2に実行させ、続いて、牽引されているワイヤ12を弛緩させる弛緩動作を駆動装置2に実行させる。牽引および弛緩されるワイヤ12は、任意の1本のワイヤ12である。
 牽引動作において、プロセッサ5aは、例えば駆動装置2にワイヤ12を所定量だけ牽引させ、ワイヤ12を所定の目標張力がかかった状態にする。所定の目標張力は、体腔の形状に沿う軟性部13の湾曲を妨げない範囲内であり、したがって、牽引動作後のワイヤ12は、体腔の形状に沿う軟性部13の湾曲を許容する程度に弛緩した状態である。
 弛緩動作中、ワイヤ12の基端部の変位が時間と共に減少し、ワイヤ12の基端部の張力は時間と共に低下する(例えば、図5参照。)。弛緩動作中、変化するワイヤ12の張力および変位が、例えば所定のサンプリング周期で、センサ3,4によって連続的に検出される。
 ここで、ワイヤ12の基端部の変位が減少するにつれて、張力の低下する領域がワイヤ12の基端部から先端側へ広がる。すなわち、弛緩動作中、張力変化(張力の低下)は、ワイヤ12の基端部から先端部へ順に伝達される。プロセッサ5aは、少なくとも張力変化がワイヤ12の先端部に伝達されるまで、駆動装置2に弛緩動作を実行させる。
 例えば、プロセッサ5aは、弛緩動作中に現在の張力または変位をセンサ3,4から逐次取得し、現在の張力または変位に基づいてワイヤ12の全体の弛緩が完了したと判断し、弛緩が完了したときに弛緩動作を終了させてもよい。現在の張力が所定値以下となったとき、または、現在の変位が所定値以下となったときに、弛緩が完了したと判断される。
 張力変化がワイヤ12の先端に到達したとき、張力変化率が変化する変化点が現れることがある。プロセッサ5aは、張力の変化点が検出されたときに弛緩動作を終了させてもよい。
 ステップS3において、プロセッサ5aは、センサ3,4によって検出された弛緩動作中の張力および変位を時系列で記憶部5bに記憶させる。これにより、プロセッサ5aは、弛緩動作中の張力および変位の各々のデータを取得する。
 図5は、図4に示されるようにループが先端部、中央部および基端部にそれぞれ形成されている軟性部13の3つの形状のパターン1,2,3において、弛緩動作中のワイヤ12の先端および基端の張力の時間変化を示している。図5に示されるように、張力変化がワイヤ12の先端に到達するまでの期間I,II,IIIにおける張力の変化は、軟性部13の形状に応じて異なる。すなわち、弛緩動作中の張力の変化は、軟性部13の形状情報を含む。
 次に、ステップS4において、プロセッサ5aは、ステップS3において取得された張力および変位のデータを使用して弛緩動作中の変位に対する張力の変化率を算出し、変化率に基づいて制御パラメータを調整する。張力の変化率とは、弛緩動作開始時の最大張力からの各変位での張力の変化率である。
 制御パラメータは、ワイヤ12の先端まで張力変化が伝達されるためのワイヤ12の牽引量および弛緩量である。より具体的には、制御パラメータは、図5に示される期間I,II,IIIにおけるワイヤ12の基端部の変位量である。言い換えると、制御パラメータは、図6Aに示されるように、ワイヤ12の先端まで張力変化が伝達されるために必要な基端部の張力変化ΔTに相当するワイヤ12の基端部の変位量である。
 図7および図8は、ワイヤ12の形状と、弛緩動作中のワイヤ12の変位および張力の関係とを説明している。ワイヤ12の基端部の張力変化は、ワイヤ12の基端部から先端部に向かって順番に伝達されることから、ワイヤ12の基端部の各変位Δxi(i=1,2,…)における張力の変化は、ワイヤ12の対応する部分Piの形状情報を含む。
 例えば、ワイヤ12の基端部の変位がΔx1だけ減少したとき、張力変化はワイヤ12の部分P1まで伝達される。したがって、変位Δx1における張力変化は、部分P1の形状情報を含む。ワイヤ12の基端部の変位がさらにΔx2だけ減少したとき、張力変化はワイヤ12の部分P2まで伝達される。したがって、変位Δx2における張力変化は、部分P1および部分P2の形状情報を含む。
 したがって、ワイヤ12の基端側から順に、変位xiに対する張力の変化率Ti/Tpから部分Pi形状を推定することができ、このような変化率Ti/Tpに基づいて軟性部13の全体の形状に応じた制御パラメータを決定することができる。
 なお、弛緩動作中の張力の変化から軟性部13の形状を正確に推定するためには、図6Aに示されるように、軟性部13に沿って配置されたワイヤ12の張力が基端から先端まで単調減少または単調増加することが好ましい。したがって、プロセッサ5aは、弛緩動作中、張力変化が先端に伝達されるまで、ワイヤ12の基端部を前進させ続けることによって基端部の張力を漸次低下させ続ける。
 例えば張力変化が先端に到達する前にワイヤ12の弛緩を終了して再度牽引した場合、図6Bに示されるように、ワイヤ12の張力が基端から先端まで単調減少しなくなる。この場合、最大変位が更新される際の変位と張力の関係を抽出する。
 弛緩動作の終了後、ステップS5において、プロセッサ5aは、ワイヤ12の張力を初期張力に戻すイニシャライズ動作を駆動装置2に実行させる。これにより、ワイヤ12および湾曲部11は、初期状態に復帰する。
 ステップS5の後、プロセッサ5aは、操作装置6からの操作信号とステップS4において調整された制御パラメータとに基づいて制御信号を生成し、制御信号を駆動装置2に送信する。これにより、軟性部13の形状に関わらず、湾曲部11を良好な応答性で制御することができる。
 このように、本実施形態によれば、弛緩動作中のワイヤ12の張力の変化は、軟性部13の湾曲形状に応じて異なり、ワイヤ12の張力の変化に対応する軟性部13の形状は、一意である。したがって、ワイヤ12の張力の変化に基づいて、軟性部13の形状に応じた適切な制御パラメータを設定することができる。
 また、ワイヤ12およびセンサ3,4を使用した簡易な構成によって、必要なデータの取得と制御パラメータの設定とを行うことができる。
 また、ワイヤ12が駆動ワイヤとしての機能と、計測ワイヤとしての機能とを有する。このことによって、形状情報の取得のための別途の計測ワイヤを搭載する必要や、計測のための新たな部品を軟性部13に追加する必要がない。したがって、軟性部13を細径化することができる。
 また、張力および変位のデータの取得は、軟性部13が体腔内に挿入され湾曲した湾曲部11が直線状に戻る動作において行われてもよい。この場合、データを取得するための操作は不要であり、制御パラメータの調整に必要なデータを、操作者の手間を増やすことなく取得することができる。
 また、湾曲部11の精緻な動作が要求される作業の直前にデータの取得および制御パラメータの調整を行うことによって、軟性部13のその時点での形状に応じた最適な制御パラメータを確実に設定することができ、操作装置6に入力された操作に従って湾曲部11を正確に動かすことができる。
 本実施形態において、プロセッサ5aは、牽引および弛緩させるワイヤ12を選択することによって、湾曲部11の動きを伴わない牽引動作および弛緩動作を駆動装置2に実行させてもよい。
 具体的には、図9に示されるように、プロセッサ5aは、ステップS2の牽引動作および弛緩動作の実行の前に、複数のワイヤ12のうち、湾曲部11の湾曲のために牽引されている駆動中のワイヤ12を操作装置6からの操作信号に基づいて認識する(ステップS6)。駆動中のワイヤ12の認識は、例えば、制御装置5から駆動装置2に送信される制御信号または張力センサ3によって検出された張力に基づいて行ってもよい。
 図9の制御方法の第1の例のステップS2において、プロセッサ5aは、駆動中のワイヤ12と、該駆動中のワイヤ12と対抗するもう1本のワイヤ12とを選択する。対抗するワイヤ12とは、駆動中のワイヤ12による湾曲部11の湾曲方向とは逆方向に湾曲部11を湾曲させるためのワイヤ12である。例えば、駆動中のワイヤ12が上向きの湾曲用ワイヤである場合、対抗するワイヤ12は下向きの湾曲用ワイヤである。
 次に、プロセッサ5aは、駆動装置2を制御し、牽引動作および弛緩動作において、選択された2本のワイヤ12を同時に牽引および弛緩させる。このときの弛緩動作は、駆動中のワイヤ12の張力が牽引動作前の張力に戻るまで実行される。プロセッサ5aは、弛緩動作中の2本のワイヤ12のうち少なくとも一方の張力および変位のデータを取得し、取得されたデータに基づいて制御パラメータを調整する。
 この構成によれば、牽引動作中および弛緩動作中、湾曲部11に加わるモーメントが釣り合うので、湾曲部11の湾曲方向および湾曲角度が一定に維持される。したがって、湾曲部11の動作を生じさせることなく、張力および変位のデータを取得することができる。
 図9の制御方法の第2の例において、プロセッサ5aは、駆動中のワイヤ12以外のいずれか1本のワイヤ12を選択する、すなわち、駆動中でないワイヤ12の中から1本を選択する。例えば、駆動中のワイヤ12とこれに対抗するワイヤ12とを除いた他のワイヤ12の中から1本が選択される。具体的には、駆動中のワイヤ12が上向きまたは下向きの湾曲用である場合、左向きまたは右向きの湾曲用のワイヤ12が選択される。駆動中のワイヤ12が左向きまたは右向きの湾曲用である場合、上向きまたは下向きの湾曲用のワイヤ12が選択される。
 次に、プロセッサ5aは、駆動装置2を制御し、牽引動作および弛緩動作において、選択された1本のワイヤ12を牽引および弛緩させる。
 この構成によっても、牽引動作中および弛緩動作中に湾曲部11の動作を生じさせることなく、張力および変位のデータを取得することができる。
 本実施形態において、可動部11が湾曲部であることとしたが、可動部11はこれに限定されるものではなく、他の形態であってもよい。例えば、可動部11は、関節であってもよく、把持等の機能を有するエンドエフェクタであってもよい。
 図10は、可動部11としてエンドエフェクタを備えるエンドルミナルデバイス1を示している。この例において、エンドエフェクタ11は、相互に開閉する一対のジョーを有し、ワイヤ12の駆動によって一対のジョーが開閉する。
 本実施形態において、プロセッサ5aが、操作者によって入力されるトリガに応答して制御方法を実行することとしたが、これに代えて、自動的に制御方法を実行してもよい。
 例えば、プロセッサ5aは、所定の時間間隔でステップS2からS5を繰り返し実行してもよい。この場合、操作者によるトリガの入力を必要とすることなく、データの取得および制御パラメータの調整が繰り返し自動的に実行される。
 例えば、軟性部13を体腔内に挿入する過程において、軟性部13の形状は変化し続ける。このような場面において、軟性部13の形状の変化に応じて制御パラメータが逐次更新されることによって、可動部11の良好な応答性を維持することができる。
 本実施形態において、図11に示されるように、プロセッサ5aは、張力および変位のデータに基づいて軟性部13の形状を推定してもよい(ステップS7)。この場合、ステップS4において、プロセッサ5aは、上述したように張力の変化率に基づいて制御パラメータを調整してもよく、または、軟性部13の形状に基づいて制御パラメータを調整してもよい。
 図12は、ワイヤ12の張力および変位から軟性部13の形状を推定する方法を説明するものであり、ワイヤ12の基端から先端までの張力の分布を示している。この方法によって、軟性部13の主軸に沿う曲げ半径、湾曲角度および長さといった形状情報を算出することができる。
 図12に示されるように、ワイヤ12は、基端から先端まで順にn個の要素i(i=1,2,…,n)から構成されると考える。要素1は、ワイヤ12の基端を含み、要素nは、ワイヤ12の先端を含む。
 t=t0の初期状態において、ワイヤ12の張力は、ワイヤ12に作用する摩擦の影響によって、基端から先端に向かって指数関数的に減少する。前述したように、ワイヤ12の基端部の変位(前進)によってワイヤ12が弛緩する過程において、張力変化(張力の低下)は、基端から先端に向かって順に伝達される。
 t=ti-1において、基端の張力が初期の最大張力Tpから張力Tr_(i-1)まで低下し、張力変化が要素i-1まで伝達される。すなわち、動作領域[1:i-1]において、張力が低下し、動作領域[1:i-1]の範囲の要素1,2,…,i-1の伸びが変化(減少)する。
 同様に、t=tiにおいて、基端の張力が最大張力Tpから張力Tr_iまで低下し、張力変化が要素iまで伝達される。
 図13は、ワイヤ12の形状(すなわち軟性部13の形状)の計算の手順を示している。図13に示されるように、iをインクリメントしながら(ステップS11,S17)ステップS12からS16を繰り返すことによって、基端側から順に、要素iの湾曲角度θi、長さLiおよび湾曲半径Riを計算する。算出された湾曲角度θi、長さLiおよび湾曲半径Riは、記憶部5bに蓄積され、次の要素i+1の湾曲角度θi+1、長さLi+1および湾曲半径Ri+1の計算に使用される。長さLiの和がワイヤ12の全長に達するまでステップS12からS16は繰り返され、それにより全ての要素iの形状θi,Li,Riが得られる。
 ステップS12において、ワイヤ12の基端部の変位がdxiだけ減少することによって基端の張力がTr_(i-1)からTr_iまで低下し、ワイヤ12が要素iまで弛緩する、すなわち動作領域が要素iへ進展する。
 次に、ステップS13において、要素iの張力Tiを計算する。
 基端の最大張力Tpは、オイラーのベルトの式により、各要素iの張力Tiを用いて次式(1)で表される。μは、摩擦係数であり、θiは、要素iの湾曲角度である。
Figure JPOXMLDOC01-appb-M000001
 
 要素iの張力Tiは、張力センサ3によって検出されたワイヤ12の基端部の張力Tr_iを用いて、下式(2)から計算することができる。張力の変化率は、初期の最大張力Tpに対する、各変位xiのときに張力センサ3が取得した張力Tr_iの比として計算される。
Figure JPOXMLDOC01-appb-M000002
 
 次に、ステップS14において、要素iの湾曲角度θiを計算する。湾曲角度θiは、次式(3)から求められる。
Figure JPOXMLDOC01-appb-M000003
 
 次に、ステップS15において、動作領域[1,i-1]の範囲の各要素kの伸びの変化量dlkを計算する。要素kの伸びの変化量dlkは、下式(4)の通り、要素kの牽引時と弛緩時との間の張力の差dTkを用いてフックの法則から計算できる。EAは、ワイヤ12の剛性である。
 dlk = Lk/EA × dTk   (4)
 ステップS15より、要素1から要素i-1までの伸びの変化量dl1,dl2,…,dl(i-1)の総和が得られる。
 次に、ステップS16において、要素iの長さLiおよび湾曲半径Riを計算する。
 ワイヤ12の駆動変位dxiは、張力が伝達された動作範囲[1:i]の伸びの変化量dl1,dl2,…,dliの総和である。したがって、下式(5)の通り、要素iの変化量dliは、変位dxiと、要素1から要素i-1までの伸びの変化量dl1,dl2,…,dli-1の総和と、の差分として算出される。
Figure JPOXMLDOC01-appb-M000004
 以上から、要素iの長さLiおよび湾曲半径(曲率半径)Riは、次式(6)および(7)によってそれぞれ得られる。
Figure JPOXMLDOC01-appb-M000005
 
 軟性部13の形状の推定において、張力の複数のデータに重み付けしてもよい。複数のデータは、1本のワイヤ12に対して牽引動作および弛緩動作を複数回実行することによって取得されるか、または、複数本のワイヤ12に対して牽引動作および弛緩動作を実行することによって取得される。
 複数のデータの内、信頼性の高いデータに対してより大きな重みが付される。信頼性の高いデータは、例えば、ばね定数の線形性の高いワイヤ12を用いて取得されたデータ、張力が大きいデータ、または、弛緩動作におけるワイヤ12の駆動速度が遅いデータである。張力が大きい程、弛緩動作における張力の変化量が大きくなるので、データの信頼性が高くなる。また、駆動速度が遅い程、データの密度が大きくなるので、データの信頼性が高くなる。
 このように、信頼性に基づき重み付けされた複数のデータを使用して軟性部13の形状を推定することによって、軟性部13の形状の推定誤差を抑制し、軟性部13の形状をより高精度に推定することができる。
(第2実施形態)
 次に、本発明の第2実施形態に係るエンドルミナルデバイスシステム、制御装置および制御方法について図面を参照して説明する。
 図14に示されるように、本実施形態に係るエンドルミナルデバイスシステム200は、駆動ワイヤ17とは別の計測ワイヤ14が設けられている点において、第1実施形態と相違する。本実施形態において、第1実施形態と相違する構成について説明し、第1実施形態と共通する構成については同一の符号を付して説明を省略する。
 エンドルミナルデバイスシステム200は、可動部11および1以上の駆動ワイヤ(第2ワイヤ)17を有するエンドルミナルデバイス10と、エンドルミナルデバイス10に設けられた計測ワイヤ(第1ワイヤ)14と、駆動装置2と、ワイヤ14,17の張力を検出する張力センサ(第1センサ)3と、計測ワイヤ14の変位を検出する変位センサ(第2センサ)4と、制御装置5と、を備える。
 図14において、可動部11は湾曲部である。図16に示されるように、可動部11は、エンドエフェクタであってもよく、または、関節であってもよい。
 可撓性の駆動ワイヤ17は、第1実施形態のワイヤ12と同一の構成であるが、機能が異なる。すなわち、本実施形態の駆動ワイヤ17は、軟性部13内に軟性部13の長手方向に沿って配置され、駆動ワイヤ17の先端は湾曲部11の先端に固定され、駆動ワイヤ17の基端は駆動装置2に接続されている。このように軟性部13の全長にわたって延びる可撓性の駆動ワイヤ17は、軟性部13の湾曲に伴って、軟性部13と同一の形状に湾曲する。
 第1実施形態のワイヤ12とは異なり、本実施形態の駆動ワイヤ17は、駆動装置2から与えられた動力を基端から先端へ伝達し可動部11を動作させる機能を有し、軟性部13の形状情報を取得する機能を有しない。例えば、湾曲部11を上、下、左、右にそれぞれ湾曲させるための4本のワイヤ17が設けられている。本実施形態においては、これらの4本のワイヤ17がそれぞれ駆動ワイヤとしての機能を実行可能に構成されているが、計測ワイヤとしての機能は実行しない。
 可撓性の計測ワイヤ14は、軟性部13内に軟性部13の長手方向に配置され、計測ワイヤ14の先端は、可動部11には連結されず、軟性部13の先端に固定され、計測ワイヤ14の基端は駆動装置2に接続されている。計測ワイヤ14は、軟性部13の形状情報を取得する機能を有するが、駆動装置2から与えられた動力を基端から先端へ伝達し可動部11を動作させる機能を有しない。
 駆動装置2は、各ワイヤ14,17の基端部を各ワイヤ14,17の長手方向に後退および前進させるアクチュエータ2aを有する。
 張力センサ3は、各ワイヤ14,17の基端部に設けられ、各ワイヤ14,17の基端部の張力を検出する。
 変位センサ4は、計測ワイヤ14の長手方向における計測ワイヤ14の基端部の変位を検出する。
 計測ワイヤ14の経路の摩擦係数は、駆動ワイヤ17の経路の摩擦係数よりも大きい。
 例えば、図15に示されるように、エンドルミナルデバイスシステム200は、計測ワイヤ14が挿入された管状の第1シース15と、駆動ワイヤ17が挿入された管状の第2シース16とを備える。各ワイヤ14,17は、シース15,16内において長手方向に移動可能である。計測ワイヤ14と第1シース15と間の摩擦係数は、駆動ワイヤ17と第2シース16と間の摩擦係数よりも大きい。
 ワイヤ14,17の経路の摩擦係数を異ならせる他の手段として、潤滑剤、撚線/単線または表面処理が採用されてもよい。
 すなわち、計測ワイヤ14の経路の摩擦係数が駆動ワイヤ17の経路の摩擦係数よりも大きくなるように、ワイヤ14,17に塗布される潤滑剤の種類が選択されてもよい。または、駆動ワイヤ17として単線が使用され、計測ワイヤ14として撚線が使用されてもよい。または、摩擦係数を高める表面処理、例えば凹凸構造を形成する粗面処理が、計測ワイヤ14の外面に施されていてもよい。
 本実施形態の制御方法において、プロセッサ5aは、牽引動作および弛緩動作において計測ワイヤ14を牽引および弛緩させ(ステップS2)、弛緩動作中の計測ワイヤ14の張力および変位のデータを取得し(ステップS3)、データに基づいて駆動ワイヤ17用の制御パラメータを調整する(ステップS4)。
 このように、本実施形態によれば、駆動ワイヤ17とは別の計測ワイヤ14が使用され、計測ワイヤ14に作用する摩擦が、駆動ワイヤ17に作用する摩擦よりも大きい。駆動ワイヤ17に作用する摩擦が小さい程、駆動ワイヤ17の基端から先端への動力の伝達効率が高くなる。一方、計測ワイヤ14に作用する摩擦が大きい程、弛緩動作中の計測ワイヤ14の基端部の張力の変化が大きくなる。したがって、可動部11の応答性を高めることができるとともに、軟性部13の形状に対する張力の感度を高め、軟性部13の形状の推定精度および制御パラメータの調整精度を向上することができる。
 本実施形態において、計測ワイヤ14の経路の摩擦係数が駆動ワイヤ17の経路の摩擦係数よりも大きいこととしたが、これに代えて、またはこれに加えて、計測ワイヤ14のばね定数が、駆動ワイヤ17のばね定数よりも小さくてもよい。
 駆動ワイヤ17のばね定数が大きい程、駆動ワイヤ17の基端から先端への動力の伝達が速くなる。一方、計測ワイヤ14のばね定数が小さい程、張力の変化に対する変位の変化量が大きくなり、牽引動作および弛緩動作において必要とされる計測ワイヤ14の変位量が大きくなる。
 したがって、計測ワイヤ14のばね定数を駆動ワイヤ17のばね定数よりも小さくすることによって、可動部11の応答性を高めることができるとともに、軟性部13の形状に対する変位の感度を高め、軟性部13の形状の推定精度および制御パラメータの調整精度を向上することができる。
 本実施形態において、計測ワイヤ14のばね特性の線形領域において、計測ワイヤ14を牽引および弛緩させてもよい。
 図17は、計測ワイヤ14のばね特性の一例を示し、横軸は計測ワイヤ14の変位を表し、縦軸は計測ワイヤ14の張力を表している。撚線からなる計測ワイヤ14の場合、ばね特性は、張力が線形に変化する領域(破線の楕円によって囲まれた領域)と、張力が非線形に変化する領域と、を含むことがある。
 本変形例によれば、計測ワイヤ14の線形領域を使用することによって、軟性部13の形状の算出および制御パラメータの調整のための演算を簡単化することができる。また、軟性部13の形状の算出および制御パラメータの調整をより正確に行うことができる。
 単線からなる計測ワイヤ14の場合、計測ワイヤ14は、変位の略全域において張力が線形に変化するばね特性を有する。したがって、計測ワイヤ14として単線を使用する場合には、任意の線形領域において計測ワイヤ14を牽引および弛緩させてもよい。
(第3実施形態)
 次に、本発明の第3実施形態に係るエンドルミナルデバイスシステム、制御装置および制御方法について図面を参照して説明する。
 図18に示されるように、本実施形態に係るエンドルミナルデバイスシステム300は、エンドルミナルデバイス20が複数の可動部11A,11Bを有する点において、第1および第2実施形態と相違する。本実施形態において、第1および第2実施形態と相違する構成について説明し、第1および第2実施形態と共通する構成については同一の符号を付して説明を省略する。
 エンドルミナルデバイスシステム300は、2つの可動部11A,11Bおよび2以上のワイヤ(第1ワイヤ)12A,12Bを有するエンドルミナルデバイス20と、ワイヤ12A,12Bを牽引および弛緩させることによって可動部11A,11Bを駆動する駆動装置2と、各ワイヤ12A,12Bの張力を検出する張力センサ(第1センサ)3と、各ワイヤ12A,12Bの変位を検出する変位センサ(第2センサ)4と、制御装置5と、を備える。
 可動部11A,11Bは、例えば、湾曲部、関節およびエンドエフェクタのいずれかである。図18の例において、可動部11Aはエンドエフェクタであり、可動部11Bは、エンドエフェクタ11Aと軟性部13の先端との間に配置された関節である。
 ワイヤ12A,12Bは、第1実施形態のワイヤ12と同様に、対応する可動部11A,11Bを動作させるための駆動ワイヤであり、かつ、計測ワイヤでもある。各ワイヤ12A,12Bの先端は対応する可動部11A,11Bにそれぞれ固定され、各ワイヤ12A,12Bの基端は駆動装置2に接続されている。
 駆動装置2は、各ワイヤ12A,12Bの基端部をワイヤ12A,12Bの長手方向に後退および前進させる2以上のアクチュエータ2aを有する。
 張力センサ3は、各ワイヤ12A,12Bの基端部に設けられ、各ワイヤ12A,12Bの基端部の張力を検出する。
 変位センサ4は、各ワイヤ12A,12Bの長手方向におけるワイヤ12A,12Bの基端部の変位を検出する。
 本実施形態において、プロセッサ5aは、可動部11A,11Bのいずれか1つを動作させるときに、制御方法を実行し可動部11A,11Bの制御パラメータを調整する。例えば、プロセッサ5aは、可動部11Bの動作に伴うワイヤ12Bの弛緩動作中にワイヤ12Bの張力および変位のデータを取得し、取得されたデータに基づいて、可動部11A,11Bの両方の制御パラメータを調整する。
 このように、本実施形態によれば、可動部11A,11Bのいずれかが処置等の作業に必要な動作をしたときに、他の可動部11A,11B用の制御パラメータも調整することができる。
 本実施形態において、プロセッサ5aは、第1実施形態と同様に、トリガに応答して制御方法を実行してもよく、または、所定の時間間隔で繰り返し制御方法を実行してもよい。この場合、プロセッサ5aは、所定の複数のワイヤ12A,12Bの中から任意の1本のワイヤを選択し、選択されたワイヤを牽引動作および弛緩動作において牽引および弛緩させてもよい。
 本実施形態において、プロセッサ5aは、張力の複数のデータに基づいて、軟性部13の形状の算出および制御パラメータの調整を行ってもよい。複数のデータは、1つの計測ワイヤ12について牽引動作および弛緩動作を複数回実行することによって、または、複数の計測ワイヤ12について牽引動作および弛緩動作を実行することによって、取得される。この構成によれば、軟性部13の形状の算出よび制御パラメータの調整の精度を向上することができる。
 上述した第1および第2実施形態においても、プロセッサ5aは、張力の複数のデータに基づいて、軟性部13の形状の算出および制御パラメータの調整を行ってもよい。
 上述した第1から第3の実施形態において、エンドルミナルデバイス1,10,20が可動部11,11A,11Bを有することとしたが、図19に示されるように、エンドルミナルデバイス30は、可動部を有していなくてもよい。計測ワイヤ14の先端は、軟性部13の先端に固定される。この場合、プロセッサ5aは、計測ワイヤ14の張力および変位のデータを取得した後、軟性部13の形状の算出を行い、制御パラメータの調整を省略してもよい。
1,10,20 エンドルミナルデバイス
2 駆動装置
3 張力センサ(第1センサ)
4 変位センサ(第2センサ)
5 制御装置
5a プロセッサ
11 湾曲部、可動部
11A,11B 可動部
12 ワイヤ(第1ワイヤ)
12A,12B (第1ワイヤ)
13 軟性部
14 計測ワイヤ(第1ワイヤ)
15 第1シース
16 第2シース
17 駆動ワイヤ(第2ワイヤ)
100,200,300 エンドルミナルデバイスシステム

Claims (20)

  1.  長尺かつ可撓性のエンドルミナルデバイスと、
     該エンドルミナルデバイス内に該エンドルミナルデバイスの長手方向に配置される可撓性の第1ワイヤと、
     該第1ワイヤの張力を検出する第1センサと、
     前記第1ワイヤを牽引可能な駆動装置と、
     少なくとも1つのプロセッサと、を備え、
     該少なくとも1つのプロセッサが、
     牽引されている前記第1ワイヤを弛緩させる弛緩動作を前記駆動装置に実行させ、
     前記第1センサによって検出された前記弛緩動作中の前記第1ワイヤの張力を取得し、
     前記弛緩動作中の前記張力に基づいて前記エンドルミナルデバイスの制御パラメータを調整する、エンドルミナルデバイスシステム。
  2.  前記第1ワイヤの変位を検出する第2センサをさらに備え、
     前記少なくとも1つのプロセッサが、
     前記第2センサによって検出された前記弛緩動作中の前記第1ワイヤの変位を取得し、
     前記弛緩動作中の前記変位に対する前記張力の変化率に基づいて前記制御パラメータを調整する、請求項1に記載のエンドルミナルデバイスシステム。
  3.  前記エンドルミナルデバイスが、長尺かつ可撓性の軟性部と、該軟性部の先端に接続された可動部とを備え、
     前記第1ワイヤが、前記可動部に連結され、
     前記第1ワイヤの牽引および弛緩によって前記可動部が動く、請求項2に記載のエンドルミナルデバイスシステム。
  4.  前記少なくとも1つのプロセッサが、前記可動部の動きを伴わない前記弛緩動作を前記駆動装置に実行させる、請求項3に記載のエンドルミナルデバイスシステム。
  5.  複数の前記第1ワイヤを備え、
     前記可動部が湾曲部であり、前記複数の前記第1ワイヤが前記湾曲部に連結され、
     前記少なくとも1つのプロセッサが、
     前記弛緩動作の実行の前に、前記複数の第1ワイヤのうち前記湾曲部の湾曲のために牽引されている駆動中の第1ワイヤを認識し、
     前記駆動中の前記第1ワイヤと、該駆動中の第1ワイヤと対抗する前記第1ワイヤとを同時に弛緩させることによって前記可動部の動きを伴わない前記弛緩動作を前記駆動装置に実行させる、請求項4に記載のエンドルミナルデバイスシステム。
  6.  複数の前記第1ワイヤを備え、
     前記可動部が湾曲部であり、前記複数の前記第1ワイヤが前記湾曲部に連結され、
     前記少なくとも1つのプロセッサが、
     前記弛緩動作の実行の前に、前記複数の第1ワイヤのうち前記湾曲部の湾曲のために牽引されている駆動中の第1ワイヤを認識し、
     前記駆動中の第1ワイヤ以外のいずれかの前記第1ワイヤを弛緩させることによって前記可動部の動きを伴わない前記弛緩動作を前記駆動装置に実行させる、請求項4に記載のエンドルミナルデバイスシステム。
  7.  前記エンドルミナルデバイスが、長尺かつ可撓性の軟性部と、該軟性部の先端に接続された可動部と、前記軟性部内に該軟性部の長手方向に配置された第2ワイヤとを備え、
     前記第1ワイヤが、前記可動部に連結されておらず、
     前記第2ワイヤが、前記可動部に連結されている、請求項2に記載のエンドルミナルデバイスシステム。
  8.  前記第1ワイヤが挿入された第1シースと、
     前記第2ワイヤが挿入された第2シースと、をさらに備え、
     前記第1ワイヤと前記第1シースとの間の摩擦係数が、前記第2ワイヤと前記第2シースと間の摩擦係数よりも大きい、請求項7に記載のエンドルミナルデバイスシステム。
  9.  前記第1ワイヤのばね定数が、前記第2ワイヤのばね定数よりも小さい、請求項7に記載のエンドルミナルデバイスシステム。
  10.  前記制御パラメータが、前記第1ワイヤの先端まで張力が伝達されるための前記第1ワイヤの牽引量および弛緩量である、請求項2に記載のエンドルミナルデバイスシステム。
  11.  前記少なくとも1つのプロセッサが、前記変化率に基づいて前記エンドルミナルデバイスの形状を推定する、請求項2に記載のエンドルミナルデバイスシステム。
  12.  エンドルミナルデバイスシステムの制御装置であって、前記エンドルミナルデバイスシステムが、長尺かつ可撓性のエンドルミナルデバイスと、該エンドルミナルデバイス内に該エンドルミナルデバイスの長手方向に配置される可撓性の第1ワイヤと、該第1ワイヤの張力を検出する第1センサと、前記第1ワイヤを牽引可能な駆動装置と、を備え、
     少なくとも1つのプロセッサを備え、
     該少なくとも1つのプロセッサが、
     牽引されている前記第1ワイヤを弛緩させる弛緩動作を前記駆動装置に実行させ、
     前記第1センサによって検出された前記弛緩動作中の前記第1ワイヤの張力を取得し、
     前記弛緩動作中の前記張力に基づいて前記エンドルミナルデバイスの制御パラメータを調整する、制御装置。
  13.  前記エンドルミナルデバイスシステムが、前記第1ワイヤの変位を検出する第2センサをさらに備え、
     前記少なくとも1つのプロセッサが、
     前記第2センサによって検出された前記弛緩動作中の前記第1ワイヤの変位を取得し、
     前記弛緩動作中の前記変位に対する前記張力の変化率に基づいて前記制御パラメータを調整する、請求項12に記載の制御装置。
  14.  前記エンドルミナルデバイスが、可動部を備え、
     前記少なくとも1つのプロセッサが、前記可動部の動きを伴わない前記弛緩動作を前記駆動装置に実行させる、請求項13に記載の制御装置。
  15.  前記エンドルミナルデバイスシステムが複数の前記第1ワイヤを備え、前記可動部が湾曲部であり、前記複数の第1ワイヤが前記湾曲部に連結され、
     前記少なくとも1つのプロセッサが、
     前記弛緩動作の実行の前に、前記複数の第1ワイヤのうち前記湾曲部の湾曲のために牽引されている駆動中の第1ワイヤを認識し、
     前記弛緩動作において、前記駆動中の前記第1ワイヤと、該駆動中の第1ワイヤと対抗する前記第1ワイヤとを同時に弛緩させる、請求項14に記載の制御装置。
  16.  エンドルミナルデバイスの制御方法であって、該エンドルミナルデバイス内に該エンドルミナルデバイスの長手方向に可撓性の第1ワイヤが配置され、
     牽引されている前記第1ワイヤを弛緩させる弛緩動作を実行し、
     前記弛緩動作中の前記第1ワイヤの張力を取得し、
     前記弛緩動作中の前記張力に基づいて前記エンドルミナルデバイスの制御パラメータを調整する、制御方法。
  17.  前記弛緩動作の前記第1ワイヤの変位を取得し、
     前記弛緩動作中の前記変位に対する前記張力の変化率に基づいて前記制御パラメータを調整する、請求項16に記載の制御方法。
  18.  前記エンドルミナルデバイスが、可動部を備え、
     前記可動部の動きを伴わない前記弛緩動作を実行する、請求項17に記載の制御方法。
  19.  前記エンドルミナルデバイスが複数の前記第1ワイヤを備え、前記可動部が湾曲部であり、前記複数の第1ワイヤが前記湾曲部に連結され、
     前記弛緩動作の実行の前に、前記複数の第1ワイヤのうち前記湾曲部の湾曲のために牽引されている駆動中の第1ワイヤを認識し、
     前記駆動中の前記第1ワイヤと、該駆動中の第1ワイヤと対抗する前記第1ワイヤとを同時に弛緩させることによって前記可動部の動きを伴わない前記弛緩動作を実行する、請求項18に記載の制御方法。
  20.  前記エンドルミナルデバイスが、複数の前記第1ワイヤを備え、前記可動部が湾曲部であり、前記複数の前記第1ワイヤが前記湾曲部に連結され、
     前記弛緩動作の実行の前に、前記複数の第1ワイヤのうち前記湾曲部の湾曲のために牽引されている駆動中の第1ワイヤを認識し、
     前記駆動中の第1ワイヤ以外のいずれかの前記第1ワイヤを弛緩させることによって前記可動部の動きを伴わない前記弛緩動作を実行する、請求項18に記載の制御方法。
PCT/JP2022/007493 2022-02-24 2022-02-24 エンドルミナルデバイスシステム、制御装置および制御方法 WO2023162066A1 (ja)

Priority Applications (2)

Application Number Priority Date Filing Date Title
PCT/JP2022/007493 WO2023162066A1 (ja) 2022-02-24 2022-02-24 エンドルミナルデバイスシステム、制御装置および制御方法
US18/219,318 US20240099553A1 (en) 2022-02-24 2023-07-07 Endoluminal device system, control device, and control method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2022/007493 WO2023162066A1 (ja) 2022-02-24 2022-02-24 エンドルミナルデバイスシステム、制御装置および制御方法

Related Child Applications (1)

Application Number Title Priority Date Filing Date
US18/219,318 Continuation US20240099553A1 (en) 2022-02-24 2023-07-07 Endoluminal device system, control device, and control method

Publications (1)

Publication Number Publication Date
WO2023162066A1 true WO2023162066A1 (ja) 2023-08-31

Family

ID=87764980

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2022/007493 WO2023162066A1 (ja) 2022-02-24 2022-02-24 エンドルミナルデバイスシステム、制御装置および制御方法

Country Status (2)

Country Link
US (1) US20240099553A1 (ja)
WO (1) WO2023162066A1 (ja)

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009131374A (ja) * 2007-11-29 2009-06-18 Olympus Medical Systems Corp 処置具システムおよびマニピュレータシステム
JP2009261568A (ja) * 2008-04-24 2009-11-12 Fujinon Corp 内視鏡
JP2015024032A (ja) * 2013-07-26 2015-02-05 オリンパス株式会社 マニピュレータシステム
JP2015163413A (ja) * 2014-02-28 2015-09-10 オリンパス株式会社 マニピュレータのキャリブレーション方法、マニピュレータ、およびマニピュレータシステム

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009131374A (ja) * 2007-11-29 2009-06-18 Olympus Medical Systems Corp 処置具システムおよびマニピュレータシステム
JP2009261568A (ja) * 2008-04-24 2009-11-12 Fujinon Corp 内視鏡
JP2015024032A (ja) * 2013-07-26 2015-02-05 オリンパス株式会社 マニピュレータシステム
JP2015163413A (ja) * 2014-02-28 2015-09-10 オリンパス株式会社 マニピュレータのキャリブレーション方法、マニピュレータ、およびマニピュレータシステム

Also Published As

Publication number Publication date
US20240099553A1 (en) 2024-03-28

Similar Documents

Publication Publication Date Title
US20230072380A1 (en) Tension control in actuation of jointed instruments
JP7403513B2 (ja) マルチジョイント医療器具の作動における張力制御
JP4914735B2 (ja) 処置具の位置制御を行う内視鏡システム
US10155316B2 (en) Manipulator-calibrating method, manipulator, and manipulator system
US8523765B2 (en) Medical control apparatus
US10849699B2 (en) Control apparatus for a continuum robot system
JP5936607B2 (ja) 位置測定を備える医療機器における駆動力制御
US9452276B2 (en) Catheter with removable vision probe
JP6234643B2 (ja) 医療システム及びその作動方法
CN107252517B (zh) 导管系统
US11478306B2 (en) Shape acquiring method and controlling method for medical manipulator
JP2009516574A (ja) 曲げ可能な装置の形状を決定する方法
JP2009247619A (ja) 医療用マニピュレータシステム
US11076746B2 (en) Flexible tube insertion apparatus and flexible tube insertion method
WO2023162066A1 (ja) エンドルミナルデバイスシステム、制御装置および制御方法
WO2019003272A1 (ja) 可撓管挿入装置、挿入制御装置及び挿入制御プログラム
JP5841366B2 (ja) 医療装置
WO2019171471A1 (ja) 可撓管挿入装置、剛性制御装置、剛性制御装置の作動方法、及び剛性制御プログラムを記録した記録媒体
US20180049831A1 (en) Medical manipulator system
WO2022172697A1 (ja) マニピュレータシステムおよびマニピュレータの制御装置
WO2023150761A1 (en) Methods, apparatus and systems for manipulating a medical device
JP6113376B2 (ja) 医療用マニピュレータシステム
CN115990043A (zh) 挠性管的滞后补偿控制装置及其方法

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 22928596

Country of ref document: EP

Kind code of ref document: A1