Control system for continuum robot, and control method for same

The control system for continuum robots addresses stability issues by using coupled control units and dampers to manage tension fluctuations between sections, ensuring stable operation and accurate positioning despite changes in frictional forces.

WO2024242034A1PCT designated stage expired Publication Date: 2024-11-28CANON KK
View PDF 5 Cites 0 Cited by

Patent Information

Application Number
PCT/JP2024/018252
Authority / Receiving Office
WO · WO
Patent Type
Applications
Current Assignee / Owner
Priority Date
2023-05-24
Filing Date
2024-05-17
Publication Date
2024-11-28

AI Technical Summary

Technical Problem

Continuum robots with multiple curved sections face stability issues due to coupling between sections, leading to decreased control system stability, especially when frictional forces change, causing instability in motion control.

Method used

A control system that includes a coupled control unit to manage the operation of actuators for each curved section, using a second wire driving mechanism to suppress tension fluctuations in other sections, and employing a coupled control damper or actuator to stabilize the system by controlling the displacement of wire gripping parts, thereby reducing the influence of one section's motion on others.

Benefits of technology

The solution effectively stabilizes the control system of continuum robots with multiple curved sections by suppressing coupling effects, maintaining high backdrivability and positioning accuracy even under varying friction conditions.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure JP2024018252_28112024_PF_FP_ABST
    Figure JP2024018252_28112024_PF_FP_ABST
Patent Text Reader

Abstract

A control system 10 for a continuum robot 100 comprises: a bendable part that is provided with a plurality of curved sections driven by a wire; and a wire driving means for driving the wire in each of the plurality of curved sections. The control system has: a position control unit KSV, a generative force calculation unit -Kt2, and a force control unit KF that are control means for controlling the operation of the wire driving means in each of the plurality of curved sections; and a coupled control unit KD that is one configuration of, when the wire driving means is operated in one curved section among the plurality of curved sections, a suppression means for suppressing the fluctuation in the tension of the wire in the other curved sections.
Need to check novelty before this filing date? Find Prior Art

Description

Continuum robot control system and control method

[0001] The present invention relates to a control system and a control method for a continuum robot.

[0002] Continuum robots, also known as continuum robots, have a flexible bendable section consisting of multiple curved sections, and their shape is controlled by deforming the bendable section. These robots have two main advantages over robots composed of rigid links (hereinafter referred to as "rigid-link robots"). The first advantage is that continuum robots can move along the curves of objects in narrow spaces or cluttered environments where rigid-link robots can get stuck. The second advantage is that continuum robots are inherently flexible, allowing them to manipulate fragile objects without damaging them. Therefore, external force detection, which is required for rigid-link robots, is not necessarily required.

[0003] Taking advantage of this characteristic, continuum robots are expected to be applied in the medical field, such as in endoscopic sheaths and catheters, and in extreme work robots such as rescue robots. Furthermore, backdrivability is when a drive unit operates passively according to the load, and there are continuum robots that have high backdrivability due to their mechanisms and control algorithms.

[0004] Patent Document 1 derives a dynamic model of a continuum robot including a wire drive unit capable of detecting the tension of a wire that bends a bendable portion by driving it. Patent Document 1 also realizes a double-loop control system in which an inner-loop control system performs force control on the continuum robot and an outer-loop control system performs position control on the continuum robot. As a result, Patent Document 1 realizes a continuum robot that has high backdrivability against disturbances at the tip of the continuum robot and is also capable of positioning to a target position.

[0005] Japanese Patent Application Laid-Open No. 2021-133429

[0006] In Patent Document 1, the stability of the feedback system is ensured in the force control system and position control system by using a transfer function obtained from a dynamic model of the continuum robot. In this case, Patent Document 1 models a continuum robot having a single curved section. When Patent Document 1 is applied to a continuum robot having multiple curved sections, a distributed backdrivable control system is used in which the above-mentioned control system is applied to each curved section.

[0007] However, a continuum robot having a bendable section made up of multiple bendable sections has coupling between the bendable sections, in which the movement of one bendable section affects the movement of the other bendable sections. Patent Document 1 does not take into consideration this coupling between the bendable sections, which poses a problem that the stability of the control system of the continuum robot decreases due to changes in the shape of the continuum robot or changes in the mechanism, such as an increase or decrease in friction elements.

[0008] The present invention has been made in consideration of such problems, and aims to provide a technique that can suppress a decrease in the stability of the control system of a continuum robot.

[0009] The control system for a continuous body robot of the present invention is a control system for a continuous body robot that includes a bendable section having a plurality of bending sections driven by wires, and a wire driving means that drives the wire for each bending section among the plurality of bending sections, and includes a control means that controls the operation of the wire driving means for each bending section among the plurality of bending sections, and a suppression means that suppresses fluctuations in the tension of the wire in other bending sections when the wire driving means is operated in a bending section among the plurality of bending sections.

[0010] According to the present invention, it is possible to suppress a decrease in stability of the control system of a continuum robot.

[0011] FIG. 1 is a diagram showing an example of a schematic configuration of a continuum robot according to the first embodiment. FIG. 2 is a diagram showing an example of a schematic configuration of a control system for a continuum robot according to the first embodiment. FIG. 3 is a diagram showing an example of a schematic configuration of a continuum robot according to the second embodiment. FIG. 4 is a diagram showing an example of a schematic configuration of a continuum robot according to the third embodiment. FIG. 5 is a diagram showing an example of a dynamic model of a continuum robot (continuum part) according to the third embodiment. FIG. 6 is a diagram showing an example of a model consisting of a rotary motor, a rotary-linear motion conversion mechanism, and a wire gripping mechanism in a continuum robot according to the third embodiment. FIG. 7 is a diagram showing an example of a configuration of a continuum robot according to the third embodiment, in which the dynamic model of the continuum part shown in FIG. 5 is combined with a model consisting of a rotary motor, a rotary-linear motion conversion mechanism, and a wire gripping mechanism shown in FIG. 6A. In a continuum robot according to the third embodiment, c w21 = c w22 10 is a diagram illustrating an example of a frequency response when c = 0 Ns / m in the continuum robot according to the third embodiment. w21 = c w22 10 is a diagram illustrating an example of a frequency response when c = 0 Ns / m in the continuum robot according to the third embodiment. w21 = c w22 10 is a diagram showing an example of a frequency response when c = 150 Ns / m in the continuum robot according to the third embodiment. w21 = c w22 10 is a diagram showing an example of a frequency response when K = 150 Ns / m in the control system for a continuum robot according to the fourth embodiment. p 2.2.10 -3 Then, F zi 1.0 and the control band is about 10 Hz. In the control system for a continuous object robot according to the fourth embodiment, a diagram plotting the change in the eigenvalue of the closed loop system is shown. In the control system for a continuous object robot according to the fourth embodiment, the suboptimal damping coefficient of the coupled control damper is set to c w21 = c w2210 is a diagram showing an example of a frequency response of a continuum robot when the suboptimal damping coefficient of the coupled control damper is set to c = 25 Ns / m in the control system for a continuum robot according to the fourth embodiment. w21 = c w22 10 is a diagram showing an example of a frequency response of a continuum robot when K = 25 Ns / m in the control system for a continuum robot according to the fourth embodiment. p 5-10 3 Then, F zi is set to 0.5, and F zd 100. A Bode plot of a position control unit when is set to 100. A diagram showing a simulation response in the control system for a continuum robot according to a fourth embodiment, with a suboptimal model indicated by a solid line, a low damping model indicated by a dashed line, and a high damping model indicated by a dashed line. A diagram showing a simulation response in the control system for a continuum robot according to a fourth embodiment, with a suboptimal model indicated by a solid line, a low damping model indicated by a dashed line, and a high damping model indicated by a dashed line. A diagram showing a simulation response in the control system for a continuum robot according to a fourth embodiment, with a suboptimal model indicated by a solid line, a low damping model indicated by a dashed line, and a high damping model indicated by a dashed line. A diagram showing a simulation response in the control system for a continuum robot according to a fourth embodiment, with a suboptimal model indicated by a solid line, a low damping model indicated by a dashed line, and a high damping model indicated by a dashed line. A diagram showing a simulation response in the control system for a continuum robot according to a fourth embodiment, with a suboptimal model indicated by a solid line, a low damping model indicated by a dashed line, and a high damping model indicated by a dashed line. FIG. 10 is a diagram showing the simulation response of the control system for a continuum robot according to the fourth embodiment, with a suboptimal model shown by a solid line, a low damping model shown by a dashed line, and a high damping model shown by a dotted line.

[0012] DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS Hereinafter, embodiments of the present invention will be described with reference to the drawings.

[0013] First Embodiment First, the first embodiment will be described.

[0014] [1] Configuration of the continuum robot Fig. 1 is a diagram showing an example of the schematic configuration of a continuum robot 100 according to the first embodiment. In the following description, the continuum robot 100 according to the first embodiment shown in Fig. 1 will be referred to as "continuum robot 100-1."

[0015] As shown in FIG. 1 , the continuum robot 100-1 includes a base 140 and a bendable section 170. The bendable section 170 is a component (a component having multiple bendable sections) that includes multiple bendable sections 171-172 that are bent by driving wires. The base 140 supports the bendable section 170, and includes actuators 131 and 132 that act as wire driving means for driving the wires 111-112 of the bendable sections 171-172. While FIG. 1 illustrates an example in which the multiple bendable sections provided in the bendable section 170 include two bendable sections, a first bendable section 171 and a second bendable section 172, this is not a limitation of the present embodiment. For example, a configuration in which the multiple bendable sections provided in the bendable section 170 include three or more bendable sections is also applicable to the present embodiment.

[0016] 1, an origin O is set at a predetermined position on the top surface 141 of the base 140. In the continuum robot 100-1, an xz coordinate system is illustrated, in which the forward direction is set as the z direction of the coordinate system and a predetermined direction perpendicular to the z direction is set as the x direction of the coordinate system.

[0017] The wire 111 is connected to a connection portion 121 at the distal end 163 of the first curved section 171. The posture (curved shape) of the continuum robot 100-1 is controlled by pushing and pulling the wire 111 with an actuator 131 installed inside the base portion 140. Here, the actuator 131 is a wire driving means for driving the wire 111.

[0018] The wire 112 is connected to the connection portion 122 at the distal end 160 of the second curved section 172. The posture (curved shape) of the continuum robot 100-1 is controlled by pushing and pulling the wire 112 with an actuator 132 installed inside the base portion 140. Here, the actuator 132 is a wire driving means for driving the wire 112.

[0019] The continuum robot 100-1 has wire guides 164 and 165, which are members for guiding the wire 111 and the wire 112, in the first curved section 171. The continuum robot 100-1 also has wire guides 161 and 162, which are members for guiding the wire 112, in the second curved section 172. The distal end and wire guides 160 to 165 are fixed to the spine 113. Note that the continuum robot 100-1 is configured such that a plurality of members, including the distal end and wire guides 160 to 165, are discretely arranged, but other continuum robots such as bellows-shaped or mesh-shaped members may also be used.

[0020] In addition, in the internal mechanism of the base unit 140 in the first curved section 171 driven by the wire 111, a wire gripping section 212 that grips the wire 111 and a spring 211 are interposed between the wire 111 and the actuator 131. Similarly, in the internal mechanism of the base unit 140 in the second curved section 172 driven by the wire 112, a wire gripping section 222 that grips the wire 112 and a spring 221 are interposed between the wire 112 and the actuator 132.

[0021] Displacement z of the actuator 131 in the first curved section 171 t11 , and the displacement z of the wire gripping portion 212 t21 These displacements and the spring coefficient k of the spring 211 can be detected by an encoder or the like. t2 Based on this, the wire tension of the wire 111 that drives (bends) the first bending section 171 can be detected. In this case, the spring 211 is one component of a tension detection means for detecting the tension of the wire 111. Similarly, the displacement z of the actuator 132 in the second bending section 172 t12, and the displacement z of the wire gripping portion 222 t22 and the spring coefficient k of the spring 221 t2 Based on this, it is possible to detect the wire tension of the wire 112 that drives (bends) the second bending section 172. In this case, the spring 221 is one component of the tension detection means for detecting the tension of the wire 112.

[0022] Furthermore, in this embodiment, in the internal mechanism of the base unit 140 in the first bending section 171 driven by the wire 111, a coupled control actuator 213 is connected to the wire gripper 212. The surface of this coupled control actuator 213 opposite to the wire 111 side is connected to the base unit 140. Similarly, in this embodiment, in the internal mechanism of the base unit 140 in the second bending section 172 driven by the wire 112, a coupled control actuator 223 is connected to the wire gripper 222.

[0023] In this coupling control actuator 223 , the surface opposite to the wire 112 side is connected to the base portion 140 .

[0024] Next, the coupling between the first curved section 171 and the second curved section 172 will be described.

[0025] For example, as shown in FIG. 1 , when the actuator 132 operates in the forward direction, the second bending section 172 bends, but torque is applied to the distal end 163 of the first bending section 171 via a member such as the spine 113, causing the first bending section 171 to bend at the same time. By subjecting each of the first bending section 171 and the second bending section 172 to position control, they can be bent into any shape, but the wire tensions of the wires 111 and 112 are partially superimposed on each other. In other words, when the actuator 132 is operated, the tension of the wire 111 changes in addition to the tension of the wire 112. Similarly, when the actuator 131 is operated, the tension of the wire 112 changes in addition to the tension of the wire 111. In this embodiment, this is defined as coupling between the bending sections. When a control system is designed by taking into account the wire tension in a single curved section without taking into account the coupling between the curved sections, as in Patent Document 1, and this control system is applied to a continuum robot having multiple curved sections, there is a problem that the stability of the control system changes (decreases). In particular, when the frictional force acting on the driving wire decreases, the coupling between the curved sections increases, making the control system unstable. In this embodiment, the change in the tension of the wire 111 when the actuator 131 is driven and the change in the tension of the wire 112 when the actuator 132 is driven are referred to as direct characteristics.

[0026] [2] Configuration of the control system Figures 2A and 2B are diagrams showing an example of the schematic configuration of the control system 10 of the continuum robot according to the first embodiment. As shown in Figure 2A, the control system 10 of the continuum robot includes, for example, a mechanical unit P of the continuum robot 100-1 shown in Figure 1 (hereinafter simply referred to as "continuum robot 100"), a control device 200 for the continuum robot, and an input device 300.

[0027] As shown in FIG. 2A, the control device 200 for the continuum robot includes a kinematics calculation unit (Kinematics) 210 and controllers 220-1 to 220-n. Here, the controller 220-1 is, for example, a controller corresponding to the first curved section 171 shown in FIG. 1. The controller 220-2 is, for example, a controller corresponding to the second curved section 172 shown in FIG. 1. Furthermore, when three or more curved sections are configured in the continuum robot 100, 220-n is a controller corresponding to a certain curved section among the three or more curved sections. Furthermore, for example, the controller 220-n shown in FIG. 2A includes a position control unit K SV , force control section K F , generated force calculation unit -k t2 , and the coupled control unit K D 2B illustrates the internal configuration of the controller 220-n shown in FIG. 2A, but the controllers 220-1 and 220-2 shown in FIG. 2A also have the same internal configuration as the controller 220-n shown in FIG. 2B. In this case, the internal configurations of the controllers 220-1 and 220-2 shown in FIG. 2A are the same as those of the controller 220-n shown in FIG. 2B, with the symbol "n" changed to the symbol "1" and the symbol "2." Hereinafter, when describing matters common to the controllers 220-1 to 220-n without specifying the controllers 220-1 to 220-n, the term "controller 220" will be used.

[0028] In this embodiment, the controller 220 shown in FIG. 2B includes a force control unit K F The force control for the continuum robot 100 is performed by an inner loop control system (first loop control system) including the force control unit K F and position control unit K SVPosition control of the continuum robot 100 is performed by an outer loop control system (second loop control system) including the inner loop control system (first loop control system) and the outer loop control system (second loop control system). The control system 10 of the continuum robot according to this embodiment is a double loop control system consisting of this inner loop control system (first loop control system) and the outer loop control system (second loop control system). This double loop control system allows the control system 10 of the continuum robot 100 to have high backdrivability, and at the same time, achieves high positioning performance of the bendable section 170 of the continuum robot 100 to a target position.

[0029] Furthermore, in this embodiment, in the controller 220 shown in FIG. 2B, in order to improve the stability of the control system due to the coupling between the curved sections described above (suppress the deterioration of stability), a coupling control unit K D For example, the coupling control unit K D provides a control input to the coupling control actuator 213 in order to suppress a decrease in stability of the control system due to the coupling between the curved sections. D provides a control input to the coupling control actuator 223 in order to suppress a decrease in the stability of the control system due to the coupling between the curved sections described above.

[0030] Next, a specific signal flow in the control system 10 for the continuum robot will be described.

[0031] The kinematics calculation unit 210 shown in FIG. 2A receives the target bending angle ref for each bending section of the continuum robot 100 from the input device 300. θ1 ~ref θn When the input is received, the kinematics calculation unit 210 performs kinematics calculation. Then, the kinematics calculation unit 210 calculates the target displacement ref of the push-pull drive of the wires 111, 112, ... by the actuators 131, 132, ... of the continuum robot 100. z1 ~ref zn are output to the corresponding controllers 220-1 to 220-n.

[0032] The position control unit K shown in FIG. SV is the target displacement ref output from the kinematics calculation unit 210 zand the actuator displacement z t1 The control is to compensate for the error between the target tension of the wire and the target generated force ref F Here, the target generated force ref F represents the target value of the generated force F, which is the positive / negative inverted value of the wire tension sensor defined in this embodiment.

[0033] The generated force calculation unit -k shown in FIG. t2 is the displacement z of the wire gripping part t2 and the actuator displacement z t1 The difference between the spring constant k and the spring constant k t2 The force control unit K shown in FIG. F is the position control unit K SV The target generated force ref output from F and the generated force calculation unit -k t2 The control is performed to compensate for the error between the generated force F output from the wire drive means and the target torque u of the actuator. c Output.

[0034] The feedback loop control system in the control device 200 of the continuum robot shown in Figure 2A is equivalent to compensating for the equivalent inertia of the rotary-to-linear motion conversion mechanism, thereby making it possible to improve the backdrivability of the continuum robot 100.

[0035] Furthermore, in this embodiment, the controller 220 shown in FIG. 2B controls the displacement z of the wire gripping part independently of the first and second loop control systems. t2 A coupled control unit K controls the operation of the coupled control actuator based on D In this third loop control system, a coupling control unit K D is the displacement z of the wire gripping part t2 is used as the input signal, and the coupled control actuator receives the control input u d By giving t2 Suppress.

[0036] For example, the third loop control system is a coupled control unit K DWhen direct velocity control using a differentiator is used, a direct velocity feedback control system is configured. In this case, the coupled control actuators 213 and 223 act as dampers, suppressing fluctuations in the tension of the coupled wire 111 when the actuator 132 is operated, and suppressing fluctuations in the tension of the coupled wire 112 when the actuator 131 is operated. In this way, by providing a third loop control system in the controller 220, coupling between the curved sections can be suppressed, and appropriate first and second loop control systems can be designed taking into account only the direct characteristics of each curved section. In addition, the coupled control unit K D The control system may be a control system in which a low-pass filter is connected in series to a differentiator, or may be a PD control system or a PID control system. D The first and second loop control systems may be designed by evaluating the stability of the first and second loop control systems. For the evaluation, a numerical model of the continuum robot 100 may be used, or an experimental system may be directly measured.

[0037] The control system 10 of the continuum robot according to the first embodiment described above has the following configuration. First, the continuum robot 100 includes a bendable section 170 having a plurality of bending sections 171 and 172, and actuators 131 and 132, which are wire driving means for driving the wires 111 and 112, for each bending section of the plurality of bending sections. Also, a position control unit K, which is control means for controlling the operation of the actuators 131 and 132, which are wire driving means, for each bending section of the plurality of bending sections, is provided. SV , generated force calculation unit -k t2 and force control unit K F Furthermore, each of the bending sections among the plurality of bending sections has a suppression means for suppressing fluctuations in the tension of the wire 112 or 111 in the other bending section when the actuator 131 or 132, which is the wire driving means in that bending section, is operated. Specifically, the suppression means in the first bending section 171 includes a coupling control actuator 213, which is the second wire driving means, and a coupling control unit K in the first bending section 171, which is the second control means for controlling the operation of the coupling control actuator 213. DIn this case, the coupling control actuator 213 in the first bending section 171 is connected to a wire gripping section 212 that grips the wire 111 so as to drive the wire 111 without the intervention of a spring 211, which is a tension detection means. D is the displacement z of the wire gripping unit 212, which is the wire gripping means. t21 The operation of the coupling control actuator 213 is controlled based on the above. Similarly, for example, the suppression means in the second bending section 172 is a means for suppressing fluctuations in the tension of the wire 111 in the other bending section 171 when the actuator 132, which is the wire driving means, is operated. Specifically, the suppression means in the second bending section 172 is a coupling control actuator 223, which is the second wire driving means, and a coupling control unit K in the second bending section 172, which is the second control means for controlling the operation of the coupling control actuator 223. D In this case, the coupling control actuator 223 in the second bending section 172 is connected to a wire gripping section 212 that grips the wire 112 so as to drive the wire 112 without the intervention of a spring 221, which is a tension detection means. D is the displacement z of the wire gripping portion 222, which is the wire gripping means. t22 The operation of the coupling control actuator 223 is controlled based on the above.

[0038] According to this configuration, since the suppression means is provided, it is possible to reduce the influence that the movement of one bending section has on the movement of another bending section, and it is possible to suppress coupling between the bending sections.

[0039] Therefore, in a continuum robot 100 having multiple curved sections, it is possible to suppress a decrease in the stability of the control means (control system) that controls the operation of each curved section in the multiple curved sections.

[0040] In this embodiment, the coupling control unit K D The control of the displacement z is based on t21 and displacement z t22is the displacement of the wire gripping portion 212 and the wire gripping portion 222. However, the displacement is not limited to the wire gripping portion as long as it is a portion between the connection portion of the coupled control actuator 213 and the spring 211, which is the tension detection means, and a portion between the connection portion of the coupled control actuator 223 and the spring 221, which is the tension detection means.

[0041] Furthermore, although an example has been given in which the coupled control actuator is connected to the wire gripping means, the object to which the coupled control actuator is connected can be replaced with the wire gripping means as long as it is a means for connecting the wire and the tension detection means.

[0042] Second Embodiment Next, a second embodiment will be described. In the following description of the second embodiment, matters common to the first embodiment will be omitted, and only matters different from the first embodiment will be described.

[0043] In the control system 10 for the continuous object robot according to the first embodiment described above, as suppression means for suppressing coupling between curved sections, coupling control actuators 213 and 223 which are second wire driving means, and a coupling control unit K which is second control means are used. D In contrast to this, in the control system 10 of the continuum robot according to the second embodiment, a coupling control damper connected to the wire gripping units 212 and 222 is provided in the continuum robot 100 as a suppression means for suppressing coupling between the curved sections.

[0044] Fig. 3 is a diagram showing an example of a schematic configuration of a continuum robot 100 according to the second embodiment. In the following description, the continuum robot 100 according to the second embodiment shown in Fig. 3 will be referred to as a "continuum robot 100-2." In Fig. 3, the same components as those shown in Fig. 1 are denoted by the same reference numerals, and detailed description thereof will be omitted.

[0045] In the continuous body robot 100-2 shown in FIG. 3, a coupled control damper 513 connected to the wire gripper 212 is provided as a suppression means in the first curved section 171. The side of this coupled control damper 513 opposite to the side of the wire gripper 212 is connected to the base 140. In addition, in the continuous body robot 100-2 shown in FIG. 3, a coupled control damper 523 connected to the wire gripper 222 is provided as a suppression means in the second curved section 172. The side of this coupled control damper 523 opposite to the side of the wire gripper 222 is connected to the base 140. These coupled control dampers 513 and 523 are the same as those of the coupled control unit K in the first embodiment. D In this case, the damping coefficients of the coupled control dampers 513 and 523 may be set by direct measurement, or may be set using a numerical model (dynamic model) of the continuum robot 100-2.

[0046] In the second embodiment, as in the first embodiment, in a continuum robot 100 having multiple curved sections, it is possible to suppress a decrease in the stability of the control means (control system) that controls the operation of each curved section in each of the multiple curved sections.

[0047] Third Embodiment Next, a third embodiment will be described. In the following description of the third embodiment, matters common to the first and second embodiments will be omitted, and only matters different from the first and second embodiments will be described.

[0048] In the control system 10 of the continuous object robot according to the first embodiment described above, the coupled control actuators 213 and 223 are provided on the wire grippers 212 and 222, respectively. In the control system 10 of the continuous object robot according to the second embodiment described above, the coupled control dampers 513 and 523 are provided on the wire grippers 212 and 222, respectively. In contrast, in the control system 10 of the continuous object robot according to the third embodiment, the coupled control actuators or coupled control dampers are provided on the wires.

[0049] 4A and 4B are diagrams showing an example of a schematic configuration of a continuum robot 100 according to the third embodiment. In the following description, the continuum robot 100 according to the first example of the third embodiment shown in FIG. 4A will be referred to as "continuum robot 100-31," and the continuum robot 100 according to the second example of the third embodiment shown in FIG. 4B will be referred to as "continuum robot 100-32."

[0050] In addition, in FIGS. 4A and 4B, the same components as those shown in FIGS. 1 and 3 are denoted by the same reference numerals, and detailed description thereof will be omitted.

[0051] In the continuum robot 100-31 shown in Fig. 4A, a coupled control actuator 713 is provided on the wire 111 in the first curved section 171, and a coupled control actuator 723 is provided on the wire 112 in the second curved section 172. In this robot, the coupled control actuator 713 is provided instead of the coupled control actuator 213 of the continuum robot 100-1 shown in Fig. 1, and the coupled control actuator 723 is provided instead of the coupled control actuator 223 of the continuum robot 100-1 shown in Fig. 1.

[0052] In the continuum robot 100-32 shown in Fig. 4B, a coupled control damper 813 is provided on the wire 111 in the first curved section 171, and a coupled control damper 823 is provided on the wire 112 in the second curved section 172. This is the same as the continuum robot 100-2 shown in Fig. 3, except that the coupled control damper 813 is provided instead of the coupled control damper 513, and the coupled control damper 823 is provided instead of the coupled control damper 523 of the continuum robot 100-2 shown in Fig. 3.

[0053] As in the first embodiment described above, the coupling control unit K of the coupling control actuators 713 and 723 shown in FIG. Dmay be designed by evaluating the stability of the first and second loop control systems. For this evaluation, a numerical model of the continuum robot 100 may be used, or an experimental system may be directly measured. In this embodiment, the damping coefficients of the coupled control dampers 813 and 823 shown in FIG. 4B are designed using a dynamic model of the continuum robot 100. Details thereof will be described below. In this embodiment, the first curved section 171 and the second curved section 172 are also referred to as a first curved section 171 and a second curved section 172.

[0054] [1] Modeling of the continuum robot 100 Fig. 5 is a diagram showing an example of a dynamic model of the continuum robot 100 (continuum part) according to the third embodiment. The definitions of symbols in the dynamic model of the continuum robot 100 (continuum part) shown in Fig. 5 are as follows: θ n :Bending angle of the continuum robot m sn : Mass of the continuum part k bn : Spring constant z for the curved angle of the continuum part wn : Displacement of wire equivalent mass z pn : Displacement of the pipe held by the wire m wn : Mass of wire m pn : Mass of wire-held pipe k wn , k w3n : Spring constant of the wire c wn , c w3n : damping coefficient of the wire c w2n : damping coefficient of coupled control damper

[0055] Here, the number of curved sections n=2 (first curved section 171 and second curved section 172) and the equation of motion of the continuum robot 100 are derived. In this embodiment, the following assumptions are made: <1> Only motion within a two-dimensional plane (xz plane) is considered. <2> The curvature of the continuum part is assumed to be constant and the spring coefficient is assumed to be uniform. <3> The wire is approximated as a concentrated mass system, and a reaction force due to deformation in the longitudinal direction acts on the tip of the continuum part. Lateral vibration and lateral deformation of the wire are not considered. <4> The friction between the wire and the wire guide, and between the wire and the diameter conversion part is assumed to be viscous damping including nonlinear friction such as Coulomb friction, with a damping coefficient c w2 Can be pushed into.

[0056] First, the kinetic energy of the continuum part is calculated. The first curved section 171 is displaced x on the central axis of the continuum part. g1 , z g1 Taking the displacement x g1 and z g1 are expressed by the following equations (1) and (2), respectively.

[0057]

[0058] Furthermore, since the following equation (3) holds, the above equations (1) and (2) become the following equations (4) and (5), respectively.

[0059]

[0060] The second curved section 172 is displaced x on the central axis of the continuum portion. g2 , z g2 Taking the displacement x g2 and z g2 is expressed as the following equation (6).

[0061]

[0062] Furthermore, since the following equation (7) holds, the above-mentioned equation (6) becomes the following equation (8).

[0063]

[0064] In this embodiment, a zero-degree vicinity linearized model that does not take large deformation into consideration is obtained. From the above-described formulas (4) and (5), the first curved section 171 is expressed by the following formula (9).

[0065]

[0066] For the second curved section 172, the first curved section 171 is first approximated to near zero degrees from the above-mentioned equation (8), resulting in the following equation (10).

[0067]

[0068] Next, when the second curved section 172 is approximated to be near zero degrees, the following equation (11) is obtained.

[0069]

[0070] As a result, the second curved section 172 is expressed by the following equations (12) and (13).

[0071]

[0072] Here, the kinetic energy T a0 is expressed as the following equation (14).

[0073]

[0074] In addition, the potential energy U a is the following equation (15).

[0075]

[0076] Next, the kinetic energy T of the wire and the wire-holding pipe w and potential energy U w is the wire driving amount l p1 =r 1 θ 1 , l p2 =r 2 θ 2 Therefore, the following equations (16) and (17) are obtained.

[0077]

[0078] Consider determining the equation of motion from Lagrange's equation shown in the following equation (18).

[0079]

[0080] Then, the equation of motion becomes the following equation (19).

[0081]

[0082] [2] Model consisting of a rotary motor, a rotary-to-linear motion conversion mechanism, and a wire gripping mechanism Figure 6A is a diagram showing an example of a model consisting of a rotary motor, a rotary-to-linear motion conversion mechanism, and a wire gripping mechanism in the continuum robot 100 according to the third embodiment. The wire gripping mechanism has the function of detecting the tension of the wire. A wire gripping mechanism base is provided between the wire gripping mechanism and the actuator, and the wire gripping mechanism base is connected to the actuator, and a spring connects the wire gripping mechanism base and the wire gripping mechanism. The tension of the wire is detected by detecting the displacement of the spring. Symbols are defined below. Note that a subscript n is added to the end of all of the following symbols to indicate the nth curved section, but this is omitted in the text. J m : Motor inertia θ m : Motor rotation angle T m : Motor torque command c m : damping coefficient of motor shaft k g , c g : Spring coefficient and damping coefficient of the coupling J n : Inertia of drive shaft θ n : rotation angle of drive shaft c n : damping coefficient of the drive shaft p: screw pitch of the drive shaft R: ​​conversion coefficient of the linear motion rotation conversion mechanism, which is the equivalent speed increase ratio m t1 : Mass of the wire gripping mechanism base k t1 : Spring constant of the drive shaft in the z direction c t1 : damping coefficient of the linear slider of the wire gripping mechanism base z t1 : Displacement of the wire gripping mechanism base m t2 : Mass of wire gripping mechanism k t2 , c t2 : Spring constant of tension detection mechanism z t2 : Displacement of the wire gripping mechanism

[0083] The equations of motion are as follows: (20) to (23).

[0084]

[0085] In the above equations (21) and (22), R=p / 2π. l =[θ m , θ n , zt1 , z t2 ] T When expressed in matrix notation, the following equation (24) is obtained.

[0086]

[0087] Using equation (24), a model consisting of a rotary motor for driving the nth curved section, a rotary-to-linear motion conversion mechanism, and a wire gripping mechanism can be expressed as equation (25) below.

[0088]

[0089] [3] Configuration of the expanded system Fig. 6B is a diagram showing an example of a configuration in which the dynamic model of the continuum part shown in Fig. 5 is combined with the model consisting of the rotary motor, the rotary-to-linear motion conversion mechanism, and the wire gripping mechanism shown in Fig. 6A in the continuum robot 100 according to the third embodiment. In the first curved section 171, the displacement z t21 and the displacement z of the wire-held pipe p1 In the second curved section 172, the displacement z t22 and the displacement z of the wire-held pipe p2 As a result, when an expanded system is constructed from the above-mentioned equations (19) and (24), the equation of motion becomes the following equation (26).

[0090]

[0091] Next, the state equations are expressed as the following equations (27) and (28).

[0092]

[0093] In this embodiment, the displacement z of the wire gripping mechanism base t1n and the displacement z of the wire gripping mechanism t2n  The spring constant k can be measured. t2n The force generated by the force F acts on the wire gripping mechanism (hereinafter referred to as "generated force") n and the displacement z of the wire gripping mechanism t2n is the observable quantity. Here, the generated force F n is expressed as the following equation (29): n = -kt2n (z t2n -z t1n ) … (29)

[0094] At this time, the observable y g is expressed by the output equation shown in the following equation (30).

[0095]

[0096] [4] Simulation Using the model of the continuum robot 100 shown in Equations (27) and (30), the damping coefficient c of the coupled control damper is calculated. w21 , c w22 The variation of the model in response to the variation of is simulated.

[0097] 7A and 7B show the configuration of the continuum robot 100 according to the third embodiment, w21 = c w22 7A is a diagram showing an example of a frequency response when the control input u of the first curved section 171 is 0 Ns / m. c1 From the above, the generated force F of the wire in the first curved section 171 is 1 The transfer function from 2 7B shows the transfer function of the control input u c2 From the above, the force F generated by the wire in the second curved section 172 is 2 The transfer function from 1 7A and 7B show the frequency response due to coupling between curved sections with dashed lines, and in both cases the phase exceeds 180 degrees around 400 Hz. For example, the force control section K F When a P controller is used, it can be seen that increasing the gain makes the control system unstable due to coupling between curved sections.

[0098] 8A and 8B show the configuration of the continuum robot 100 according to the third embodiment, w21 = c w228A is a diagram showing an example of a frequency response when the control input u of the first curved section 171 is c1 From the above, the generated force F of the wire in the first curved section 171 is 1 The transfer function from 2 The dashed line shows the transfer function of the control input u c2 From the above, the force F generated by the wire in the second curved section 172 is 2 The transfer function from 1 The transfer function up to is shown by a dashed line. From Figures 8A and 8B, it can be seen that the gain characteristics due to coupling between the curved sections are sufficiently lower than the direct gain characteristics. This shows that it is sufficient to design a control system taking into account only the direct frequency response. Furthermore, the direct frequency responses in Figures 8A and 8B are similar, and it can be seen that when performing distributed control using the same controller, there is no significant difference in the curve drive control characteristics of each.

[0099] (Fourth embodiment) Next, a fourth embodiment will be described. In the following description of the fourth embodiment, matters common to the first to third embodiments will be omitted, and only matters different from the first to third embodiments will be described.

[0100] In the third embodiment described above, the responses when the values ​​of the coupled control dampers 813 and 823 are set to zero and when a large value is assigned are compared, and it has been explained that assigning a large value reduces coupling between curved sections. This makes it possible to design a control means (control system) for a single curved section without considering coupling, and to stably design distributed control to be placed in each curved section. In the fourth embodiment, it will be explained that the control performance of the entire control system, including coupling, can be improved by setting appropriate values ​​for the coupled control dampers 813 and 823.

[0101] [1] Design of Control System In the fourth embodiment, as shown in FIG. 2B, a double-loop control system is used to perform force control in an inner loop and position control in an outer loop, and a control system is designed for the continuum robot 100 that has high backdrivability and simultaneously enables positioning. Here, P n represents the expanded system shown in equations (27) and (30). θn is the target command for the bending angle in the nth bending section, ref zn is the target displacement of the wire gripping mechanism in the nth bending section, ref F represents the target value of the generated force F. And the wire driving amount l p The relationship between l and the bending angle θ is given by the following equation (31): p =r 1 θ ... (31)

[0102] In the fourth embodiment, the amount of extension and contraction of the wire is considered to be minute and is not taken into consideration in the derivation of kinematics. zn is given by the following equation (32): zn =r 1 ・ref θn …(32)

[0103] Enlarged P n and force control section K F In the inner loop consisting of F The error is calculated by taking the difference between the generated force F and the force control unit K F is the motor torque T m This feedback loop is equivalent to compensating for the equivalent inertia of the rotary-to-linear motion conversion mechanism, thereby making it possible to improve the backdrivability of the continuum robot 100. In the fourth embodiment, the force control unit K F A PI control system shown in the following equation (33) is used.

[0104]

[0105] Here, in equation (33), F ziis the zero crossing frequency of the integral controller. In addition, a second-order low-pass filter with a corner frequency of 30 Hz is connected to the PI control system for stabilization against higher modes. FIG. 9 shows the control system 10 for a continuum robot according to the fourth embodiment, in which K p 2.2.10 -3 Then, F zi is set to 1.0, and the control band is set to about 10 Hz. F 1 is a Bode plot of

[0106] Next, let P be the state space model of the continuum robot 100 shown in equations (27) and (30), and then define the closed loop system G shown in equation (34) below. cl Ask for.

[0107]

[0108] The damping coefficient c of the coupled control damper 813 is w21 and the damping coefficient c of the coupled control damper 823 w22 The eigenvalues ​​of the closed-loop system are calculated while varying the complex number from 0 Ns / m to 150 Ns / m in increments of 1 Ns / m. FIG. 10 is a plot of the changes in the eigenvalues ​​of the closed-loop system in the control system 10 for a continuum robot according to the fourth embodiment. The eigenvalues ​​of the system become more stable as the real part of the complex number decreases, but some poles do not monotonically decrease as the damping coefficient of the coupled control damper increases. This indicates that there is an optimal value for the damping coefficient of the coupled control damper for stabilizing the closed-loop system. In the fourth embodiment, the locus of the roots that draws the largest arc shown in FIG. 10 is focused on, and the damping coefficient of the coupled control damper that takes the pole that minimizes the value of the real part of the locus is defined as the suboptimal damping coefficient.

[0109] 11A and 11B are diagrams showing the control system 10 for a continuous object robot according to the fourth embodiment, in which the suboptimal damping coefficient of the coupled control damper is set to c w21 = c w22 11A is a diagram illustrating an example of the frequency response of the continuum robot 100 when the control input u c1 From the above, the generated force F of the wire in the first curved section 171 is 1The transfer function from 2 The transfer function for the control input u of the second curved section 172 is shown by the dashed line. c2 From the above, the force F generated by the wire in the second curved section 172 is 2 The transfer function from 1 The transfer function up to is shown by the dashed line.

[0110] 11A and 11B, it can be seen that the gain characteristics due to coupling between the curved sections are sufficiently lower than the direct gain characteristics at 100 Hz or higher where the phase approaches 180 degrees. Furthermore, the direct frequency responses in each of Fig. 11A and Fig. 11B are similar, and it can be seen that there is no significant difference in the curve drive control characteristics when performing distributed control using the same controller.

[0111] In the fourth embodiment, the position control unit K SV A PID control system shown in the following equation (35) is used.

[0112]

[0113] Here, in equation (35), F zi is the zero crossing frequency of the integral controller, and F zd is the zero crossing frequency of the differential controller. In the fourth embodiment, the augmented system P n and force control section K F The closed loop transfer function G cl Using the open loop transfer function G cl K SV is derived, and the response is used to design the system so that the gain margin and phase margin are sufficient. In the fourth embodiment, a first-order low-pass filter with a corner frequency of 50 Hz is connected to the PID control system. FIG. 12 shows the control system 10 for a continuous object robot according to the fourth embodiment, in which K p 5-10 3 Then, F zi is set to 0.5, and F zd is set to 100, the position control unit K SV 1 is a Bode plot of

[0114] [2] Simulation The damping coefficient of the coupled control damper obtained in "[1] Control system design" is c w21 = c w22 A simulation is performed using a model in which c = 25 Ns / m (hereinafter referred to as a "quasi-optimal damping model"). For comparison, the damping coefficient of the coupled control damper calculated in the third embodiment is calculated as w21 = c w22 = 0 Ns / m,c w21 = c w22 A simulation is performed using a model in which the damping force is 150 Ns / m (hereinafter referred to as the "low damping model" and the "high damping model") In this simulation, the control systems shown in Figs. 2A and 2B used in the first embodiment are used, but the coupled control unit K that controls the coupled control actuator is also used. D = 0, and a coupled control damper is used as in the third embodiment. In this simulation, the dynamic model P of the continuum robot 100 includes the coupled control damper.

[0115] In both the first bending section 171 and the second bending section 172, the force control section K F However, since the gains are different between the quasi-optimal model and the high damping model, the gain K of the PI control system is adjusted to have the same servo band. p In addition, in the low damping model, the response diverges in the same servo band as the suboptimal model, so the gain is adjusted so that the control input does not become oscillatory.

[0116] The first curved section 171 is a position control section K SV The PID control system shown in equation (35) is used. In addition, the displacement z of the wire gripping mechanism is controlled so that the bending angle becomes 45 degrees 0.5 seconds after the start of the simulation. t21 Reference command ref z1 Give.

[0117] The position control gain of the second curved section 172 is set to zero. The control problem is then one in which positioning is performed by coupling to the first curved section 171. This is because if a position control system is used for the second curved section 172, the effect of optimizing the designed coupled control damper will not be clear. If the damping of the coupled control damper is appropriate, the second curved section 172 will follow the angle of the first curved section 171 by quickly backdriving. This allows the performance of the coupled control damper to be evaluated over time.

[0118] FIG. 13 shows the simulated response of the control system 10 for the continuum robot according to the fourth embodiment, with a suboptimal model shown in solid lines, a low-damping model shown in dashed lines, and a high-damping model shown in dashed lines. FIG. 13(a) shows the angular response of the distal end of the first curved section 171. Because the first curved section 171 is controlled by a position servo system, there is little difference in response. FIG. 13(b) shows the wire force generated in the first curved section 171 and its reference value in bold and thin lines. In FIG. 13(b), the high-damping model generates a large tension in the wire due to the strong damping force of the coupled control damper. FIG. 13(c) shows the control input for the first curved section 171. In FIG. 13(c), it can be seen that the control input for the low-damping model is somewhat oscillatory. FIG. 13(d) shows the angular response of the distal end of the second curved section 172. In Figure 13(d), the suboptimal model is coupled to the motion of the first curved section 171 and quickly converges to 45 degrees. However, in Figure 13(d), the low-damping model becomes oscillatory, and the high-damping model, due to the strong damping of the coupled control damper, converges slowly to 45 degrees. Figure 13(e) shows the wire force generated in the second curved section 172. In Figure 13(e), the second curved section 172 does not have a positioning loop enabled, so all force reference values ​​are zero. It can also be seen that the response of the suboptimal model quickly converges to zero, achieving high backdrivability. However, the low-damping model becomes oscillatory, and the high-damping model converges slowly due to the strong damping of the coupled control damper. Figure 13(f) shows the control input for the second curved section 172. The high-damping model converges slowly due to its high damping.

[0119] In this way, by using a dynamic model to find the suboptimal value of the coupling control damper, the coupling between the curved sections becomes appropriate, and it can be seen that vibration coupling and response delays due to coupling do not occur.

[0120] (Other Embodiments) The present invention can also be realized by supplying a program that realizes one or more of the functions of the above-described embodiments to a system or device via a network or storage medium, and having one or more processors in the computer of the system or device read and execute the program. It can also be realized by a circuit (e.g., an ASIC) that realizes one or more functions. This program and a computer-readable storage medium storing the program are included in the present invention.

[0121] It should be noted that the above-described embodiments of the present invention are merely illustrative examples of the implementation of the present invention, and the technical scope of the present invention should not be construed as being limited by these. In other words, the present invention can be implemented in various forms without departing from its technical concept or main features.

[0122] Disclosure of embodiments of the present invention includes the following configurations and methods.

[0123] [Configuration 1] A control system for a continuum robot comprising a bendable section provided with a plurality of bending sections driven by wires, and a wire driving means for driving the wires for each of the plurality of bending sections, characterized in having: a control means for controlling the operation of the wire driving means for each of the plurality of bending sections; and a suppression means for suppressing fluctuations in the tension of the wire in other bending sections when the wire driving means is operated in a bending section of the plurality of bending sections.

[0124] [Configuration 2] The control system for a continuum robot according to Configuration 1, wherein the continuum robot further comprises tension detection means interposed between the wire and the wire driving means for each of the plurality of curved sections to detect tension of the wire, and the suppression means includes: second wire driving means that drives the wire without the tension detection means intervening; and second control means that controls operation of the second wire driving means based on displacement of a displacement detection means provided on either the wire extending between the curved section and the tension detection means or on a wire connection section that connects the wire and the tension detection means.

[0125] [Configuration 3] The control system for a continuum robot according to Configuration 2, wherein the second wire driving means is connected to the wire connecting portion.

[0126] [Configuration 4] The control system for a continuum robot according to Configuration 2, wherein the second wire driving means is connected to the wire.

[0127] [Configuration 5] The control system for a continuum robot according to any one of configurations 2 to 4, wherein the second control means is configured as a control system using a differentiator.

[0128] [Configuration 6] The control system for a continuum robot according to Configuration 1, wherein the suppression means is a damper connected to a wire connection portion that connects the wire and the wire driving means.

[0129] [Configuration 7] The control system for a continuum robot according to Configuration 1, wherein the suppression means is a damper connected to the wire.

[0130] [Configuration 8] The control system for the continuum robot according to Configuration 6 or 7, wherein the damping coefficient of the damper is set using a dynamic model of the continuum robot.

[0131] [Method 1] A control method for a continuum robot having a bendable section provided with a plurality of bending sections driven by wires, and a wire driving means for driving the wires for each of the plurality of bending sections, the control method comprising: a control step of controlling the operation of the wire driving means for each of the plurality of bending sections using a control means provided for each of the plurality of bending sections; and a suppression step of suppressing fluctuations in the tension of the wire in other bending sections when the wire driving means is operated in a bending section of the plurality of bending sections using a suppression means.

[0132] The present invention is not limited to the above-described embodiments, and various modifications and variations can be made without departing from the spirit and scope of the present invention. Therefore, the following claims are appended to apprise the public of the scope of the present invention.

[0133] This application claims priority based on Japanese Patent Application No. 2023-085690, filed on May 24, 2023, the entire contents of which are incorporated herein by reference.

[0134] 10 Control system for continuum robot 100 Continuum robot 111, 112 Wire 113 Spine 121, 122 Connection portion 131, 132 Actuator 140 Base portion 141 Upper surface of base portion 140 160, 163 Distal end 161, 162, 164, 165 Wire guide 170 Bendable portion 171, 172 Bendable section 200 Control device for continuum robot 210 Kinematics calculation unit 211, 221 Spring 212, 222 Wire gripping portion 213, 223, 713, 723 Coupled control actuator 220-1 to 220-n Controller 300 Input device 513, 523, 813, 823 Coupled control damper K SV Position control unit K F Force control section -k t2 Generated force calculation unit K D Coupled control section

Claims

1. A control system for a continuum robot comprising a bendable section having a plurality of curved sections driven by a wire, and a wire driving means for driving the wire for each of the plurality of curved sections, characterized in having: a control means for controlling the operation of the wire driving means for each of the plurality of curved sections; and a suppression means for suppressing fluctuations in the tension of the wire in other curved sections when the wire driving means is operated in a curved section of the plurality of curved sections.

2. The control system for a continuum robot as described in claim 1, characterized in that the continuum robot further comprises a tension detection means interposed between the wire and the wire driving means for detecting the tension of the wire in each of the plurality of curved sections, and the suppression means includes: a second wire driving means for driving the wire without the tension detection means; and a second control means for controlling the operation of the second wire driving means based on the displacement of a displacement detection means provided on either the wire extending between the curved section and the tension detection means or on the wire connection section connecting the wire and the tension detection means.

3. The control system for a continuous object robot according to claim 2, characterized in that the second wire driving means is connected to the wire connection portion.

4. The control system for a continuous object robot according to claim 2, characterized in that the second wire driving means is connected to the wire.

5. A control system for a continuum robot according to claim 2, characterized in that the second control means is composed of a control system using a differentiator.

6. The control system for a continuous body robot according to claim 1, wherein the suppression means is a damper connected to a wire connection portion that connects the wire and the wire driving means.

7. The control system for a continuum robot according to claim 1, wherein the suppression means is a damper connected to the wire.

8. The control system for the continuum robot according to claim 6 or 7, characterized in that the damping coefficient of the damper is set using a dynamic model of the continuum robot.

9. A control method for a continuum robot having a bendable section having a plurality of curved sections driven by a wire, and a wire driving means for driving the wire for each of the plurality of curved sections, the control method comprising: a control step of controlling the operation of the wire driving means for each of the plurality of curved sections using a control means provided for each of the plurality of curved sections; and a suppression step of suppressing fluctuations in the tension of the wire in other curved sections when the wire driving means is operated in a curved section of the plurality of curved sections using a suppression means.

Citation Information

Patent Citations

  • Multi-articulated function ropy device

    JP1982168889A

  • Multi-joint manipulator

    JP1985118489A

  • Manipulator control method, manipulator, and manipulator system

    JP2016002414A

  • Continuum robot, method of correcting kinematics of the same, and control method of continuum robot

    JP2018008335A

  • Control system of continuum robot and control method for the same as well as continuum robot

    JP2021133429A