Catheter system, catheter drive control method, and storage medium
By controlling the movement of the external catheter to follow the internal catheter, the problem of the lack of protection and support for the internal catheter is solved, ensuring the normal function of the catheter device and the user experience.
Patent Information
- Application Number
- PCT/CN2024/091428
- Authority / Receiving Office
- WO · WO
- Patent Type
- Applications
- Current Assignee / Owner
- Priority Date
- 2023-05-25
- Filing Date
- 2024-05-07
- Publication Date
- 2024-11-14
AI Technical Summary
The existing internal catheter extends too far outside the lumen of the external catheter, resulting in a lack of necessary protection and support, which affects the function of the catheter device.
By acquiring the current and target distances between the ends of the inner and outer catheters, the outer catheter is controlled to follow the movement of the inner catheter until the current distance reaches a critical threshold, ensuring that the inner catheter receives the necessary protection and support, and that the movement speed of the outer catheter is greater than that of the inner catheter.
To prevent the internal catheter from extending too far outside the lumen of the external catheter, provide necessary protection and support, ensure the normal function of the catheter device, and avoid sudden cessation of the user's field of vision, thereby improving the user experience.
Smart Images

Figure CN2024091428_14112024_PF_FP_ABST
Abstract
Description
Catheter system, catheter drive control method and storage medium
[0001] This application claims priority to Chinese patent application number "2023106009865" filed on May 25, 2023, and invention name "Catheter system, catheter drive control method and storage medium". This application claims priority to Chinese patent application number "2023105283241" filed on May 10, 2023, and invention name "Catheter system, catheter drive control method and storage medium". The entire contents of these texts are incorporated into this application by reference. Technical Field
[0002] The present application belongs to the field of medical device technology, and specifically relates to a catheter system, a catheter drive control method, and a computer-readable storage medium. Background Art
[0003] Minimally invasive medical technology is mainly aimed at reducing damage to patient tissues during medical procedures, and has the advantages of less trauma, less pain, and faster recovery. This minimally invasive technology can be performed through natural orifices or surgical incisions in the patient's anatomical structure, so that the catheter instrument can reach the target tissue location under the control of a controller. The catheter instrument is usually a flexible and / or steerable slender device that can be inserted into an anatomical through-hole and navigated toward the target area within the patient's anatomical structure. The catheter instrument can be divided into an inner catheter instrument with an inner catheter and an outer catheter instrument with an outer catheter, wherein the inner catheter is configured to be driven through the cavity of the outer catheter. In the existing inner and outer catheter instruments, in a non-paired driving mode, only the inner catheter or the outer catheter advances. If the inner catheter extends too far outside the cavity of the outer catheter, the inner catheter will lack the necessary protection and support, thereby affecting the function of the catheter instrument.
[0004] Summary of the Invention
[0005] The main purpose of this application is to provide a catheter system, a catheter drive control method and a computer-readable storage medium, aiming to solve the technical problem that the existing inner catheter extends too far outside the cavity of the outer catheter, resulting in the inner catheter lacking the necessary protection and support, thereby affecting the function of the catheter device.
[0006] To achieve the above-mentioned objectives, the present application provides a catheter system, which includes: a robotic arm; an outer catheter instrument, which is configured to engage with a power unit of one of the robotic arms, the outer catheter instrument including an outer catheter; an inner catheter instrument, which is configured to engage with the power unit of another of the robotic arms, the inner catheter instrument including an inner catheter, and the inner catheter is configured to be driven through the cavity of the outer catheter; a processor communicatively connected to the robotic arm, the processor being configured to perform the following steps: obtaining a current distance between the end of the inner catheter and the end of the outer catheter, and obtaining a target distance between the end of the inner catheter and the end of the outer catheter; when the current distance reaches the target distance, controlling the outer catheter to move following the movement of the inner catheter until the current distance reaches a critical threshold; the critical threshold is the forward distance for controlling the inner catheter to move alone; wherein, the movement speed of the outer catheter is greater than the movement speed of the inner catheter.
[0007] The present application also provides a computer-readable storage medium, wherein the computer-readable storage medium stores computer program instructions, and the computer program instructions are configured to be loaded and executed by a processor to implement the steps of the method described above.
[0008] The catheter system, catheter drive control method, and computer-readable storage medium provided by the present application obtain the current distance and target distance between the ends of the inner and outer catheters. When the current distance reaches the target distance, the outer catheter is controlled to follow the movement of the inner catheter until the current distance reaches the forward distance again. In this way, the inner catheter can be prevented from extending too far outside the cavity of the outer catheter, thereby providing the necessary protection and support for the inner catheter and ensuring the normal function of the catheter device. In addition, the inner catheter does not stop to wait, and the outer catheter moves to follow the movement of the inner catheter, which can avoid the user's field of view from suddenly stopping. This is more in line with the user's field of view habits and thus improves the user experience. BRIEF DESCRIPTION OF THE DRAWINGS
[0009] FIG1 shows a schematic diagram of a catheter system provided by an embodiment of the present application;
[0010] FIG2 shows a schematic diagram of a catheter device and a power unit provided in one embodiment of the present application;
[0011] FIG3 shows a schematic diagram of a catheter device provided in one embodiment of the present application;
[0012] FIG4 is a schematic flow chart showing a method for controlling the driving of a catheter according to an embodiment of the present application;
[0013] FIG5 is a schematic structural diagram showing an inner catheter device and an outer catheter device in a forward movement process according to an embodiment of the present application;
[0014] FIG6 shows a detailed schematic diagram of the process of obtaining the target distance between the inner catheter end and the outer catheter end in step S10 of FIG4 ;
[0015] FIG7 shows a detailed schematic diagram of the process of controlling the outer catheter to follow the movement of the inner catheter in step S20 of FIG4 ;
[0016] FIG8 shows a detailed flow chart of step S202 in FIG7 ;
[0017] FIG9 shows a schematic diagram of a catheter control mode provided by the first embodiment of the present application;
[0018] FIG10 is a schematic flow chart showing a method for driving and controlling a catheter according to a second embodiment of the present application;
[0019] FIG11 is a schematic diagram showing a detailed process of controlling the outer catheter to follow the inner catheter in step S30 of FIG10 and to bend along with the inner catheter when the inner catheter bends;
[0020] FIG12 shows a detailed flowchart of step S302 in FIG11 ;
[0021] FIG13 is a schematic diagram showing a detailed process of obtaining the target bending angle of the outer catheter in step S301 of FIG11 in a first embodiment;
[0022] FIG14 shows a schematic diagram of a detailed process of obtaining the target bending angle of the outer catheter in step S301 of FIG11 according to a second embodiment;
[0023] FIG15 is a schematic diagram showing a detailed process of obtaining the current distance between the inner catheter end and the outer catheter end in step S10 of FIG10 ;
[0024] FIG16 is a schematic flow chart showing a method for driving and controlling a catheter according to a third embodiment of the present application;
[0025] FIG17 shows a schematic diagram of a catheter control mode provided by the second embodiment of the present application;
[0026] FIG18 is a schematic flow chart showing a method for driving and controlling a catheter according to another embodiment of the present application;
[0027] FIG19 shows a detailed flowchart of step S10 in FIG18 ;
[0028] FIG20 is a schematic structural diagram showing an inner catheter device and an outer catheter device in a process of moving forward according to an embodiment of the present application;
[0029] FIG21 is a schematic diagram showing a method of calculating the length LengthControl1In of the controllable section of the inner catheter inside the outer catheter according to an embodiment of the present application;
[0030] FIG22 is a schematic diagram showing another embodiment of the present application, wherein the length LengthControl1In of the controllable section of the inner catheter inside the outer catheter is calculated;
[0031] FIG23 shows a schematic diagram of a detailed process of the first embodiment of step S30 in FIG18 ;
[0032] FIG24 shows a schematic diagram of a detailed flow chart of the second embodiment of step S30 in FIG18 ;
[0033] FIG25 shows a detailed flowchart of step S304 in FIG24 ;
[0034] FIG26 shows a detailed flowchart of step S3041 in FIG25 ;
[0035] FIG27 shows a detailed flowchart of step S3042 in FIG25 ;
[0036] FIG28 shows a schematic diagram of a detailed process of the third embodiment of step S30 in FIG18 ;
[0037] FIG29 shows a detailed flowchart of step S306 in FIG28 ;
[0038] FIG30 shows a detailed flowchart of step S3061 in FIG29 ;
[0039] FIG31 shows a detailed flowchart of step S3062 in FIG29 ;
[0040] FIG32 shows three catheter control modes not involving bending in this application;
[0041] FIG33 shows three catheter control modes involving bending in this application;
[0042] FIG34 shows a schematic structural diagram of a control system of a catheter system provided in one embodiment of the present application;
[0043] FIG35 shows a schematic diagram of a computer-readable storage medium provided in an embodiment of the present application. DETAILED DESCRIPTION
[0044] The following will be combined with the drawings in the embodiments of this application to clearly and completely describe the technical solutions in the embodiments of this application. Obviously, the embodiments described are only part of the embodiments of this application, not all of the embodiments. Based on the embodiments of this application, all other embodiments obtained by ordinary technicians in this field without making creative efforts are within the scope of protection of this application.
[0045] It should be noted that all directional indications in the embodiments of the present application (such as up, down, left, right, front, back, etc.) are only used to explain the relative position relationship, movement status, etc. between the various components under a certain specific posture (as shown in the accompanying drawings). If the specific posture changes, the directional indication will also change accordingly.
[0046] In this application, unless otherwise specified or limited, the terms "connection" and "fixation" should be understood in a broad sense. For example, "fixation" can mean fixed connection, detachable connection, or integration; mechanical connection or electrical connection; direct connection or indirect connection through an intermediate medium; internal communication between two elements or interaction between two elements, unless otherwise specified. For those skilled in the art, the specific meanings of the above terms in this application can be understood according to specific circumstances.
[0047] In addition, the descriptions of "first", "second", etc. in this application are for descriptive purposes only and should not be understood as indicating or implying their relative importance or implicitly indicating the number of the technical features indicated. Therefore, the features defined as "first" or "second" may explicitly or implicitly include at least one of such features. In addition, the technical solutions between the various embodiments can be combined with each other, but this must be based on the fact that they can be implemented by ordinary technicians in this field. When the combination of technical solutions is contradictory or cannot be implemented, it should be deemed that such combination of technical solutions does not exist and is not within the scope of protection required by this application.
[0048] FIG1 shows a catheter system 1000 provided in accordance with an embodiment of the present application. The catheter system 1000 includes an imaging cart 100, a trolley 200 and a user input device 300 connected to the imaging cart 100, a catheter instrument 400 that can be coupled to the trolley 200, a sensor system 500 connected to the trolley 200, and a control system 600 for achieving control between the catheter instrument 400, the user input device 300, the sensor system 500, and the imaging cart 100. The user input device 300 can be connected to the trolley 200 by wire or wirelessly. When the operator performs various procedures on a patient next to the trolley 200, the operator can trigger control instructions by operating the user input device 300, and control the catheter instrument 400 to advance, retract, bend, turn, etc., through the drive of the trolley 200.
[0049] The trolley 200 can typically be moved to the side of the operating table to engage the catheter instrument 400 and, under control instructions, control the catheter instrument 400 to move vertically, horizontally, or in non-vertical and non-horizontal directions, thereby providing a better preoperative preparation angle for the operation of the catheter instrument 400. The control instructions can be instructions triggered by the operator through the user input device 300, or instructions triggered by the operator directly clicking or pressing a button on the trolley 200. Of course, in other embodiments, the control instructions can also be instructions triggered by voice control or a force feedback mechanism.
[0050] As shown in Figure 1, further, the trolley 200 may include a base 210, a sliding seat body 220 that can be lifted and lowered along the base 210, and two mechanical arms 230 fixedly connected to the sliding seat body 220. The mechanical arm 230 may include multiple arm segments connected at a joint, and the multiple arm segments provide the mechanical arm 230 with multiple degrees of freedom, for example, seven degrees of freedom corresponding to seven arm segments. The end of the mechanical arm 230 is equipped with a power unit (not shown in the figure), and the power unit of the mechanical arm 230 is used to engage the catheter instrument 400 and control the end of the catheter instrument 400 to bend and turn accordingly under the driving action of the power unit. Among them, the two mechanical arms 230 can be structures that are exactly the same or partially identical, one mechanical arm 230 is used to engage the inner catheter instrument 410, and the other mechanical arm 230 is used to engage the outer catheter instrument 420. During installation, the outer catheter device 420 may be installed first. After the outer catheter device 420 is installed, the catheter of the inner catheter device 410 is inserted into the lumen of the catheter of the outer catheter device 420 .
[0051] The sensor system 500 has one or more subsystems for receiving information about the catheter device 400. The subsystems may include: a position sensor system; a shape sensor system for determining the position, orientation, speed, velocity, pose, and / or shape of the tip of the catheter device 400 and / or along one or more segments of a catheter that may comprise the catheter device 400; and / or a visualization system for capturing images from a camera at the tip of the catheter device 400.
[0052] The imaging vehicle 100 may be provided with a display system 110 and an irrigation system (not shown). The display system 110 is used to display images or representations of the surgical site and the catheter instrument 400 generated by the subsystems of the sensor system 500. Real-time images of the surgical site and the catheter instrument 400 captured by the visualization system may also be displayed. Preoperative or intraoperative images of the surgical site recorded using imaging technologies such as computed tomography (CT), magnetic resonance imaging (MRI), optical coherence tomography (OCT), and ultrasound may also be used to present preoperative or intraoperative images of the surgical site. The preoperative or intraoperative image data may be presented as two-dimensional, three-dimensional, or four-dimensional (e.g., time-based or rate-based) images and / or as images from a model created based on the preoperative or intraoperative image data set. A virtual navigation image may also be displayed. In the virtual navigation image, the actual position of the catheter instrument 400 is registered with the preoperative image to present a virtual image of the catheter instrument 400 within the surgical site to the operator from the outside.
[0053] The control system 600 includes at least one memory and at least one processor in communication with the robotic arm. It is understandable that the control system 600 can be integrated into the trolley 200 or the imaging trolley 100, or can be independently provided. The control system 600 can support wireless communication protocols such as IEEE 802.11, IrDA, Bluetooth, HomeRF, DECT, and wireless telemetry. The control system 600 can transmit one or more signals instructing the catheter instrument 400 to move, which are used to move the catheter instrument 400 by the power unit. The catheter instrument 400 can extend to a surgical location in the body through an opening in the patient's natural cavity or a surgical incision.
[0054] Furthermore, the control system 600 may include a mechanical control system (not shown) and an image processing system (not shown). The mechanical control system is used to control the movement of the catheter instrument 400 and can therefore be integrated into the trolley 200. The image processing system is used for virtual navigation path planning and can therefore be integrated into the imaging vehicle 100. Of course, the various subsystems of the control system 600 are not limited to the specific ones listed above and can be reasonably configured according to actual circumstances. The image processing system can use the above-mentioned imaging techniques to image the surgical site based on preoperative or intraoperative images of the surgical site. Software, which can also be used in conjunction with manual input, can convert the recorded images into two-dimensional or three-dimensional composite images of a portion or the entire anatomical organ or region. During the virtual navigation procedure, the sensor system 500 can be used to calculate the position of the catheter instrument 400 relative to the patient's anatomy. This position can be used to generate external tracking images and internal virtual images of the patient's anatomy, achieving registration of the actual position of the catheter instrument 400 with the preoperative images, thereby allowing a virtual image of the catheter instrument 400 within the surgical site to be presented to the operator from the outside.
[0055] The inner catheter device 410 and the outer catheter device 420 have substantially the same structural composition, and each comprises a slender and flexible inner catheter 41 and an outer catheter 42, wherein the diameter of the outer catheter 42 is slightly larger than that of the inner catheter 41, so that the inner catheter 41 can pass through the lumen of the outer catheter 42 and provide a certain degree of support for the inner catheter 41, thereby enabling the inner catheter 41 to reach a target location in the patient's body, facilitating operations such as tissue or cell sampling from the target location.
[0056] Certain movements of the user input device 300 can cause corresponding movements of the catheter instrument 400. For example, when the operator manipulates the directional lever of the user input device 300 to move upward or downward, the movement of the directional lever of the user input device 300 can be mapped to a corresponding pitch movement of the distal end of the catheter instrument 400. When the operator manipulates the directional lever of the user input device 300 to move left or right, the movement of the directional lever of the user input device 300 can be mapped to a corresponding yaw movement of the distal end of the catheter instrument 400. In this embodiment, the user input device 300 can control the movement of the distal end of the catheter instrument 400 within a 360-degree spatial range.
[0057] Figures 2 and 3 illustrate a catheter device 400 provided in one embodiment of the present application. The catheter device 400 is configured to engage with the power unit 240 of the robotic arm 230. The catheter device 400 includes an instrument cassette 45 configured to engage with the power unit 240 and a catheter 48 connected to the instrument cassette 45. The term "engagement" refers to a state in which, when the instrument cassette 45 is mounted to the power unit 240, the driving force of the power unit 240 can be transmitted to the instrument cassette 45 and cause the catheter 48 to move normally. For example, under the driving force of the power unit 240, the distal end of the catheter 48 can bend, turn, or the like.
[0058] The instrument box 45 includes a plurality of drive wheels 451 configured to be driven by the power unit 240 and a plurality of drive wires 452. The power unit 240 includes a plurality of drive motors 241. The drive motors 241, the drive wheels 451, and the drive wires 452 are arranged in a one-to-one correspondence. Each drive wheel 451 is configured to engage with a corresponding drive motor 241. That is, when the instrument box 45 is installed in the power unit 240, the corresponding drive motor 241 can drive the drive wheel 451 to rotate, and the drive wheel 451 is wound with a corresponding drive wire 452. The movable portion of the corresponding drive wire 452, that is, the portion not wound on the drive wheel 451, extends into the catheter 48, extends along the length of the catheter 48, and is ultimately fixed to the distal end of the catheter.
[0059] The end in this application may also be referred to as the distal end or the head, which refers to the end away from the instrument box 45 ; the front end may also be referred to as the proximal end or the tail, which refers to the end close to the instrument box 45 .
[0060] A portion of catheter 48, including the distal end, is a controllable section 49, the distal end of which is also the distal end of catheter 48. Controllable section 49 may be a joint assembly having high stiffness in the extension direction and low stiffness in the bending direction, and may bend under the control of actuation wire 452, thereby achieving steering of catheter 48. In certain embodiments, this joint assembly may be referred to as a snakebone.
[0061] The processor of the control system 600 is configured to execute the following steps to implement the catheter drive control method provided in the first embodiment of the present application. As shown in FIG4 , the method includes:
[0062] Step S10, obtaining a current distance between the inner catheter end and the outer catheter end, and obtaining a target distance between the inner catheter end and the outer catheter end;
[0063] As shown in FIG5 , in one embodiment, the length L1 of the inner tube and the length L2 of the outer tube can be obtained. The length information of L1 and L2 is known and can be retrieved from the factory information of the inner tube and the outer tube. Based on the kinematics of the manipulator, the position information of the two power units can be calculated according to the joint angle of the manipulator, thereby obtaining the distance d between the two power units. The current distance between the end of the inner tube and the end of the outer tube can be calculated using the formula: D c = L1 - L2 - d. In other embodiments, a position sensor disposed at the end of the inner catheter can be used to obtain the spatial position coordinates of the inner catheter, and a position sensor disposed at the end of the outer catheter can be used to obtain the spatial position coordinates of the outer catheter. The current distance between the inner and outer catheter ends can be calculated based on these two spatial position coordinates. Of course, the present application is not limited to obtaining the current distance between the inner and outer catheter ends through the above embodiment; other reasonable solutions are also possible, and the present application does not specifically limit this.
[0064] The target distance is a critical value for controlling the outer catheter to follow the movement of the inner catheter. Its value mainly depends on the length and maximum curvature of the inner catheter. In one embodiment, the target distance can be preset based on experience. In another embodiment, it can be obtained by calculation. Specifically, as shown in Figure 6, the step of obtaining the target distance between the inner catheter end and the outer catheter end in step S10 can further include:
[0065] Step S101, obtaining the maximum curvature of the inner catheter, the maximum curvature of the outer catheter, the controllable section length of the inner catheter, the controllable section length of the outer catheter, and a preset adjustment coefficient;
[0066] In this embodiment, the maximum curvature k of the inner catheter can be obtained 1max , maximum curvature k of the outer catheter 2max, the length of the controllable section of the inner catheter LengthControl1, the length of the controllable section of the outer catheter LengthControl2 and the preset adjustment coefficient ε and other parameters, these parameter information are known and can be retrieved from the factory information of the inner catheter and the outer catheter. Among them, the preset adjustment coefficient ε can take a reasonable value such as 1, 2, etc. As shown in Figure 2 or Figure 3, the length of the controllable section of the inner catheter LengthControl1 or the length of the controllable section of the outer catheter LengthControl2 is the length of the controllable section corresponding to the inner catheter or the outer catheter. The length of the controllable section of the inner catheter LengthControl1 is greater than or equal to the length of the controllable section of the outer catheter LengthControl2. In this way, it can not only provide sufficient support and protection for the inner catheter, but also enable the end of the inner catheter to have a more flexible bending space after extending out of the end of the outer catheter.
[0067] Step S102, calculating the length difference between the controllable section length of the inner catheter and the controllable section length of the outer catheter, and calculating the curvature ratio between the maximum curvature of the inner catheter and the maximum curvature of the outer catheter;
[0068] Step S103: Calculate the product of the preset adjustment coefficient, the length difference, and the curvature ratio to obtain the target distance.
[0069] In this embodiment, the length difference between the controllable length of the inner catheter section LengthControl1 and the controllable length of the outer catheter section LengthControl2 can be calculated: LengthControl1-LengthControl2, and the maximum curvature k of the inner catheter can be calculated. 1max and the maximum curvature k of the outer catheter 2max The curvature ratio between: k 1max / k 2max The target distance D can be calculated using the following formula: f :
[0070] It is understood that the target distance is mainly determined by at least one of the parameters such as the length of the controllable section of the inner catheter, the length of the controllable section of the outer catheter, the maximum curvature of the inner catheter, and the maximum curvature of the outer catheter. The target distance can be obtained by calculation using the above formula; it can also be calculated using other formulas, for example, using a preset adjustment coefficient ε, the maximum curvature of the inner catheter k 1max and the maximum curvature k of the outer catheter 2maxThe target distance can be calculated by, for example,
[0045] or directly preset based on experience. That is, the present application is not limited to obtaining the target distance between the inner catheter end and the outer catheter end through the above embodiment, and other reasonable solutions are also possible, and the present application does not impose any specific limitation on this.
[0071] Step S20: When the current distance reaches the target distance, control the outer catheter to move following the movement of the inner catheter until the current distance reaches a critical threshold.
[0072] The critical threshold is the distance for controlling the movement of the inner catheter alone, and its size mainly depends on at least one of the parameters such as the length of the controllable section of the inner catheter, the length of the controllable section of the outer catheter, the maximum curvature of the inner catheter, and the maximum curvature of the outer catheter. When the current distance reaches the critical threshold, the inner catheter moves alone, while the outer catheter stays in place and remains motionless. The setting of the current distance can ensure that the image data captured by the camera at the end of the inner catheter is not blocked by the outer catheter. In this embodiment, the maximum curvature k of the inner catheter can be obtained. 1max , maximum curvature k of the outer catheter 2max , the inner catheter controllable section length LengthControl1, the outer catheter controllable section length LengthControl2 and the preset adjustment coefficient ε and other parameters, these parameter information is known and can be retrieved from the factory information of the inner catheter and the outer catheter. The forward distance D can be calculated using the following formula entry :
[0073] The preset adjustment coefficient ε can be set to a reasonable value such as 0.5. It is understood that the forward distance can be obtained by calculating the above formula; it can also be calculated according to other formulas, for example, using the preset adjustment coefficient ε, the maximum curvature k of the inner catheter, and the distance between the front and rear ends of the spherical tube. 1max and the maximum curvature k of the outer catheter 2max The advancement distance can be calculated by, for example,
[0065] or directly preset based on experience. That is, the present application is not limited to obtaining the advancement distance between the inner catheter end and the outer catheter end through the above embodiment, and other reasonable solutions are also possible, and the present application does not impose any specific limitation on this.
[0074] In this embodiment, when the outer catheter follows the movement of the inner catheter and the distance between the ends of the two reaches the forward distance, only the inner catheter is driven forward; when the distance between the ends of the two reaches the target distance, the outer catheter is controlled to follow the movement of the inner catheter, and the operation is repeated.
[0075] As shown in FIG7 , in one embodiment, the step of controlling the outer catheter to follow the movement of the inner catheter in step S20 further includes:
[0076] Step S201: receiving the forward speed of the inner catheter via the user input device;
[0077] In this embodiment, the operator can trigger an advance command and a bend command for controlling the advancement and bending of the inner catheter by operating the user input device. The advance command may include controlling the speed of the inner catheter's advancement; the advance command may also include controlling the distance of the inner catheter's advancement. Of course, the advance speed can be determined entirely by the operator based on their own experience, or can be a range within which the operator can select, or can be a system-recommended value.
[0078] Of course, the user input device can be a controller with physical buttons for operation, a controller with a touch screen for operation, or a controller that can receive voice commands, etc. In other words, the forward speed can be triggered in a variety of ways.
[0079] Step S202: Calculate a following speed of the outer catheter following the inner catheter based on the current distance, the target distance, and the forward speed;
[0080] In this embodiment, the following speed of the outer catheter following the inner catheter can be calculated based on the current distance between the inner catheter end and the outer catheter end, the target distance between the inner catheter end and the outer catheter end, and the forward speed of the inner catheter.
[0081] It is understood that the outer catheter moves at a greater speed than the inner catheter, ensuring that the outer catheter gradually catches up with the inner catheter as it follows the outer catheter. The speed at which the outer catheter follows the inner catheter is related to the current distance between the inner and outer catheter ends, and as the outer catheter follows the inner catheter, the current distance between the inner and outer catheter ends gradually decreases. Therefore, the speed at which the outer catheter follows the inner catheter is not constant but varies.
[0082] Step S203: Control the outer catheter to move at the calculated following speed to follow the movement of the inner catheter.
[0083] In this embodiment, the outer catheter will follow the movement of the inner catheter at the calculated following speed. When the outer catheter starts to follow the movement, the following speed V2 of the outer catheter is greater than the forward speed V1 of the inner catheter, that is, the outer catheter first moves at a larger following speed to prevent the outer catheter from catching up with the inner catheter. As the current distance D between the end of the inner catheter and the end of the outer catheter increases, the outer catheter moves at a larger following speed to prevent the outer catheter from catching up with the inner catheter. c As the distance D decreases, the following speed V2 of the outer catheter decreases accordingly. That is, the following speed V2 of the outer catheter is large at the beginning and then slowly decreases until the current distance D c Distance D from the target f =Equal, at this time, the following speed V2 of the outer catheter is equal to the advancing speed V1 of the inner catheter. It can be understood that the solution of this embodiment is suitable for scenarios where rapid movement at a relatively high speed is possible, for example, controlling the movement of a catheter instrument within the first and second level branches of a bronchial cavity.
[0084] As shown in FIG8 , in one embodiment, step S202 may further include:
[0085] Step S2021: Calculate the ratio between the current distance and the target distance;
[0086] In this embodiment, the current distance between the inner catheter end and the outer catheter end can be set as D c The inner catheter's forward speed is V1, the outer catheter's following speed following the inner catheter is V2, and the current distance D c Distance D from the target f The ratio D c / D f .
[0087] Step S2022: Calculate the product of the ratio and the forward speed to obtain a following speed of the outer catheter following the movement of the inner catheter.
[0088] In this embodiment, the ratio D is calculated c / D f The product of the forward speed V1 and the outer tube's following speed V2 is obtained. That is, the following speed V2 can be calculated using the following formula:
[0089] It is understood that the following speed can also be calculated based on a preset coefficient and the forward speed, can also be directly preset based on experience, or can be calculated by introducing other reasonable parameters. That is, the present application is not limited to the above embodiment to obtain the following speed of the outer catheter following the movement of the inner catheter. Other reasonable solutions are also possible and are not specifically limited in the present application.
[0090] The following description is made in conjunction with FIG9 . This application involves two main catheter control modes: inner catheter driving mode and outer catheter following mode. (1) indicates that the catheter system is initialized, and the two robotic arms respectively lift the corresponding inner catheter instrument and outer catheter instrument and move them relative to each other in the horizontal direction until the distance between the inner catheter end and the outer catheter end reaches the forward distance D. entry , at this time, the inner catheter will enter the inner catheter drive mode; (2) indicates that the inner catheter has entered the inner catheter drive mode. In this mode, only the inner catheter moves in the direction shown in the figure until the distance between the inner catheter end and the outer catheter end reaches the target distance D f , at this time, the outer catheter will enter the outer catheter following mode; (3) indicates that the outer catheter has entered the outer catheter following mode. In this mode, the inner catheter does not stop and wait, but continues to move forward. The outer catheter moves following the movement of the inner catheter. During the following process, the following speed of the outer catheter is greater than the forward speed of the inner catheter.
[0091] This embodiment obtains the current distance and target distance between the ends of the inner and outer catheters. When the current distance reaches the target distance, the outer catheter is controlled to follow the movement of the inner catheter until the current distance reaches the forward distance again. This prevents the inner catheter from extending too far outside the lumen of the outer catheter, thereby providing the necessary protection and support for the inner catheter and ensuring the normal function of the catheter device. In addition, the inner catheter does not stop to wait, and the outer catheter follows the movement of the inner catheter. This can avoid sudden stops in the user's field of view, which is more in line with the user's field of view and thus improves the user experience.
[0092] The processor of the control system 600 is configured to perform the following steps to implement the catheter driving control method provided in the second embodiment of the present application. As shown in FIG10 , compared with the first embodiment, this embodiment further includes the following steps after step S10:
[0093] Step S30: When the current distance reaches the target distance, the outer catheter is controlled to advance following the inner catheter, and when the inner catheter bends, the outer catheter is controlled to bend following the inner catheter.
[0094] In this embodiment, when the current distance reaches the target distance, the outer tube not only follows the inner tube's movement and moves forward, but also, when the inner tube bends, bends accordingly. When the outer tube follows the inner tube's movement and bends, the relationship between the outer tube's movement speed and its bending angle and the inner tube's movement speed and bending angle can include the following: 1) the outer tube's movement speed is greater than the inner tube's movement speed, and the outer tube's bending angle is less than the inner tube's bending angle; 2) the outer tube's movement speed is greater than the inner tube's movement speed, and the outer tube's bending angle is equal to the inner tube's bending angle. Thus, by setting the outer tube's movement speed to be greater than the inner tube's movement speed, the outer tube can gradually catch up with the inner tube as it follows the outer tube's movement. By setting the outer tube's bending angle to be less than or equal to the inner tube's bending angle, the outer tube's bending can be prevented from interfering with the inner tube's bending, thereby avoiding affecting the accuracy of the inner tube's bending control.
[0095] It is understood that the direction in which the outer catheter follows the inner catheter's advancement is the same as the direction in which the inner catheter advances. Similarly, the direction in which the outer catheter follows the inner catheter's bending is the same.
[0096] As shown in FIG11 , the step of controlling the outer catheter to follow the inner catheter in step S30 and to bend along with the inner catheter when the inner catheter bends further includes:
[0097] Step S301: receiving the forward speed of the inner catheter and the target bending angle of the inner catheter via the user input device, and acquiring the target bending angle of the outer catheter;
[0098] In this embodiment, the operator can trigger an advance command and a bend command to control the advancement and bending of the inner catheter by operating the user input device. The advance command may include controlling the speed of the inner catheter's advancement; the advance command may also control the distance of the inner catheter's advancement, etc. The bend command may include a target bend angle for controlling the bending of the inner catheter, and the target bend angle further includes a specific bend angle and bend direction. Of course, the advance speed and target bend angle can be determined entirely by the operator based on their own experience, can be set within a range, and can also be system-recommended values.
[0099] Of course, the user input device can be a controller with physical buttons for operation, a controller with a touch screen for operation, or a controller that can receive voice commands, etc. In other words, the forward speed can be triggered in a variety of ways.
[0100] In addition, the target bending angle of the outer catheter can be calculated based on relevant parameters, or can be preset based on experience.
[0101] Step S302: Calculate a following speed of the outer catheter following the inner catheter according to the current distance, the target distance, and the forward speed;
[0102] In this embodiment, the following speed of the outer catheter following the inner catheter can be calculated based on the current distance between the inner catheter end and the outer catheter end, the target distance between the inner catheter end and the outer catheter end, and the forward speed of the inner catheter.
[0103] It is understood that the outer catheter moves at a greater speed than the inner catheter, ensuring that the outer catheter gradually catches up with the inner catheter as it follows the outer catheter. The speed at which the outer catheter follows the inner catheter is related to the current distance between the inner and outer catheter ends, and as the outer catheter follows the inner catheter, the current distance between the inner and outer catheter ends gradually decreases. Therefore, the speed at which the outer catheter follows the inner catheter is not constant but varies.
[0104] Step S303: Control the outer catheter to advance at the calculated following speed, following the advancing speed of the inner catheter; and control the outer catheter to bend at the target bending angle, following the bending angle of the inner catheter.
[0105] In this embodiment, when the following speed and the target bending angle are obtained, the outer catheter is controlled to follow and move in the same direction as the moving direction of the inner catheter at the following speed; at the same time, the outer catheter is controlled to follow and bend in the same direction as the bending direction of the inner catheter at the target bending angle.
[0106] As shown in FIG12 , in one embodiment, step S302 may further include:
[0107] Step S3021: calculating a first ratio between the current distance and the target distance, and a second ratio between the target bending angle of the outer catheter and the target bending angle of the inner catheter;
[0108] In this embodiment, the current distance between the inner catheter end and the outer catheter end can be set as D c The inner catheter's forward speed is V1, the outer catheter's following speed following the inner catheter is V2, and the current distance D c Distance D from the target f The first ratio between c / D f .
[0109] The target bending angle of the outer catheter may be θ2, the target bending angle of the inner catheter may be θ1, and a second ratio between the target bending angles of the outer catheter and the inner catheter may be θ2 / θ1.
[0110] Step S3022: Calculate the product of the first ratio, the second ratio, and the forward speed to obtain a following speed of the outer catheter following the movement of the inner catheter.
[0111] In this embodiment, the first ratio D is calculated c / D f The product of the second ratio θ2 / θ1 and the forward speed V1 is the following speed V2 of the outer tube following the inner tube. That is, the following speed V2 can be calculated using the following formula:
[0112] It is understood that the following speed can also be calculated based on a preset coefficient and the forward speed, can also be directly preset based on experience, or can be calculated by introducing other reasonable parameters. That is, the present application is not limited to the above embodiment to obtain the following speed of the outer catheter following the movement of the inner catheter. Other reasonable solutions are also possible and are not specifically limited in the present application.
[0113] As shown in FIG13 , in one embodiment, the step of obtaining the target bending angle of the outer catheter in step S301 may further include:
[0114] Step S3011, obtaining the maximum bending angle of the outer catheter;
[0115] In this embodiment, the maximum bending angle θ of the outer catheter is 2max The parameter information is known and can be retrieved from the factory information of the outer catheter. In addition, the maximum bending angle can also be obtained by the maximum curvature k of the outer catheter. 2max Transformation is performed to obtain, for example, θ 2max =k 2max *s, where s is the corresponding bending arc length when the outer catheter is at the maximum bending angle.
[0116] Step S3012: when the target bending angle of the inner catheter is less than or equal to the maximum bending angle of the outer catheter, obtaining the controllable section length of the inner catheter and the controllable section length of the outer catheter;
[0117] This embodiment is suitable for scenarios where the inner catheter bending angle is relatively small. For example, when controlling the movement or bending of the catheter instrument in the 1st to 2nd level branches of the bronchial cavity, since there are no branches with large curvatures, the inner catheter can be bent at a relatively small bending angle to achieve observation or operation purposes.
[0118] In this embodiment, a preset condition is set such as: the target bending angle θ1 of the inner catheter is less than or equal to the maximum bending angle θ of the outer catheter. 2max , that is, θ1≤θ 2max When bending, the inner catheter can be bent at a smaller angle to achieve the purpose of observation or operation.
[0119] Likewise, the controllable length of the inner catheter and the controllable length of the outer catheter are known parameter information, which can be retrieved from the factory information of the inner catheter and the outer catheter.
[0120] Step S3013: Calculate the target bending angle of the outer catheter according to the target bending angle of the inner catheter, the controllable section length of the inner catheter, and the controllable section length of the outer catheter.
[0121] In this embodiment, the target bending angle θ2 of the outer catheter can be calculated according to the target bending angle θ1 of the inner catheter, the controllable length of the inner catheter section LengthControl1 and the controllable length of the outer catheter section LengthControl2:
[0122] In this embodiment, the target bending angle θ2 of the outer catheter is calculated by combining the target bending angle θ1 of the inner catheter, the controllable length of the inner catheter section LengthControl1, and the controllable length of the outer catheter section LengthControl2. In this way, a more suitable target bending angle can be provided for the outer catheter in specific scenarios where a larger bending angle is not required, thereby preventing the outer catheter from bending to an inappropriately large bending angle and thereby injuring the bronchial lumen.
[0123] As shown in FIG14 , in another embodiment, the step of obtaining the target bending angle of the outer catheter in step S301 may further include:
[0124] Step S3014: obtaining the maximum bending angle of the outer catheter;
[0125] In this embodiment, the maximum bending angle θ of the outer catheter is 2maxThe parameter information is known and can be retrieved from the factory information of the outer catheter. In addition, the maximum bending angle can also be obtained by the maximum curvature k of the outer catheter. 2max Transformation is performed to obtain, for example, θ 2max =k 2max *s, where s is the corresponding bending arc length when the outer catheter is at the maximum bending angle.
[0126] Step S3015: When the target bending angle of the inner catheter is greater than the maximum bending angle of the outer catheter, obtaining the controllable section length of the inner catheter, the controllable section length of the outer catheter, and the current distance between the inner catheter end and the outer catheter end;
[0127] This embodiment is suitable for scenarios where the inner catheter has a large bending angle. For example, when controlling the catheter instrument to move or bend in the 3rd to 4th level branches of the bronchial cavity, since the curvature of the bronchial branches is usually large, the inner catheter needs to be bent at a larger bending angle to achieve observation or operation purposes.
[0128] In this embodiment, a preset condition is set such as: the target bending angle θ1 of the inner catheter is greater than the maximum bending angle θ of the outer catheter. 2max , that is, θ1>θ 2max It is used to characterize the scenario where the inner catheter needs to be bent at a larger bending angle to achieve the purpose of observation or operation.
[0129] Likewise, the controllable length of the inner catheter and the controllable length of the outer catheter are known parameter information, which can be retrieved from the factory information of the inner catheter and the outer catheter.
[0130] Step S3016: Calculate the target bending angle of the outer catheter according to the target bending angle of the inner catheter, the length of the controllable section of the inner catheter, and the current distance between the end of the inner catheter and the end of the outer catheter.
[0131] In this embodiment, the target bending angle θ1 of the inner catheter, the controllable length LengthControl1 of the inner catheter, and the current distance D between the end of the inner catheter and the end of the outer catheter can be used. c , the target bending angle θ2 of the outer catheter is calculated as:
[0132] In this embodiment, the target bending angle θ1 of the inner catheter, the controllable length LengthControl1 of the inner catheter, and the current distance D between the end of the inner catheter and the end of the outer catheter are combined. c, the target bending angle θ2 of the outer catheter is calculated, so that a more suitable target bending angle can be provided for the outer catheter under the current specific scenario demanding a larger bending angle, thereby preventing the outer catheter from bending at a smaller bending angle and failing to achieve the purpose of observation or operation.
[0133] As shown in FIG15 , in one embodiment, the step of obtaining the current distance between the inner catheter end and the outer catheter end in step S10 further includes:
[0134] Step S104: Acquire the length L1 of the inner conduit, the length L2 of the outer conduit, the distance d between the two power units, the controllable section length of the inner conduit, the controllable section length of the outer conduit, the target bending angle of the inner conduit, and the target bending angle of the outer conduit;
[0135] In this embodiment, the length L1 of the inner catheter and the length L2 of the outer catheter can be obtained. The length information of L1 and L2 is known and can be retrieved from the factory information of the inner catheter and the outer catheter. Based on the kinematics of the manipulator, the position information of the two power units can be calculated according to the joint angles of the manipulator, thereby obtaining the distance d between the two power units. In other embodiments, the spatial position coordinates of the inner catheter can be obtained using a position sensor provided at the end of the inner catheter, and the spatial position coordinates of the outer catheter can be obtained using a position sensor located at the end of the outer catheter. The current distance between the ends of the inner catheter and the outer catheter can be calculated based on these two spatial position coordinates.
[0136] The method for obtaining or calculating the target bending angle of the inner catheter and the target bending angle of the outer catheter has been described in detail in the above embodiments and will not be repeated here.
[0137] Step S105: Calculate the length L1 of the inner conduit, the length L2 of the outer conduit, and the difference between the distance d between the two power units, calculate the length ratio between the controllable section length of the inner conduit and the controllable section length of the outer conduit, and calculate the angle ratio between the target bending angle of the outer conduit and the target bending angle of the inner conduit;
[0138] In this embodiment, the length L1 of the inner conduit, the length L2 of the outer conduit, and the difference between the distance d between the two power units can be calculated: L1-L2-d; the length ratio between the controllable section length of the inner conduit and the controllable section length of the outer conduit is calculated: LengthControl1 / LengthControl2; and the angle ratio between the target bending angle θ2 of the outer conduit and the target bending angle θ1 of the inner conduit is calculated: θ2 / θ1.
[0139] Step S106: Calculate the product of the difference, the length ratio, and the angle ratio to obtain a current distance Dc between the end of the inner catheter and the end of the outer catheter.
[0140] In this embodiment, the product of the difference L1-L2-d, the length ratio LengthControl1 / LengthControl2, and the angle ratio θ2 / θ1 is calculated to obtain the current distance Dc between the inner and outer catheter ends. Specifically, the current distance Dc can be calculated using the following formula:
[0141] It is understood that the current distance can also be calculated based on at least one preset coefficient and parameters such as the difference L1-L2-d, can be directly preset based on experience, or can be calculated by introducing other reasonable parameters. That is, the present application is not limited to obtaining the current distance between the inner catheter end and the outer catheter end through the above embodiment, and other reasonable solutions are also possible, and the present application does not specifically limit this.
[0142] As shown in FIG16 , in one embodiment, before step S30, the following steps are further included:
[0143] Step S40, obtaining the maximum curvature of the inner catheter, the maximum curvature of the outer catheter, the controllable length of the inner catheter, the controllable length of the outer catheter, a preset adjustment coefficient, a target bending angle of the inner catheter, and a target bending angle of the outer catheter;
[0144] In this embodiment, the maximum curvature k of the inner catheter can be obtained 1max , maximum curvature k of the outer catheter 2max , the length of the controllable section of the inner catheter LengthControl1, the length of the controllable section of the outer catheter LengthControl2 and the preset adjustment coefficient ε and other parameters, these parameter information are known and can be retrieved from the factory information of the inner catheter and the outer catheter. Among them, the preset adjustment coefficient ε can take a reasonable value such as 1, 2, etc. As shown in Figure 2 or Figure 3, the length of the controllable section of the inner catheter LengthControl1 or the length of the controllable section of the outer catheter LengthControl2 is the length of the controllable section corresponding to the inner catheter or the outer catheter. The length of the controllable section of the inner catheter LengthControl1 is greater than or equal to the length of the controllable section of the outer catheter LengthControl2. In this way, it can not only provide sufficient support and protection for the inner catheter, but also enable the end of the inner catheter to have a more flexible bending space after extending out of the end of the outer catheter.
[0145] The method for obtaining or calculating the target bending angle of the inner catheter and the target bending angle of the outer catheter has been described in detail in the above embodiments and will not be repeated here.
[0146] Step S50, calculating the length difference between the controllable section length of the inner catheter and the controllable section length of the outer catheter, calculating the curvature ratio between the maximum curvature of the inner catheter and the maximum curvature of the outer catheter, and calculating the angle ratio between the target bending angle of the inner catheter and the target bending angle of the outer catheter;
[0147] In this embodiment, the length difference between the controllable length of the inner catheter LengthControl1 and the controllable length of the outer catheter LengthControl2 can be calculated: LengthControl1-LengthControl2, and the maximum curvature k of the inner catheter can be calculated. 1max and the maximum curvature k of the outer catheter 2max The curvature ratio between: k 1max / k 2max , calculate the angle ratio between the target bending angle θ1 of the inner catheter and the target bending angle θ2 of the outer catheter: θ1 / θ2.
[0148] Step S60: Calculate the product of the preset adjustment coefficient, the length difference, the curvature ratio, and the angle ratio to obtain the target distance.
[0149] In this embodiment, the preset adjustment coefficient ε, the length difference LengthControl1-LengthControl2, and the curvature ratio k are calculated. 1max / k 2max The target distance D can be calculated by multiplying the angle ratio θ1 / θ2 by the following formula: f :
[0150] It is understood that the target distance is mainly determined by at least one of the parameters such as the length of the controllable section of the inner catheter, the length of the controllable section of the outer catheter, the maximum curvature of the inner catheter, the maximum curvature of the outer catheter, the target bending angle of the inner catheter, and the target bending angle of the outer catheter. The target distance can be obtained by calculation using the above formula; it can also be calculated using other formulas, for example, using a preset adjustment coefficient ε, the maximum curvature k of the inner catheter, and the target bending angle k of the outer catheter. 1max , maximum curvature k of the outer catheter 2maxThe target distance can be calculated based on the target bending angle θ1 of the inner catheter and the target bending angle θ2 of the outer catheter, etc. Alternatively, the target distance can be directly preset based on experience. That is, the present application is not limited to the above-described embodiment for obtaining the target distance between the inner and outer catheter ends; other reasonable solutions are also possible and are not specifically limited in the present application.
[0151] The following description is made in conjunction with FIG17. This application involves three main catheter control modes: inner catheter driving mode, outer catheter linear following mode, and outer catheter linear following and curved following mode. (1) indicates that the catheter system is initialized, and the two robotic arms respectively lift the corresponding inner catheter instrument and outer catheter instrument and move them relative to each other in the horizontal direction until the distance between the inner catheter end and the outer catheter end reaches the forward distance D. entry , at this time, the inner catheter will enter the inner catheter drive mode; (2) indicates that the inner catheter has entered the inner catheter drive mode. In this mode, only the inner catheter moves in the direction shown in the figure until the distance between the inner catheter end and the outer catheter end reaches the target distance D f , at this time, the outer catheter will enter the outer catheter straight line following mode or the outer catheter straight line following and curved following mode; (3) indicates that the outer catheter has entered the outer catheter straight line following mode. In this mode, the inner catheter does not stop and wait, but continues to move forward. The outer catheter moves following the movement of the inner catheter. During the following process, the following speed of the outer catheter is greater than the forward speed of the inner catheter; (4) indicates that the outer catheter has entered the outer catheter straight line following and curved following mode. In this mode, the inner catheter does not stop and wait, but continues to move forward. The outer catheter moves following the movement of the inner catheter. During the forward following process, the following speed of the outer catheter is greater than the forward speed of the inner catheter; at the same time, the inner catheter also bends during the forward process. The outer catheter follows the bending of the inner catheter and follows the bending. During the bending following process, the bending angle of the outer catheter is smaller than the bending angle of the inner catheter. It can be understood that in other embodiments, a curved following mode can also be included, that is, when the outer catheter and the inner catheter both stay at a certain place, the outer catheter can follow the bending of the inner catheter and bend accordingly.
[0152] It should be understood that the "reach" mentioned in this application, such as the "reach" in the above-mentioned distance between the end of the inner catheter and the end of the outer catheter reaching the advancement distance or reaching the target distance, means that the two distances are equal; or close, such as having a certain distance range, which can also be considered to be reached.
[0153] This embodiment obtains the current distance and target distance between the inner and outer catheter tips. When the current distance reaches the target distance, the outer catheter is controlled to follow the movement of the inner catheter and, when the inner catheter bends, to follow the inner catheter's curve. This allows the outer catheter to follow the inner catheter's movement and bend in a timely manner as the inner catheter advances and bends. In particular, the outer catheter's bend-following behavior allows the inner catheter to maintain its curved shape, providing necessary protection and support for the inner catheter and ensuring the proper function of the catheter device. For example, existing catheter devices have limited ability to reach the upper lobes of the lungs. In this embodiment, the outer catheter's forward tracking provides support for the inner catheter. Simultaneously, the outer catheter's bend-following behavior further increases the inner catheter's bending angle, thereby helping the catheter device's tip reach the upper lobes. Furthermore, the inner catheter does not stop to wait, and the outer catheter follows its movement, preventing sudden stops in the user's field of view. This better aligns with the user's visual field and improves the user experience.
[0154] The processor of the control system 600 is configured to perform the following steps to implement the catheter drive control method provided by another embodiment of the present application. As shown in FIG18 , the method includes:
[0155] Step S10: receiving a first target retreat speed of the inner catheter and a first target bending angle of the inner catheter via the user input device;
[0156] In this embodiment, the operator can trigger forward, backward, and bending commands for controlling the advancement, retreat, and bending of the inner catheter by operating the user input device. The forward command may include controlling the forward speed of the inner catheter; the forward command may also include controlling the distance of the inner catheter's forward movement; the backward command may include controlling the backward speed of the inner catheter's backward movement; the backward command may also include controlling the backward distance of the inner catheter's backward movement; and the bending command may include a bending direction and angle. Of course, the forward speed, backward speed, and bending angle can be determined entirely by the operator based on their own experience, can be set within a range, and can be selected by the operator, or can be system-recommended values.
[0157] Of course, the user input device can be a controller with physical buttons for operation, a controller with a touch screen for operation, or a controller that can receive voice commands, etc. In other words, the forward speed can be triggered in a variety of ways.
[0158] In one embodiment, as shown in FIG19 , the step of obtaining the first target bending angle of the inner catheter in step S10 may specifically include:
[0159] Step S101: receiving an input bending angle of the inner catheter via the user input device, and obtaining a maximum curvature of the outer catheter;
[0160] Step S102: determining the magnitude relationship between the input bending angle and the maximum curvature of the outer catheter;
[0161] Step S103: when the input bending angle is less than or equal to the maximum curvature of the outer catheter, using the input bending angle as the first target bending angle;
[0162] Step S104: When the input bending angle is greater than the maximum curvature of the outer catheter, the maximum curvature of the outer catheter is used as the first target bending angle.
[0163] In this embodiment, the input bending angle is the target bending angle input by the operator, but the target bending angle input by the operator is not always reasonable. Therefore, it is necessary to introduce the maximum curvature of the outer catheter to confirm whether the target bending angle input by the operator is reasonable. Specifically, the size relationship between the input bending angle and the maximum curvature of the outer catheter is judged. When the input bending angle is less than or equal to the maximum curvature of the outer catheter, when the input bending angle is used as the first target bending angle, it indicates that the input bending angle input by the operator is reasonable. Therefore, the input bending angle can be used as the first target bending angle. On the contrary, when the input bending angle is greater than the maximum curvature of the outer catheter, it indicates that the input bending angle input by the operator is unreasonable. At this time, the outer catheter will interfere with the bending of the inner catheter, resulting in the inner catheter being unable to reach the input bending angle. To solve this problem, the maximum curvature θ of the outer catheter can be used. 2max as the first target bending angle.
[0164] Step S20, obtaining the current distance between the inner catheter end and the outer catheter end, the length of the controllable section of the inner catheter, the length of the controllable section of the outer catheter, and the length of the controllable section of the inner catheter inside the outer catheter;
[0165] As shown in FIG20 , in one embodiment, the length L1 of the inner tube and the length L2 of the outer tube can be obtained. The length information of L1 and L2 is known and can be retrieved from the factory information of the inner tube and the outer tube. Based on the kinematics of the manipulator, the position information of the two power units can be calculated according to the joint angle of the manipulator, thereby obtaining the distance d between the two power units. The current distance between the end of the inner tube and the end of the outer tube can be calculated using the formula: D c= L1 - L2 - d. In other embodiments, a position sensor disposed at the end of the inner catheter can be used to obtain the spatial position coordinates of the inner catheter, and a position sensor disposed at the end of the outer catheter can be used to obtain the spatial position coordinates of the outer catheter. The current distance between the inner and outer catheter ends can be calculated based on these two spatial position coordinates. Of course, the present application is not limited to obtaining the current distance between the inner and outer catheter ends through the above embodiment; other reasonable solutions are also possible, and the present application does not specifically limit this.
[0166] Parameters such as the inner conduit controllable section length LengthControl1 and the outer conduit controllable section length LengthControl2 can be obtained. These parameter information is known and can be retrieved from the factory information of the inner conduit and the outer conduit. As shown in Figure 2 or Figure 3, the inner conduit controllable section length LengthControl1 or the outer conduit controllable section length LengthControl2 is the length of the controllable section corresponding to the inner conduit or the outer conduit. The inner conduit controllable section length LengthControl1 is greater than or equal to the outer conduit controllable section length LengthControl2. In this way, not only can sufficient support and protection be provided for the inner conduit, but also the end of the inner conduit can have more flexible bending space after extending from the end of the outer conduit.
[0167] As shown in FIG21 , in one embodiment, the length of the controllable section of the inner catheter LengthControl1 and the current distance D between the end of the inner catheter and the end of the outer catheter can be used. c , calculate the length LengthControl1In of the controllable section of the inner catheter inside the outer catheter. Specifically, the following formula can be used: LengthControl1In=LengthControl1-D c Of course, in other embodiments, as shown in FIG22 , the length L1 of the inner conduit, the length L2 of the outer conduit, and the length LengthControl1 of the controllable section of the inner conduit can also be used to calculate the length LengthControl1In of the controllable section of the inner conduit inside the outer conduit. Specifically, the following formula can be used: LengthControl1In = LengthControl1 - (L1 - L2).
[0168] Step S30: Control the catheter system to switch among a free retreat control mode, a partial retreat control mode, and a full retreat control mode based on the relationship between the current distance and the length of the controllable section of the inner catheter, and / or the relationship between the length of the controllable section of the inner catheter inside the outer catheter and the length of the controllable section of the outer catheter.
[0169] In this embodiment, the free retreat control mode is a mode in which the inner catheter is controlled to retreat and bend, and the outer catheter is controlled to bend, in response to a first target retreat speed and a first target bend angle of the inner catheter. The partial retreat control mode is a mode in which both the inner catheter and the outer catheter are controlled to retreat and bend, in response to the first target retreat speed and the first target bend angle of the inner catheter. The full retreat control mode is a mode in which the inner catheter is controlled to retreat and bend, and the outer catheter is controlled to advance and bend, stop and bend, or retreat and bend. Whether the catheter system executes the free retreat control mode can be determined based on the relationship between the current distance and the length of the controllable section of the inner catheter. Whether the catheter system executes the partial retreat control mode can also be determined based on the relationship between the current distance and the length of the controllable section of the inner catheter, and the relationship between the length of the controllable section of the inner catheter within the outer catheter and the length of the controllable section of the outer catheter. Whether the catheter system executes the full retreat control mode can also be determined based on the relationship between the length of the controllable section of the inner catheter within the outer catheter and the length of the controllable section of the outer catheter. The specific control method will be expanded below and will not be described here in detail.
[0170] This embodiment controls the catheter system to switch between a free retreat control mode, a partial retreat control mode, and a full retreat control mode, enabling at least one of the inner and outer catheters to bend and retreat at the target bending angle and target speed in the corresponding mode. In this manner, the inner and / or outer catheters can be adjusted accordingly based on the current relative position between the inner and outer catheter ends to prevent the inner catheter from extending too far outside the lumen of the outer catheter, thereby providing the necessary protection and support for the inner catheter and ensuring the normal function of the catheter device. Furthermore, when the controllable sections of the inner and outer catheters partially overlap, the distance the inner catheter extends beyond the outer catheter can be adjusted accordingly to prevent the outer catheter from interfering with the inner catheter's bending. Furthermore, the inner catheter does not stop to wait, and the outer catheter follows the movement of the inner catheter, thereby avoiding sudden stops in the user's field of view. This is more in line with the user's field of view and improves the user experience.
[0171] As shown in FIG. 23 , in the first embodiment, step S30 further includes:
[0172] Step S301, comparing the current distance with the length of the controllable section of the inner catheter;
[0173] Step S302: When the current distance is greater than or equal to the length of the controllable section of the inner catheter, control the catheter system to execute the backward free control mode.
[0174] In this embodiment, when the current distance between the inner catheter end and the outer catheter end, as well as the length of the inner catheter controllable section, is obtained, the current distance and the length of the inner catheter controllable section can be compared. When the current distance is greater than or equal to the length of the inner catheter controllable section, specifically, when the current distance is equal to the length of the inner catheter controllable section, it indicates that the inner catheter controllable section has just fully extended from the end of the outer catheter; when the current distance is greater than the length of the inner catheter controllable section, it indicates that the inner catheter controllable section has fully extended from the end of the outer catheter. At this time, although the bending of the inner catheter is not restricted by the outer catheter and can be freely bent to the target bending angle, the inner catheter lacks the protection and support provided by the outer catheter, and in particular, cannot maintain a specific bending shape, thereby affecting the normal function of the catheter device. To solve this problem, the catheter system can be controlled to execute the retreat free control mode.
[0175] Specifically, in one embodiment, step S302 further includes:
[0176] When the current distance is greater than or equal to the length of the controllable section of the inner catheter, the inner catheter is controlled to move backward at the first target retreat speed and bend to the first target bending angle; the outer catheter is controlled to stay in place and maintain the current bending angle.
[0177] In this embodiment, since the controllable section of the inner catheter has completely extended beyond the end of the outer catheter, it is only necessary to control the inner catheter to retreat and bend accordingly, without the outer catheter following the movement and bending. Specifically, when the current distance D between the end of the inner catheter and the end of the outer catheter is c When D is greater than or equal to the controllable length of the inner catheter, the inner catheter can be controlled to move backward at the first target backward speed and bend to the first target bending angle; at the same time, the outer catheter is controlled to stay in place and maintain the current bending angle. cWhen LengthControl1 is equal to or greater than LengthControl1, the inner catheter's first target retreat speed V1 equals the operator input, and the first target bend angle θ1 equals the operator input; the outer catheter's movement speed V2 equals 0, and the outer catheter's bend angle equals the outer catheter's current angle. Thus, when the current distance is greater than or equal to the inner catheter's controllable segment length, the catheter system is controlled to execute the free retreat control mode, ensuring that the outer catheter provides the necessary protection and support for the inner catheter, and particularly enabling the inner catheter to maintain a specific bend shape.
[0178] As shown in FIG. 24 , in the second embodiment, step S30 further includes:
[0179] Step S303: comparing the current distance with the length of the controllable section of the inner catheter, and the length of the controllable section of the inner catheter inside the outer catheter with the length of the controllable section of the outer catheter;
[0180] Step S304: When the current distance is less than the length of the controllable section of the inner catheter and the length of the controllable section of the inner catheter inside the outer catheter is less than the length of the controllable section of the outer catheter, control the catheter system to execute the retreat control mode.
[0181] In this embodiment, when the current distance between the end of the inner catheter and the end of the outer catheter, the length of the controllable section of the inner catheter, and the length of the controllable section of the inner catheter inside the outer catheter and the length of the controllable section of the outer catheter are obtained, the size relationship between the current distance and the length of the controllable section of the inner catheter, as well as the size relationship between the length of the controllable section of the inner catheter inside the outer catheter and the length of the controllable section of the outer catheter can be compared. When the current distance is less than the length of the controllable section of the inner catheter, and the length of the controllable section of the inner catheter inside the outer catheter is less than the length of the controllable section of the outer catheter, it indicates that the controllable section of the inner catheter and the controllable section of the outer catheter at least partially overlap. In this case, the bending of the inner catheter will be restricted by the outer catheter, resulting in the inner catheter being unable to bend freely to the target bending angle. To solve this problem, the catheter system can be controlled to execute the retreat portion control mode.
[0182] Specifically, as shown in FIG25 , in one embodiment, step S304 further includes:
[0183] Step S3041: When the current distance is less than the length of the controllable section of the inner catheter, and the length of the controllable section of the inner catheter inside the outer catheter is less than the length of the controllable section of the outer catheter, obtaining a target distance between the inner catheter end and the outer catheter end, and calculating a second target retreat speed of the outer catheter based on the target distance, the current distance, and the first target retreat speed;
[0184] In this embodiment, the target distance is a critical threshold for controlling the outer catheter to follow the movement of the inner catheter. Its value is primarily determined by, among other factors, the length and maximum curvature of the inner catheter. In one embodiment, the target distance can be preset empirically. In another embodiment, the target distance can be obtained by calculation. Specifically, the maximum curvature of the inner catheter, the maximum curvature of the outer catheter, the length of the controllable section of the inner catheter, the length of the controllable section of the outer catheter, and a preset adjustment coefficient ε can be obtained; the length difference between the controllable section length of the inner catheter and the controllable section length of the outer catheter and the curvature ratio between the maximum curvature of the inner catheter and the maximum curvature of the outer catheter can be calculated; and the product of the preset adjustment coefficient, the length difference, and the curvature ratio can be calculated to obtain the target distance.
[0185] In this embodiment, the length difference between the controllable length of the inner catheter section LengthControl1 and the controllable length of the outer catheter section LengthControl2 can be calculated: LengthControl1-LengthControl2, and the maximum curvature k of the inner catheter can be calculated. 1max and the maximum curvature k of the outer catheter 2max The curvature ratio between: k 1max / k 2max The target distance D can be calculated using the following formula: f , wherein the preset adjustment coefficient ε can take reasonable values such as 1, 2, etc.:
[0186] It is understood that the target distance is mainly determined by at least one of the parameters such as the length of the controllable section of the inner catheter, the length of the controllable section of the outer catheter, the maximum curvature of the inner catheter, and the maximum curvature of the outer catheter. The target distance can be obtained by calculation using the above formula; it can also be calculated using other formulas, for example, using a preset adjustment coefficient ε, the maximum curvature of the inner catheter k 1max and the maximum curvature k of the outer catheter 2max The target distance can be calculated by, for example,
[0045] or directly preset based on experience. That is, the present application is not limited to obtaining the target distance between the inner catheter end and the outer catheter end through the above embodiment, and other reasonable solutions are also possible, and the present application does not impose any specific limitation on this.
[0187] In this embodiment, as shown in FIG. 26 , in one embodiment, the step S3041 of calculating the second target retreat speed of the outer catheter according to the target distance, the current distance, and the first target retreat speed may further include:
[0188] Step S3411: Calculate a first ratio between the target distance and the current distance;
[0189] Step S3412: Calculate a first product between the first ratio and the first target speed to obtain the second target backward speed.
[0190] In this embodiment, the target distance D can be calculated f The current distance D c The first ratio between: D f / D c , and calculate the first ratio D f / D c The first product between the first target speed V1 and the second target speed V2 can be calculated using the following formula:
[0191] It is understood that the second target retreat speed can also be calculated based on a preset coefficient and the first target speed, can also be directly preset based on experience, or can be calculated by introducing other reasonable parameters. That is, the present application is not limited to the above embodiment to obtain the second target retreat speed of the outer catheter following the movement of the inner catheter, and other reasonable solutions are also possible, and the present application does not specifically limit this.
[0192] Step S3042: Calculate a second target bending angle of the outer catheter based on the length of the controllable section of the inner catheter inside the outer catheter, the length of the controllable section of the inner catheter, and the first target bending angle of the inner catheter;
[0193] In this embodiment, the second target bending angle of the outer catheter can be calculated based on the length of the controllable section of the inner catheter inside the outer catheter, the length of the controllable section of the inner catheter, and the first target bending angle of the inner catheter. As shown in Figure 27, in one embodiment, the step S3042 further includes:
[0194] Step S3421, calculating a second ratio between the length of the controllable section of the inner catheter inside the outer catheter and the length of the controllable section of the inner catheter;
[0195] Step S3422: Calculate a second product between the second ratio and the first target bending angle to obtain a second target bending angle of the outer catheter.
[0196] In this embodiment, a second ratio of the length of the controllable section of the inner catheter within the outer catheter, LengthControl1In, to the length of the controllable section of the inner catheter, LengthControl1, can be calculated: LengthControl1In / LengthControl1, and a second product of the second ratio and the first target bending angle θ1 can be calculated. That is, the second target bending angle θ2 can be calculated using the following formula:
[0197] It is understood that the second target bending angle can also be calculated based on a preset coefficient and the first target bending angle, can also be directly preset based on experience, or can be calculated by introducing other reasonable parameters. That is, the present application is not limited to the above embodiment to obtain the second target bending angle of the outer catheter following the bending of the inner catheter. Other reasonable solutions are also possible and are not specifically limited in the present application.
[0198] It can be understood that when the inner catheter and the outer catheter are in a bent state, the current distance D c It can also be further calculated by combining the controllable length of the inner catheter section LengthControl1, the controllable length of the outer catheter section LengthControl2, the first target bending angle θ1 of the inner catheter and the second target bending angle θ2 of the outer catheter to obtain:
[0199] Step S3043: Control the inner catheter to move backward at the first target backward speed and bend to the first target bending angle; control the outer catheter to move backward at the second target backward speed and bend to the second target bending angle.
[0200] In this embodiment, since the controllable section of the inner catheter and the controllable section of the outer catheter at least partially overlap, the inner catheter and the outer catheter can be controlled to retreat and bend accordingly. Specifically, when the current distance is less than the length of the controllable section of the inner catheter, and the length of the controllable section of the inner catheter inside the outer catheter is less than the length of the controllable section of the outer catheter, the inner catheter can be controlled to move backward at the first target retreat speed and bend to the first target bending angle; at the same time, the outer catheter can be controlled to move backward at the second target retreat speed and bend to the second target bending angle. That is, when D c <LengthControl1 and LengthControl1In<LengthControl2, the first target retracting speed V1 of the inner catheter = operator input, and the first target bending angle θ1 = operator input; the second target retracting speed V2 and the second target bending angle θ2 of the outer catheter are as follows:
[0201] In this way, when the current distance is less than the length of the controllable section of the inner catheter, and the length of the controllable section of the inner catheter inside the outer catheter is less than the length of the controllable section of the outer catheter, controlling the catheter system to execute the retreat part control mode can ensure that the outer catheter provides the necessary protection and support for the inner catheter, and in particular, can also enable the inner catheter to maintain a specific curved shape.
[0202] In addition, in the retreat part control mode, the second target retreat speed V2 of the outer catheter increases with the current distance D c until the second target backward speed V2 of the outer catheter is equal to the first target speed V1 of the inner catheter. Specifically, when the current distance is greater than the target distance, that is, D c >D f When the outer catheter retreats at a speed less than the inner catheter retreats; as the current distance D c The backward speed of the outer catheter gradually increases until it is the same as the backward speed of the inner catheter. When the current distance is less than or equal to the target distance, that is, D c ≤D f When the outer catheter retreats faster than the inner catheter, the current distance D c The outer tube gradually decreases in speed until the retraction speed of the outer tube is the same as the retraction speed of the inner tube. The retraction control mode can prevent the inner tube from retracting into the outer tube, causing the camera at the end of the inner tube to be blocked by the outer tube.
[0203] As shown in FIG. 28 , in the third embodiment, step S30 further includes:
[0204] Step S305: comparing the length of the controllable section of the inner catheter inside the outer catheter with the length of the controllable section of the outer catheter;
[0205] Step S306: When the length of the controllable section of the inner catheter inside the outer catheter is greater than or equal to the length of the controllable section of the outer catheter, control the catheter system to execute the full retreat control mode.
[0206] In this embodiment, when the length of the controllable section of the inner catheter inside the outer catheter and the length of the controllable section of the outer catheter are obtained, the length of the controllable section of the inner catheter inside the outer catheter and the length of the controllable section of the outer catheter can be compared. When the length of the controllable section of the inner catheter inside the outer catheter is greater than or equal to the length of the controllable section of the outer catheter, it indicates that the controllable section of the inner catheter completely contains the controllable section of the outer catheter. At this time, most of the inner catheter is contained in the outer catheter, with only a portion extending out. Since the bending capacity of the inner catheter is generally greater than that of the outer catheter, when the inner catheter needs to bend to an angle that the outer catheter cannot reach, the outer catheter will interfere with the inner catheter, resulting in the inner catheter being unable to bend freely to the target bending angle. To solve this problem, the catheter system can be controlled to execute the full retreat control mode.
[0207] As shown in FIG. 29 , in one embodiment, step S306 further includes:
[0208] Step S3061: When the length of the controllable section of the inner catheter inside the outer catheter is greater than or equal to the length of the controllable section of the outer catheter, calculating a second target bending angle of the outer catheter based on the controllable section length of the inner catheter, the controllable section length of the outer catheter, and the first target bending angle of the inner catheter;
[0209] In this embodiment, the second target bending angle of the outer catheter can be calculated based on the controllable section length of the inner catheter, the controllable section length of the outer catheter, and the first target bending angle of the inner catheter. As shown in FIG30 , in one embodiment, the step of calculating the second target bending angle of the outer catheter based on the controllable section length of the inner catheter, the controllable section length of the outer catheter, and the first target bending angle of the inner catheter in step S3061 further includes:
[0210] Step S3611, calculating a third ratio between the length of the controllable section of the outer catheter and the length of the controllable section of the inner catheter;
[0211] Step S3612: Calculate a third product between the third ratio and the first target bending angle to obtain a second target bending angle of the outer catheter.
[0212] In this embodiment, a third ratio of the outer catheter controllable section length LengthControl2 to the inner catheter controllable section length LengthControl1 can be calculated: LengthControl2 / LengthControl1, and a third product of the third ratio and the first target bending angle θ1 can be calculated. That is, the second target bending angle θ2 can be calculated using the following formula:
[0213] It is understood that the second target bending angle can also be calculated based on a preset coefficient and the first target bending angle, can also be directly preset based on experience, or can be calculated by introducing other reasonable parameters. That is, the present application is not limited to the above embodiment to obtain the second target bending angle of the outer catheter following the bending of the inner catheter. Other reasonable solutions are also possible and are not specifically limited in the present application.
[0214] It can be understood that when the inner catheter and the outer catheter are in a bent state, the current distance D c It can also be further calculated by combining the controllable length of the inner catheter section LengthControl1, the controllable length of the outer catheter section LengthControl2, the first target bending angle θ1 of the inner catheter and the second target bending angle θ2 of the outer catheter to obtain:
[0215] Step S3062: obtaining a preset minimum distance between the end of the inner catheter and the end of the outer catheter, and calculating a target speed of the outer catheter based on the current distance, the preset minimum distance, and the first target backward speed;
[0216] In this embodiment, the preset minimum distance can be obtained based on experience or experiments. By setting the preset minimum distance, the end of the inner catheter can be prevented from being blocked by the end of the outer catheter, thereby not affecting the field of view of the inner catheter. As shown in Figure 31, in one embodiment, the step S3062 further includes:
[0217] Step S3621: obtaining a preset minimum distance between the inner catheter end and the outer catheter end;
[0218] Step S3622: Calculate a fourth ratio between the current distance and the preset minimum distance;
[0219] Step S3623: Calculate the difference between the preset constant and the fourth ratio;
[0220] Step S3624: multiply the fourth product of the difference and the first target backward speed to obtain the target speed of the outer catheter.
[0221] In this embodiment, the preset minimum distance D between the end of the inner catheter and the end of the outer catheter can be obtained. min , calculate the current distance D c and the preset minimum distance D min The fourth ratio between: D c / D min, and calculate the difference between a preset constant such as 1 and the fourth ratio: 1-D c / D min Finally, the fourth product between the difference and the first target backward speed is calculated. That is, the target speed V2 of the outer catheter can be calculated using the following formula:
[0222] It is understood that the target velocity of the outer catheter can also be calculated based on a preset coefficient and the first target velocity, can be directly preset based on experience, or can be calculated by introducing other reasonable parameters. That is, the present application is not limited to the above-described embodiment for obtaining the target velocity of the outer catheter following the movement of the inner catheter; other reasonable solutions are also possible, and the present application does not impose specific limitations on this.
[0223] Step S3063: Control the inner catheter to move backward at the first target backward speed and bend to the first target bending angle; control the outer catheter to move forward or backward accordingly at the target speed and bend to the second target bending angle.
[0224] In this embodiment, since most of the inner catheter is contained in the outer catheter and only a part of it extends out, at least one of the inner catheter and the outer catheter can be controlled to retreat and bend accordingly. Specifically, when the length of the controllable section of the inner catheter inside the outer catheter is greater than or equal to the length of the controllable section of the outer catheter, the inner catheter can be controlled to move backward at the first target retreat speed and bend to the first target bending angle; at the same time, the outer catheter can be controlled to move forward or backward accordingly at the target speed and bend to the second target bending angle. That is, when LengthControl1In≥LengthControl2, the first target retreat speed V1 of the inner catheter = operator input, and the first target bending angle θ1 = operator input (θ1≤θ 2max When θ1=θ 2max (θ1>θ 2max The target velocity V2 of the outer conduit and the second target bending angle θ2 are as follows:
[0225] In this way, when the length of the controllable section of the inner catheter inside the outer catheter is greater than or equal to the length of the controllable section of the outer catheter, controlling the catheter system to execute the backward full control mode can avoid the outer catheter from interfering with the inner catheter, so that the inner catheter can be freely bent to the target bending angle.
[0226] In addition, in the reverse full control mode, the inner catheter moves backward all the time, and the outer catheter moves forward, stays in place, or moves backward. Specifically, when the current distance is greater than the preset minimum distance, that is, D c >D min When the inner catheter moves backward, the outer catheter moves forward; as the current distance D c Gradually decreases to the same as the preset minimum distance, that is, D c =D min When the forward speed of the outer catheter decreases to 0, the outer catheter stops moving forward and the inner catheter continues to move backward; when the current distance is less than the preset minimum distance, that is, D c <D min When , the inner catheter and the outer catheter both retreat, and the retreat speed of the outer catheter is less than the retreat speed of the inner catheter, that is, V2≤V1.
[0227]
[0228] The following description is made in conjunction with FIG32. The present application involves three main catheter control modes (involving only translation, not bending): a free retreat control mode, a partial retreat control mode, and a full retreat control mode. (1) Indicates that during the movement of the inner catheter and the outer catheter, the controllable section of the inner catheter has completely extended beyond the end of the outer catheter. If the current distance is greater than or equal to the length of the controllable section of the inner catheter, the free retreat control mode will be entered. At this time, the first target retreat speed V1 of the inner catheter = the operator input, and the movement speed V2 of the outer catheter = 0; (2) Indicates that during the movement of the inner catheter and the outer catheter, the controllable section of the inner catheter at least partially overlaps with the controllable section of the outer catheter. If the current distance is less than the length of the controllable section of the inner catheter, and the length of the controllable section of the inner catheter inside the outer catheter is less than the length of the controllable section of the inner catheter, the controllable section of the inner catheter at least partially overlaps with the controllable section of the outer catheter. D is less than the length of the controllable section of the outer catheter, it will enter the retreat partial control mode, at this time, the inner catheter moves backward at the first target retreat speed V1; at the same time, the outer catheter moves backward at the second target retreat speed V2; (3) means that during the movement of the inner catheter and the outer catheter, the controllable section of the inner catheter completely contains the controllable section of the outer catheter, if the length of the controllable section of the inner catheter inside the outer catheter is greater than or equal to the length of the controllable section of the outer catheter, it will enter the retreat full control mode, at this time, the inner catheter moves backward at the first target retreat speed V1, and the outer catheter will move backward according to the D c With D min , and moves forward, stays in place, or moves backward accordingly at the second target backward speed V2.
[0229] It can be understood that the solution of this embodiment is applicable to scenarios where rapid movement at a relatively high speed is possible, for example, controlling the movement of a catheter instrument in level 1 to 2 branches of a bronchial cavity.
[0230] The following description is made in conjunction with FIG33. The present application involves three main catheter control modes (involving translation and bending): a free retreat control mode, a partial retreat control mode, and a full retreat control mode. (1) Indicates that during the movement and bending of the inner catheter and the outer catheter, the controllable section of the inner catheter has completely extended beyond the end of the outer catheter. If the current distance is greater than or equal to the length of the controllable section of the inner catheter, the free retreat control mode will be entered. At this time, the first target retreat speed V1 of the inner catheter = the operator input, the first target bending angle θ1 = the operator input, the movement speed V2 of the outer catheter = 0, and the bending angle of the outer catheter = the current angle of the outer catheter; (2) Indicates that during the movement and bending of the inner catheter and the outer catheter, the controllable section of the inner catheter at least partially overlaps with the controllable section of the outer catheter. If the current distance is less than the length of the controllable section of the inner catheter, and the length of the controllable section of the inner catheter inside the outer catheter is less than The outer catheter controllable section length is greater than or equal to the outer catheter controllable section length, then the retreat partial control mode will be entered, at this time, the inner catheter moves backward at the first target retreat speed V1 and bends to the first target bending angle θ1; at the same time, the outer catheter moves backward at the second target retreat speed V2 and bends to the second target bending angle θ2; (3) indicates that during the movement of the inner catheter and the outer catheter, the inner catheter controllable section completely contains the outer catheter controllable section, if the length of the inner catheter controllable section inside the outer catheter is greater than or equal to the length of the outer catheter controllable section, then the retreat full control mode will be entered, at this time, the inner catheter moves backward at the first target retreat speed V1 all the time and bends to the first target bending angle θ1, and the outer catheter will be adjusted according to the D c With D min , it moves forward, stays in place, or moves backward accordingly at the second target backward speed V2, and bends to the second target bending angle θ2.
[0231] That is, no matter what the relative positional relationship between the end of the inner catheter and the end of the outer catheter is, during the retraction control process of the inner catheter and the outer catheter, the bending coordination of the inner catheter and the outer catheter can be achieved through the control of the retraction free control mode, the retraction partial control mode and the retraction full control mode, thereby avoiding the bending of the inner catheter and / or the outer catheter affecting the retraction of the inner catheter and / or the outer catheter.
[0232] Embodiments of the present application also provide a control system for a catheter system. Please refer to Figure 34, which shows a schematic diagram of the structure of a control system for a catheter system provided in one embodiment of the present application. As shown in Figure 34, control system 600 includes: a processor 60, a memory 61, a bus 62, and a communication interface 63. The processor 60, communication interface 63, and memory 61 are connected via bus 62. The memory 61 stores computer program instructions executable by the processor 60. When the processor 60 executes the computer program instructions, it performs the catheter drive control method provided in any of the aforementioned embodiments of the present application.
[0233] The memory 61 may include high-speed random access memory (RAM) and may also include non-volatile memory, such as at least one disk storage. The communication connection between the device network element and at least one other network element is achieved through at least one communication interface 63 (which may be wired or wireless), and may use the Internet, a wide area network, a local area network, a metropolitan area network, etc.
[0234] Bus 62 may be an ISA bus, a PCI bus, or an EISA bus. Such buses may be classified as address buses, data buses, and control buses. Memory 61 is used to store programs, and processor 60 executes the programs upon receiving execution instructions. The catheter drive control method disclosed in any of the aforementioned embodiments of the present application may be applied to or implemented by processor 60.
[0235] The processor 60 may be an integrated circuit chip with signal processing capabilities. During implementation, each step of the above method can be completed by hardware integrated logic circuits in the processor 60 or by software instructions. The processor 60 may be a general-purpose processor, including a central processing unit (CPU), a network processor (NP), etc.; it may also be a digital signal processor (DSP), an application-specific integrated circuit (ASIC), a field-programmable gate array (FPGA), or other programmable logic devices, discrete gate or transistor logic devices, or discrete hardware components. It can implement or execute the various methods, steps, and logic block diagrams disclosed in the embodiments of this application. The general-purpose processor may be a microprocessor or any conventional processor. The steps of the method disclosed in the embodiments of this application can be directly implemented and executed by a hardware decoding processor, or by a combination of hardware and software modules in the decoding processor. The software module can be located in a storage medium mature in the art, such as random access memory, flash memory, read-only memory, programmable read-only memory, electrically erasable programmable memory, registers, etc. The storage medium is located in the memory 61 , and the processor 60 reads the information in the memory 61 and completes the steps of the above method in combination with its hardware.
[0236] The catheter system provided in the embodiment of the present application and the driving control method of the catheter provided in the embodiment of the present application are based on the same application concept and have the same beneficial effects as the methods adopted, operated or implemented therein.
[0237] An embodiment of the present application also provides a computer-readable storage medium corresponding to the catheter drive control method provided in the aforementioned embodiment. Please refer to Figure 35, which shows a computer-readable storage medium 6 on which computer program instructions are stored. When the computer program instructions are executed by a processor, they will implement the catheter drive control method provided in any of the aforementioned embodiments.
[0238] It should be noted that examples of the computer-readable storage medium may include, but are not limited to, optical discs, phase change memory (PRAM), static random access memory (SRAM), dynamic random access memory (DRAM), other types of random access memory (RAM), read-only memory (ROM), electrically erasable programmable read-only memory (EEPROM), flash memory or other optical or magnetic storage media, which are not listed here one by one.
[0239] The computer-readable storage medium provided in the above-mentioned embodiment of the present application and the catheter driving control method provided in the embodiment of the present application are based on the same application concept and have the same beneficial effects as the method adopted, run or implemented by the application program stored therein.
[0240] The above description is merely an optional embodiment of the present application and does not limit the patent scope of the present application. Any equivalent structural transformation made by using the contents of the present application specification and drawings under the application concept of the present application, or directly / indirectly applied in other related technical fields, is included in the patent protection scope of the present application.
Claims
1. A catheter system, characterized in that: The catheter system comprises: Robotic arm; an external catheter instrument, configured to engage with a power portion of one of the robotic arms, the external catheter instrument comprising an external catheter; an inner catheter instrument configured to engage with a power portion of another of the robotic arms, the inner catheter instrument comprising an inner catheter configured to be driven through the lumen of the outer catheter; A processor in communication with the robotic arm, the processor being configured to perform the following steps: Acquire a current distance between the inner catheter end and the outer catheter end, and acquire a target distance between the inner catheter end and the outer catheter end; When the current distance reaches the target distance, the outer catheter is controlled to move following the movement of the inner catheter until the current distance reaches a critical threshold; the critical threshold is the forward distance for controlling the inner catheter to move alone; Wherein, the moving speed of the outer catheter is greater than the moving speed of the inner catheter.
2. The catheter system according to claim 1, characterized in that The processor is configured to perform the following specific steps: receiving, via the user input device, a speed of advancement of the inner catheter; Calculating a following speed of the outer catheter following the movement of the inner catheter according to the current distance, the target distance and the forward speed; The outer catheter is controlled to move at the calculated following speed to follow the movement of the inner catheter.
3. The catheter system according to claim 2, characterized in that The processor is configured to perform the following specific steps: Calculating a ratio between the current distance and the target distance; Calculate the product of the ratio and the forward speed to obtain the outer catheter following The following speed at which the inner catheter moves.
4. The catheter system according to claim 1, characterized in that The processor is configured to perform the following specific steps: Obtaining the length L1 of the inner conduit, the length L2 of the outer conduit, and the distance d between the two power parts; The length L1 of the inner conduit, the length L2 of the outer conduit, and the difference between the distance d between the two power units are calculated to obtain the current distance Dc between the end of the inner conduit and the end of the outer conduit.
5. The catheter system according to claim 1, wherein: The processor is configured to perform the following specific steps: Obtaining the maximum curvature of the inner catheter, the maximum curvature of the outer catheter, the controllable length of the inner catheter, the controllable length of the outer catheter, and a preset adjustment coefficient; Calculating the length difference between the controllable section length of the inner catheter and the controllable section length of the outer catheter, and calculating the curvature ratio between the maximum curvature of the inner catheter and the maximum curvature of the outer catheter; The product of the preset adjustment coefficient, the length difference and the curvature ratio is calculated to obtain the target distance.
6. The catheter system according to claim 1, wherein: The processor is further configured to perform the following steps: When the current distance reaches the target distance, controlling the outer catheter to follow the inner catheter to move forward, and when the inner catheter bends, controlling the outer catheter to bend along with the inner catheter; wherein the moving speed of the outer catheter is greater than the moving speed of the inner catheter, and the bending angle of the outer catheter is smaller than the bending angle of the inner catheter; or The moving speed of the outer catheter is greater than the moving speed of the inner catheter, and the bending angle of the outer catheter is equal to the bending angle of the inner catheter.
7. The catheter system according to claim 6, characterized in that The catheter system further includes a user input device communicatively connected to the robotic arm, and the processor is configured to perform the following specific steps: receiving, via the user input device, an advancing speed of the inner catheter and a target bending angle of the inner catheter, and acquiring a target bending angle of the outer catheter; Calculating a following speed of the outer catheter following the movement of the inner catheter according to the current distance, the target distance and the forward speed; The outer catheter is controlled to advance at the calculated following speed to follow the advancing speed of the inner catheter; and the outer catheter is controlled to bend at the target bending angle to follow the bending angle of the inner catheter.
8. The catheter system according to claim 7, characterized in that The processor is configured to perform the following specific steps: calculating a first ratio between the current distance and the target distance, and a second ratio between a target bending angle of the outer catheter and a target bending angle of the inner catheter; The first ratio, the second ratio, and the product of the first ratio and the advancing speed are calculated to obtain a following speed at which the outer catheter follows the inner catheter.
9. The catheter system according to claim 7, characterized in that The processor is configured to perform the following specific steps: Obtaining a maximum bending angle of the outer catheter; When the target bending angle of the inner catheter is less than or equal to the maximum bending angle of the outer catheter, obtaining the controllable section length of the inner catheter and the controllable section length of the outer catheter; The target bending angle of the outer catheter is calculated according to the target bending angle of the inner catheter, the controllable section length of the inner catheter and the controllable section length of the outer catheter.
10. The catheter system according to claim 7, characterized in that The processor is configured to perform the following specific steps: Obtaining a maximum bending angle of the outer catheter; When the target bending angle of the inner catheter is greater than the maximum bending angle of the outer catheter, Obtain the controllable section length of the inner catheter, the controllable section length of the outer catheter, and the current distance between the end of the inner catheter and the end of the outer catheter; The target bending angle of the outer catheter is calculated based on the target bending angle of the inner catheter, the length of the controllable section of the inner catheter, and the current distance between the end of the inner catheter and the end of the outer catheter.
11. The catheter system of claim 6, wherein: The processor is configured to perform the following specific steps: Obtaining the length L1 of the inner conduit, the length L2 of the outer conduit, the distance d between the two power units, the controllable section length of the inner conduit, the controllable section length of the outer conduit, the target bending angle of the inner conduit, and the target bending angle of the outer conduit; Calculating the difference between the length L1 of the inner conduit, the length L2 of the outer conduit, and the distance d between the two power units, calculating the length ratio between the controllable section length of the inner conduit and the controllable section length of the outer conduit, and calculating the angle ratio between the target bending angle of the outer conduit and the target bending angle of the inner conduit; The product of the difference, the length ratio and the angle ratio is calculated to obtain a current distance Dc between the inner catheter end and the outer catheter end.
12. The catheter system of claim 6, wherein: The processor is further configured to perform the following steps: Acquiring the maximum curvature of the inner catheter, the maximum curvature of the outer catheter, the controllable section length of the inner catheter, the controllable section length of the outer catheter, a preset adjustment coefficient, a target bending angle of the inner catheter, and a target bending angle of the outer catheter; Calculating the length difference between the controllable section length of the inner catheter and the controllable section length of the outer catheter, calculating the curvature ratio between the maximum curvature of the inner catheter and the maximum curvature of the outer catheter, and the angle ratio between the target bending angle of the inner catheter and the target bending angle of the outer catheter; The product of the preset adjustment coefficient, the length difference, the curvature ratio and the angle ratio is calculated to obtain the target distance.
13. A method for driving and controlling a catheter, characterized in that: The driving control method of the catheter comprises the following steps: obtaining the current distance between the inner catheter and the outer catheter ends; When the current distance reaches the target distance, the outer catheter is controlled to move following the movement of the inner catheter until the current distance reaches a critical threshold; the critical threshold is the forward distance for controlling the inner catheter to move alone; Wherein, the moving speed of the outer catheter is greater than the moving speed of the inner catheter.
14. The catheter driving control method according to claim 13, characterized in that: The processor is further configured to perform the following steps: When the current distance reaches the target distance, controlling the outer catheter to follow the inner catheter to move forward, and when the inner catheter bends, controlling the outer catheter to bend along with the inner catheter; wherein the moving speed of the outer catheter is greater than the moving speed of the inner catheter, and the bending angle of the outer catheter is smaller than the bending angle of the inner catheter; or The moving speed of the outer catheter is greater than the moving speed of the inner catheter, and the bending angle of the outer catheter is equal to the bending angle of the inner catheter.
15. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores computer program instructions, and the computer program instructions are configured to be loaded and executed by a processor to implement the steps of the method according to claim 13 or 14.
Citation Information
Patent Citations
System and method for driving medical instrument
CN110891514A
Systems and methods for instrument bending detection
CN115336961A
Catheter bending steering control method, catheter system and storage medium
CN115554568A
Catheter bending steering control method, catheter system and storage medium
CN115715839A
Catheter robot, registration method thereof and readable storage medium
CN115778554A
