[go: up one dir, main page]
More Web Proxy on the site http://driver.im/
Next Article in Journal
Non-Destructive Detection of Soybean Pest Based on Hyperspectral Image and Attention-ResNet Meta-Learning Model
Next Article in Special Issue
Superconducting Self-Shielded and Zero-Boil-Off Magnetoencephalogram Systems: A Dry Phantom Evaluation
Previous Article in Journal
Emerging Methods in Biosensing of Immunoglobin G—A Review
Previous Article in Special Issue
A Generic Pixel Pitch Calibration Method for Fundus Camera via Automated ROI Extraction
You seem to have javascript disabled. Please note that many of the page functionalities won't work as expected without javascript enabled.
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Planning of Medical Flexible Needle Motion in Effective Area of Clinical Puncture

School of Automation, Guangxi University of Science and Technology, Liuzhou 545006, China
*
Authors to whom correspondence should be addressed.
Sensors 2023, 23(2), 671; https://doi.org/10.3390/s23020671
Submission received: 8 November 2022 / Revised: 20 December 2022 / Accepted: 4 January 2023 / Published: 6 January 2023
(This article belongs to the Collection Biomedical Imaging & Instrumentation)
Figure 1
<p>General surgical planning based on pulmonary nodules. Techniques such as High-Resolution CT (HRCT), endobronchial ultrasonography (EBUS), and electromagnetic navigation bronchoscope (ENB) are commonly used for lung cancer screening. Transthoracic needle aspiration (TTNA) and bronchial needle aspiration (TBNA) are commonly used for lung cancer treatment; the former is less invasive but requires the needle to be passed through the chest wall from outside the body, which may lead to pneumothorax; the latter is less dangerous but often fails to reach the outer regions of the lung.</p> ">
Figure 2
<p>Three key technologies for robot-assisted puncture.</p> ">
Figure 3
<p>(<b>Right</b>): Effect of different puncture directions at fixed puncture points (light blue), both reaching the nodes of the lung parenchyma (pink) while avoiding important anatomical structures such as bronchi (yellow) and other tissues (gray). (<b>Top left</b>): Enlarged view of the effect after RCS* planning for different puncture directions. Each trajectory corresponds to the best trajectory for a certain puncture direction, with the red trajectory corresponding to the best direction. (<b>Bottom left</b>): The paths after planning for different puncture directions (black, green, yellow, purple) at the starting point (blue) can all reach the target point (pink) while avoiding obstacles (red), and the path corresponding to the lowest cost is chosen as the best puncture direction.</p> ">
Figure 4
<p>The kinematics of a bevel-tip flexible needle.</p> ">
Figure 5
<p>Feasible angle and effective area for flexible needle puncture. (<b>a</b>) describes the minimum puncture physiological angle <math display="inline"><semantics> <mi>α</mi> </semantics></math>. A denotes the punctured plane, gray represents the tissue, red represents the obstacle and <math display="inline"><semantics> <mi>τ</mi> </semantics></math> is the target tolerance. (<b>b</b>) describes the effective puncture region (green), the yellow region corresponds to the <math display="inline"><semantics> <mi>α</mi> </semantics></math> region in (<b>a</b>), and the point cloud normal vector (red) points from the center of the sphere to the sphere with the opposite puncture direction (blue).</p> ">
Figure 6
<p>All possible puncture directions are shown in (<b>a</b>). In (<b>b</b>), all valid directions are shown in green, with red in the obstacle environment denoting the direction in which a viable puncture path is present and blue denoting the direction in which a viable puncture path is absent.</p> ">
Figure 7
<p>Results after RCS* planning, where the starting point (light blue) and all light green represent all valid paths of <math display="inline"><semantics> <msub> <mi>x</mi> <mrow> <mi>g</mi> <mi>o</mi> <mi>a</mi> <mi>l</mi> <mo>_</mo> <mn>2</mn> </mrow> </msub> </semantics></math> (dark green). Purple represents all valid puncture paths of <math display="inline"><semantics> <msub> <mi>x</mi> <mrow> <mi>g</mi> <mi>o</mi> <mi>a</mi> <mi>l</mi> <mo>_</mo> <mn>1</mn> </mrow> </msub> </semantics></math> (pink). Red and dark blue are the best paths.</p> ">
Figure 8
<p>(<b>a</b>–<b>c</b>) represent the directions of the effective paths (blue) and the best puncture directions (red) obtained by running the algorithm with the starting point position <math display="inline"><semantics> <msub> <mi>p</mi> <mrow> <mi>s</mi> <mi>t</mi> <mi>a</mi> <mi>r</mi> <mi>t</mi> </mrow> </msub> </semantics></math> and the puncture effective direction (yellow) at the target point <math display="inline"><semantics> <msub> <mi>x</mi> <mrow> <mi>g</mi> <mi>o</mi> <mi>a</mi> <mi>l</mi> <mo>_</mo> <mn>1</mn> </mrow> </msub> </semantics></math> for RCS, RCS* and RRT. Similarly, (<b>d</b>–<b>f</b>) represent the case when the starting point position is <math display="inline"><semantics> <msub> <mi>p</mi> <mrow> <mi>s</mi> <mi>t</mi> <mi>a</mi> <mi>r</mi> <mi>t</mi> </mrow> </msub> </semantics></math> and target point is <math display="inline"><semantics> <msub> <mi>x</mi> <mrow> <mi>g</mi> <mi>o</mi> <mi>a</mi> <mi>l</mi> <mo>_</mo> <mn>2</mn> </mrow> </msub> </semantics></math>.</p> ">
Figure 9
<p>Puncture trajectory cost line chart. (<b>a</b>) represents the line graph of three sets of “Cost” in <a href="#sensors-23-00671-t002" class="html-table">Table 2</a> and similarly, (<b>b</b>) represents the line chart of “Cost” in <a href="#sensors-23-00671-t003" class="html-table">Table 3</a>.</p> ">
Review Reports Versions Notes

Abstract

:
Lung cancer is the leading cause of cancer deaths worldwide. Although several lung cancer diagnostic methods are available for lung nodule biopsy, there are limitations in terms of accuracy, safety, and invasiveness. Transbronchial needle aspiration (TBNA) is a common method for diagnosing and treating lung cancer that involves a robot-assisted medical flexible needle moving along a curved three-dimensional trajectory, avoiding anatomical barriers to achieve clinically meaningful goals in humans. Inspired by the puncture angle between the needle tip and the vessel in venipuncture, we suggest that different orientations of the medical flexible needle puncture path affect the cost of the puncture trajectory and propose an effective puncture region based on the optimal puncture direction, which is a strategy based on imposing geometric constraints on the search space of the puncture direction, and based on this, we focused on the improved implementation of RCS*. Planning within the TBNA-based lung environment was performed using the rapidly exploring random tree (RRT), resolution-complete search (RCS), and RCS* (a resolution-optimal version of RCS) within an effective puncture region. The experimental results show that the optimal puncture direction corresponding to the lowest cost puncture trajectory is consistent among the three algorithms and RCS* is more efficient for planning. The experiments verified the feasibility and practicality of our proposed minimum puncture angle and puncture effective region and facilitated the study of the puncture direction of flexible needle puncture.

1. Introduction

Lung cancer is the leading cause of cancer deaths worldwide, with more people dying each year from lung cancer than prostate, breast, and colon cancers combined [1,2], and has the lowest survival among other common cancers. The fact that most cases of lung cancer are not discovered until late in life is one reason that it is so fatal, and early diagnosis and treatment are effective ways to improve survival. Currently, flexible bronchoscopy or transbronchial needle aspiration (TBNA) is the most common treatment for lung cancer. Different treatment strategies were used to determine the type of lung nodules, and their overall diagnosis and treatment regimen [3] are shown in Figure 1.
Suspected lung nodules in early lung cancer are often exceptionally small and profound inside the lungs, making it difficult for specialists to analyze them precisely. Even though numerous symptomatic strategies are accessible for the biopsy of lung nodules, they have impediments to accuracy, security, or invasiveness.
Transbronchial needle aspiration (TBNA) involves a robot-assisted medical flexible needle. The concept of flexible needle control was first proposed by DiMaio et al. [4,5]. A flexible needle made of a special material with a variable puncture path has become the new favorite in piercing devices. With the minimally invasive, safe, and feasible nature of robotic puncture, robot-assisted flexible needle puncture can skillfully use the flexion of the needle shaft to avoid anatomical obstacles such as nerves, blood vessels, and bones and flexibly and precisely reach target locations that cannot be reached by traditional rigid needles, minimizing surgical trauma and increasing the speed of patient recovery after surgery. At present, research on robot-assisted puncture technology mainly includes three aspects [6]: (1) regional information sensing technology; (2) navigation and interaction control; and (3) puncture and motion planning. This is shown in Figure 2. Among them, the flexible needle puncture motion planning algorithm will be mainly studied here. For flexible needle puncture to be accepted clinically, it is important to verify the correctness and effectiveness of the motion planning algorithm involved in robot-assisted flexible needle automatic puncture from the point of view of patient care, safety, and supervision.
In the obstacle environment, the direction of the starting point will affect the puncture path. Assuming that the needle axis does not rotate, the starting direction of the puncture is the decisive factor. We searched a large number of papers on algorithms related to puncture orientation in the literature and found that scholars stress the importance of puncture orientation. For example, the AHFT (Adaptive Hermite Fractal Tree) proposed by Pinzi et al. [7] was able to determine the region and direction of the puncture site based on the location and direction of the target, but they did not take into account the differences in the optimal solution of the movement path due to the puncture direction when planning the movement. Meng Yu Fu et al. [8] planned the path with RCS* (a resolution-optimal version of resolution-complete search (RCS)) through the coordinates and directions of the given starting and target points. However, when the starting point is different, the growth direction of the tree will be different. Therefore, given the target point and direction, there is no guarantee that the planned path after the current puncture point is optimal. Based on the rapidly exploring random tree (RRT) algorithm, Zhang et al. [9,10] proposed a strategy of adapting some of its parameters for different tissues during insertion, which enhances the security of surgeries. The practicality of their study would be improved if the puncture direction was considered. In summary, existing flexible needle motion planning algorithms do not pay attention to the effect on the puncture path due to differences in the puncture starting direction, and, to the best of our knowledge, such a study is not available in the current literature.
The minimum physiological angle and effective area of puncture are first analyzed and expounded in this paper. A spherical point cloud with a diameter of 1 mm is created at the starting point of the puncture, and the opposite direction of the normal vector of the point cloud is used as the puncture direction. Taking the TBNA (bronchial needle aspiration)-based lung environment as an example, the obstacle area, starting point, and target were established. Finally, the path with the lowest cost was found in the area where the puncture was feasible. The experimental results showed that the best puncture direction was in the area where the puncture direction was effective when the puncture starting point was determined, as shown in Figure 3. In Section 2 below, the research status of relevant algorithms and the principles of puncture kinematics are introduced. The flexible needle puncture is defined and assumed in detail in Section 3. Section 4 describes the improved RCS* algorithm and its enhancements. Section 5 covers simulation studies in a 3D environment to validate the algorithm’s superiority. Section 6 presents our conclusions and the algorithm’s benefits.

2. Related Work

2.1. Three-Dimensional Static Puncture Motion Planning

The rapidly exploring random tree (RRT) algorithm [11] is a sample-based method for obtaining puncture pathways. Patil et al. proposed an RRT-based needle motion planning algorithm [12] that allows rapid path correction using Lie group symmetry without a clear control strategy, but it samples in 3D workspaces rather than configuration spaces, making the probability of completeness of the original RRT uncertain. To avoid directly addressing curvature constraints in the RRT algorithm, there is a hybrid approach combining sampling and other techniques, such as Favaro et al. [13], who recommend the use of RRT*, a sample-based heuristic search to define the asymptotically optimal solution for path length, followed by a smoothing phase to meet the required kinematic constraints of the needle.
Liu, Fangde, et al. [14] proposed an adaptive fractal tree for needle steering (AFT), using GPU to further accelerate the computation of their method iteratively to extract the cheapest plan from the previous iteration, but the best plan for extracting coarse resolution does not necessarily yield the best plan for higher resolution.
Meng Yu Fu et al. [15] presented the first resolution-complete but not the resolution-optimal manipulable needle motion planner (RCS), for steerable needles. If there is a puncture path, the RCS will find motion planning in a limited time, provided the parameter resolution is good enough, but it does not guarantee motion planning costs. Then, they enhanced the RCS, which explores the state space similarly to A*, with cost-conscious repetitive pruning combined with motion planning costs to improve efficiency. This new approach is called RCS* [8], which is a resolution optimization version of the RCS. It shows excellent practicability in operation time and provides a strong theoretical guarantee for the integrity of motion planning and global optimization in a limited time. Multiresolution motion planning algorithms facilitate future hardware implementations, but the algorithm is essentially static planning, does not consider the relative motion of needle tissue, and only includes the internal biopsy of the bronchoscope.
Hoelscher et al. [16] combined the robustness of inverse planning with the rapidity of the search method to propose a new sampling-based planning method for a steerable needle lung robot, and two speedup strategies were introduced: One strategy is based on imposing geometric constraints on the search space, and the other strategy tree extension toward regions of interest. The effective puncture area proposed in our paper is based on the first strategy. We propose a strategy based on the minimum puncture angle and the effective puncture region, which is based on the imposition of geometrical constraints on the search space in the direction of the puncture. Wu et al. [17] reviewed the development status of flexible steerable needle puncture (FSNP) surgical robots and noted that research on FSNP robots and related technologies is still evolving but lacks depth in many aspects, and so greater efforts and more research are required by those interested in FSNP to promote the early realization of large-scale applications of FSNP technology.
According to the characteristics of the algorithm, the above flexible needle motion planning algorithm is compared in Table 1. Only the RCS* algorithm has the best resolution and is beneficial for hardware implementation. AHFT considers resolutions from coarse to fine but relies on GPU threads. AFT, RRT, and RRT* all have probabilistic completeness due to being sample-based.

2.2. Three-Dimensional Dynamic Puncture Motion Planning

The main factor affecting the accuracy of puncture is the target position error caused by needle and soft tissue interaction during puncture. In most minimally invasive surgeries, the margin of error for puncture is generally within millimeters, which can also lead to severe complications [18]. The clinical puncture process is greatly influenced by the unconscious movement of the patient during the procedure (e.g., breathing, heartbeat, muscle pulsation during pain, etc.) and the influence of physiological reactions (e.g., gland swelling), as well as changes in soft tissue properties (e.g., changes in soft tissue material properties at different stages of the lesion) [19]. Therefore, dynamic puncture is more compatible with human physiology than static puncture motion planning. It is a trend to transition static motion planning algorithms to dynamic planning.
Duindam et al. [20,21] first constructed target functions, plotted and optimized needle tail motion trajectories based on distance, tissue damage, and controlled energy parameters, and then used inverse kinematics to solve time-dependent motion planning problems and obtain needle tip optimization pathways without providing theoretical guarantees. Yinoussa et al. [22] presented a new method of automatic steering of robotic needles in deformable tissues, taking into account any deformation of the needle and the trajectory itself. By giving a safe puncture path in advance, according to the deformation of tissue, the points on the needle axis can be obtained by inverse kinematics deconstruction, and the attitude can be adjusted in real time, which is of great significance for robot-assisted puncture control research.

3. Definitions and Assumptions

3.1. Flexible Needle Puncture Kinematics

Flexible needles made of special materials are controlled by the insertion and rotation of their base to control the trajectory of the needle movement, regardless of the deformation of the tissue during needle penetration. During needle penetration, the needle has only two degrees of freedom, axial displacement v and axial rotation ( w t i p and w b a s e ), and the asymmetric force exerted by the bevel due to the asymmetry of the piercing needle tip causes the needle to produce a bent trajectory, as shown in Figure 4. The maximum curvature of the needle in the tissue, k m a x , is influenced by the bevel angle of the needle tip and the properties of the tissue [23], and the curvature of the needle motion neglecting the properties of the tissue depends entirely on the needle tip bevel angle [24].

3.2. Flexible Needle Puncture Motion Planning

The precise definition of the research problem is helpful to the research. Robot-assisted puncture is a multidisciplinary engineering difficulty, of which motion planning is a branch. Conventional puncture procedures use rigid puncture needles; the flexible needle is a variable curvature puncture needle with the advantage of avoiding anatomical obstacles with the help of a curved trajectory. Therefore, the flexible needle puncture motion planning technology is equivalent to autopilot technology in the automotive field.
We used transbronchial needle aspiration biopsy (TBNA) as an example to construct a lung simulation environment in which vascular, bronchial bone, and other tissues are punctured as obstructions with a known directionally indeterminate starting point and a target. Therefore, the core of flexible needle puncture motion planning is to plan a collision-free path with constant curvature from start to target in a simulated lung environment.

3.3. Planning Assumptions for Flexible Needle Puncture Motion

One of the biggest challenges of flexible needle puncture is to ensure that the needle reaches its target location accurately. The movement of tissues and organs in the body, as well as the flexible nature of the needle, make needle movement uncertain and therefore require motion planning to ensure that the needle reaches the target location accurately. Many factors also need to be considered when planning the movement of a flexible needle puncture to ensure that the needle reaches the target location accurately, including the physical properties of the needle, the properties of the soft tissue, the movement of the organ, and the contraction of the muscle. Combining the characteristics of flexible needle puncture, we proposed the following assumptions.
  • During needle puncture, the shape, size, curvature, and other characteristics of the needle determine the needle movement and directly affect the success rate of needle puncture. The needle is subject to resistance from soft tissues, which leads to changes in the trajectory of the needle movement. Therefore, we assume that the special material of flexible needles used [15,18] is sufficiently flexible. The needle tip bends with maximum curvature k m a x as it passes through the tissue, and the needle tail trajectory strictly follows the needle tip trajectory, with w t i p and w b a s e remaining constant.
  • Soft tissues may have heterogeneous density and strength and may also be subject to external forces, such as respiration or muscle contraction, which may affect needle movement. We assume that the soft tissues have uniform density and strength as well as the same structure and friction coefficient during puncture and that the position of the surrounding tissues and the target site do not move relative to each other during the puncture.
  • During needle puncture, visual sensors or other sensors can be used to measure the needle position and attitude, as well as the needle moment and angular velocity in real-time, and to adjust the needle trajectory to stay on the planned trajectory using the robot’s motion control system. Since the needle trajectory needs to be predicted by planning algorithms, some algorithms with multiresolution properties, such as resolution-complete search (RCS), and RCS* (a resolution-optimal version of RCS), generate paths with very small spaced nodes, which may not be possible by the robot’s motion control system. Therefore, we assume that a control system exists that can adjust the needle trajectory with minimal resolution.

4. Methods

4.1. Problem Description

Suppose there exists a three-dimensional workspace W R 3 where the obstacle space W o b s W . Suppose the configuration space X S E 3 where the pinpoint position is located; then, for any point x = p , q X , where p is the position and q is the direction, p R 3 , q S O 3 . x = ( p , q ) is collision-free only when p W o b s , and X f r e e is the set of all collision-free points. Let the trajectory of the needle tip σ : 0 , l X, l be the length of σ and denote the length of the trajectory σ trajectory by l σ and s 0 , l , σ s X f r e e .
Meng Yu Fu et al. [8,25] proposed two methods for calculating configuration space-based costs: One defines the cost of a motion plan as the integral of σ along a given trajectory, i.e., C σ = 0 l c σ s d s . The other is a method to automatically extract a cost map from CT images of the lung, encoding the obstacle, which is associated with the presence of each location in the anatomical structure corresponding to the approximate likelihood of the presence of blood vessels. The first one is used in this paper.
In venipuncture, the success rate and the degree of patient pain are related to the angle of needle entry and the orientation of the needle entry, which is preferable from above the vessel at 40° for better venous conditions and from above or lateral to the vein at 20° for fine and superficial veins [26]. In the same way, during flexible needle TBNA (trans-bronchial needle aspiration), the entry angle of the needle tip into the tissue is not arbitrary, and there exists a certain minimum physiological angle α . When the angle between the entry direction and the surface of the tissue to be punctured is less than α , the puncture is invalid. The yellow area in Figure 5b corresponds to the α region in Figure 5a, and the green area is the effective direction region, expressed in the polar coordinate system as:
x 0 = p s t a r t x + s i n θ c o s φ y 0 = p s t a r t y + s i n θ c o s φ z 0 = p s t a r t z + c o s θ
where θ 0 , π 2 α , φ 0 , 2 π , p s t a r t x , p s t a r t y , p s t a r t z is the puncture start point location, and x 0 , y 0 , z 0 is the effective regional spherical point cloud, which we call Q v a l i d S O 3 . The corresponding normal vectors n x 0 , n y 0 , n z 0 for each point cloud are:
n x 0 = s i n θ c o s φ n y 0 = s i n θ c o s φ n z 0 = c o s θ
The point cloud’s normal vector direction points from the center of the sphere to the surface, like the arrow in red in Figure 5b. The actual puncture direction q x 0 , q y 0 , q z 0 at the puncture start point in the effective puncture region should be opposite to the point cloud normal vector:
q x 0 = n x 0 q y 0 = n y 0 q z 0 = n z 0
This is shown by the blue arrow in Figure 5b.
We describe the definition of the piercing movement planning problem in Section 3.2 as follows:
Set static motion planning parameters = ( X , W o b s , x s t a r t , p g o a l , τ , α , l max , k max , C ) , where X is the manipulable space of the needle tip, W o b s is the obstacle space, X s t a r t is the puncture starting point, p g o a l is the puncture target point, τ is the fault tolerance distance between the needle tip and the target point, τ > 0 , α is the physiological minimum puncture angle, l m a x is the maximum puncture depth, k m a x is the maximum puncture curvature of the flexible needle, and C is the trajectory cost.
Set the project P r o j · : X W . Using the algorithm, calculate each P r o j x = p , if P r o j x W o b s ; then, the point is collision-free, and all P r o j x W o b s composed of is a collision-free and curvature-controlled path from the starting point to the target point.
Based on the above definition, the optimal path is defined as σ * = a r g m i n σ C σ , provided that σ is valid and the following conditions are satisfied:
1.
σ 0 = x s t a r t ;
2.
l σ l m a x ;
3.
k k m a x ;
4.
P r o j σ l σ p g o a l 2 τ ;
5.
p W o b s ;
6.
x s t a r t q Q v a l i d .
The mathematical description of the flexible needle motion planning problem improves the logic of the problem. In the following sections, we will show the puncture effect and the corresponding algorithm after embedding the RCS* algorithm into the effective puncture region.

4.2. Algorithm Description

RCS* [8] is the first flexible needle puncture motion planning algorithm with resolution-optimal. We upgraded RCS* to Algorithm 1 by using the strategy provided in Section 4.1 for minimum physiological puncture angle and effective puncture area.
Algorithm 1 Improved RCS*
Input: W o b s , x s t a r t , p g o a l , τ , α , l m a x , k m a x , δ l m a x , R m i n
1:
θ { 0 , π / 2 , π , 3 π / 2 } , K 0 , k m a x
2:
root ( x s t a r t , 0 , 0 )
3:
OPEN r o o t , CLOSED , bestPlan ← NULL
4:
for ValidDirection ( x s t a r t , p g o a l , α ) do
5:
        While not OPEN.empty() do
6:
              v OPEN.extract()
7:
              if Valid ( v , W o b s , p g o a l , l m a x )  then
8:
                   if CLOSED.existDuplicate ( v )  then
9:
                        if GoalReached ( v , p g o a l , τ )  do
10:
                             bestPlan.update ( v , x s t a r t )
11:
                 for M Primitives ( K , δ l m a x , θ ) do
12:
                        OPEN.insert ( v M )
13:
                 CLOSED.insert ( v )
14:
       if v ! = r o o t then
15:
            for M RefinedPrimitives ( M v ) do
16:
                if ValidResolution ( M , R m i n ) do
17:
                        OPEN.insert ( v . p a r e n t M )
18:
return bestPlan
Algorithm 1 is our improved version of RCS*, which is also resolution-optimal and includes the following ideas:
  • Search Tree: By constructing a search tree Γ = ( V , E ) with predefined multiresolution motions in the configuration space, the search tree is based on a given start configuration x s t a r t and explores the effective motion plan as it unfolds in the configuration space.
  • Reachable Detection (line 7): The curvature restriction removes some nodes that are unlikely to be the final path. It is only necessary that the distance between the target point and the boundary of the reachable region is less than τ , excluding nodes where the needle tip turns more than 90 degrees.
  • Duplicate Detection (line 8): This is the case if there are similar and identical nodes in the search tree to be deleted. v M (line 12) means that the next node will be performed, and v will be put into CLOSED (line 13).
  • Motion Primitive: The Motion Primitive is defined as M = ( k , δ l , δ θ ) , where the curvature is k 0 , k m a x , arc length is δ l > 0 , and needle base is w b a s e rotation angle δ θ [ 0 , 2 π ) .
  • Cutoff Resolution (line 11): The minimum needle insertion δ l m i n and the minimum needle axis rotation δ θ m i n are taken as the shear resolution, and the node is not updated when the kinematic element M satisfies R m i n = δ l m i n , δ θ m i n .
  • Multithreaded: The task of each thread is to process the nodes extracted from the open list, making it possible to process the nodes in parallel.
Lines 4 and 10 are the improvements made in this paper. For any given puncture start point, if the current puncture direction is valid (line 4), i.e., x s t a r t q Q v a l i d , a sphere of spherical diameter 1 mm is first created with the puncture start point as the center of the sphere and refined to 544 points as possible puncture directions (Figure 6a). The puncture direction shown in Figure 6b is obtained according to the method shown in Equations (1)–(3). The green area in Figure 6b is the valid direction of puncture, corresponding to the green area in Figure 5b. The red color represents the effective puncture direction that may exist after the program is run in the obstacle environment. Each puncture direction corresponds to an optimal path, and the path with the lowest cost is selected at line 10 in comparison with the paths in other directions.
After the puncture direction is feasible, nodes are iteratively extracted from the OPEN list (line 5). Given an extracted node v, we first check that it is valid (line 6) using the condition described by RCS* to ensure that the insertion length does not exceed l m a x and that the target region is reachable after node v differs from another node, where the nodes are sorted according to their rank and secondary metric. In addition, RCS* checks if the cost is less than the cost of the best plan found thus far to reach the target region (line 10) and updates the best paths for all puncture directions thus far.

5. Results

We use lung environment point clouds to validate the improvements proposed in this paper for RCS*. All experiments were performed on an Intel(R) Core(TM) i5-7200U CPU (2.50 GHz × 4) with 8G RAM and Ubuntu 18.04.6. Puncture start point coordinates: x s t a r t [ ( 64.83240 , 139.4900 , 654.0964 ) , ( q s t a r t x , q s t a r t y , q s t a r t z ) ] , target point x g o a l _ 1 [ ( 105.8713 , 158.2018 613.2506 ) , ( 0.9141270 , 0.1681980 , 0.3688930 ) ] and x g o a l _ 2 [ ( 115.8713 , 148.2018 , 603.2506 ) , ( 0.4141270 , 0.3681980 , 0.1688930 ) ] . The flexible needle: k m a x = 50 mm 1 , l m a x = 100 mm, diameter d = 2 mm, α = 20°, and set the target tolerance, τ = 1.0 mm. All runs resulted in the smallest puncture trajectory length within 1 s of the run.
Our strategy of imposing punctured effective regions on the search space was applied to a rapidly exploring random tree (RRT), resolution-complete search (RCS), and RCS* (a resolution-optimal version of RCS). Figure 7 shows the effect of the planning of two different targets for the improved RCS* proposed in this paper, with dark blue representing the best puncture path for x g o a l _ 1 and red representing the best puncture path for x g o a l _ 2 . Figure 8, Table 2 and Table 3 show the effective puncture directions and their detailed results. The blue dots in Figure 8 indicate the directions of the existence of valid paths obtained by different algorithms calculated in the current lung environment, reflecting the capabilities of different algorithms. Figure 8a–c list the effective puncture regions (green) corresponding to x s t a r t and x g o a l _ 1 , and the blue dots correspond to the directions of different algorithms in Table 2. Similarly, (d), (e) and (f) represent the case when the starting point position is p s t a r t and target point is x g o a l _ 2 .
Table 2 lists the costs of the planning results of the three improved algorithms from the starting point x s t a r t to the target points x g o a l _ 1 and x g o a l _ 2 , where the planning cost represents the puncture trajectory length, and ( q s t a r t x , q s t a r t y , q s t a r t z ) is the value of q x 0 , q y 0 , q z 0 . Taking RCS* in Table 2 as an example, there are 10 directions of the planned path corresponding to 9 blue points and 1 red point in Figure 8b, and this red point also corresponds to the bolded part of the 6th row of RCS* in Table 2. According to Equations (1)–(3), we can also obtain the coordinates of the sphere of this red point in Figure 8b:
( x 0 , y 0 , z 0 ) r e d = q s t a r t x , q s t a r t y , q s t a r t z + p s t a r t x , p s t a r t y , p s t a r t z = 64.83240 , 139.4900 , 654.0964 + 0.8923680 , 0.2382610 , 0.3832890 = 63.94000 , 139.2510 , 654.4790
In addition, the red point in Figure 8b is the best puncture direction, which corresponds to the planned trajectory of the blue puncture path in Figure 7, and the starting point and target point of the trajectory are blue and pink, respectively. The other nine blue points correspond to the purple puncture path in Figure 7. Similarly, the same applied to RCS and RRT in Table 3. The difference between Table 2 and Table 3 is the change in the target location for x g o a l _ 2 . It is found that the rapidly exploring random tree (RRT), resolution-complete search (RCS), and RCS* (a resolution-optimal version of RCS) algorithms run with the direction of (0.892368, −0.238261, −0.383289) (bolded in Table 2) have the lowest cost of puncture (puncture trajectory length), with the RCS* algorithm giving the best results. Figure 8d–f list the effective puncture regions (yellow) corresponding to x s t a r t and x g o a l _ 2 , and the blue points correspond to the directions of the different algorithms in Table 3. It is found that the RCS, RCS* and RRT algorithms run with the direction of (0.924466, 0.001275, −0.381263) (bolded in Table 3) have the lowest cost of puncture (puncture trajectory length), with the RCS* algorithm giving the best results.
The six sets of “Cost” in Table 2 and Table 3 have been integrated into two line charts (Figure 9a,b, respectively). If we do not dilute the spherical point cloud to 544, it will be a set of concave curve graphs. Our proposed effective puncture area was similar to the range of gray dotted lines in Figure 9a,b. Our approach is to move the dotted area to the best evaluation interval or reduce the d value by geometrical constraints.
Most of the RCS* in Figure 9a,b are below the RCS or RCS* curves, due to the different sample sizes of each algorithm and the 1 s per planning time frame, which we abandoned to estimate the total cost by integrating the curves with the x-axis. Critically, Meng Yu Fu’s experiments [15] have shown that RCS* exhibits significant performance in terms of actual total consumption cost. The average and cost before reaching the lowest of the six groups in Table 2 and Table 3 have been integrated into Table 4. Based on the characteristics of the data in Table 4 and the trends in Figure 9a,b, we decided to consider the average cost to describe the planning efficiency of the algorithm and the cost before reaching the minimum cost to describe the planning rapidity of the algorithm.
The experiments in this paper revolve around the point cloud, and the lung environment is used as an example to establish the obstacle area, the starting point and the target point. A spherical point cloud with a spherical diameter of 1 is established with the puncture starting point as the center of the sphere, and the inverse of the point cloud normal vector is used as the puncture direction. We focus on the RCS* described, using the rapidly exploring random tree (RRT), resolution-complete search (RCS), and RCS* (a resolution-optimal version of RCS) algorithms in the puncture feasible region, which is the effective region proposed in this paper. In the effective region, the experimental data of puncture planning for all effective puncture directions of two different target points and starting points are analyzed by three algorithms to find the path with the smallest puncture trajectory from the starting point to the target point, whose corresponding direction is the best puncture direction, and to explore the connection between them and find the law. The experimental results found that the optimal puncture trajectory corresponding to the puncture direction is the same for the three algorithms.
Figure 7 shows the planning effect of the puncture effective region proposed in this paper to improve RCS*, and the method of the effective region proposed in this paper can also be transferred to RCS and RRT. Table 2 and Table 3 show the planning effect of these three algorithms through data, and the results show that the best puncture direction of each algorithm planning result is consistent, which directly reflects the rationality and the best puncture direction of the puncture effective region and the best puncture direction proposed in this paper. Figure 8 and experimental data show that the three algorithms have the best RCS* and the second-best RRT in terms of trajectory cost. In summary, the optimal (trajectory length) puncture trajectory exists in the effective region corresponding to the puncture direction ( q s t a r t x , q s t a r t y , q s t a r t z ) in the case where the puncture start point p s t a r t is determined.

6. Conclusions

Inspired by the puncture angle between the needle tip and the vessel in venipuncture, in this paper, we suggest that the different orientations of the medical flexible needle puncture path will affect the cost of the puncture trajectory and conducted an experimental study. We proposed the optimal puncture direction, in which geometric constraints are imposed to propose an effective puncture region.
The improved RCS* algorithm was tested in a simulated lung environment, and the comparison of the planning data of rapidly exploring random tree (RRT), resolution-complete search (RCS), and RCS* (a resolution-optimal version of RCS) algorithms showed that the optimal puncture direction was found to exist within the valid region of the puncture direction that determined the puncture starting point, and the optimal puncture direction was consistent among the three algorithms. The higher planning efficiency of the RCS* was found by comparing the average cost and the cost before achieving the optimal direction. The experiments verified the feasibility and practicality of our proposed minimum puncture angle and puncture effective region and facilitated the study of the puncture direction of flexible needle puncture. We have built a set of devices that can achieve fine resolution, and in the future, we will subject RCS* to dynamic puncture motion planning.

Author Contributions

Conceptualization, S.F.; methodology, S.F.; software, S.F.; validation, S.F.; investigation, S.F.; data curation, W.J.; visualization, W.J.; writing—original draft preparation, S.F.; writing—review and editing, S.W.; project administration, S.W. and X.G. All authors have read and agreed to the published version of the manuscript.

Funding

This research was funded by National Key R&D Program “Active Health and Aging Science and Technology Response” Special Project (Grant No. 2020YFC2008503) and Innovation Project of Guangxi Graduate Education (Grant No. YCSW2022440) and National Innovation and Entrepreneurship Training Program for College Students (Grant No. 202210594045).

Institutional Review Board Statement

Not applicable.

Informed Consent Statement

Not applicable.

Data Availability Statement

Not applicable.

Conflicts of Interest

The authors declare no conflict of interest.

References

  1. Sung, H.; Ferlay, J.; Siegel, R.L.; Laversanne, M.; Soerjomataram, I.; Jemal, A.; Bray, F. Global Cancer Statistics 2020: GLOBOCAN Estimates of Incidence and Mortality Worldwide for 36 Cancers in 185 Countries. CA Cancer J. Clin. 2021, 71, 209–249. [Google Scholar] [CrossRef] [PubMed]
  2. Bray, F.; Ferlay, J.; Soerjomataram, I.; Siegel, R.L.; Torre, L.A.; Jemal, A. Global cancer statistics 2018: GLOBOCAN estimates of incidence and mortality worldwide for 36 cancers in 185 countries. CA Cancer J. Clin. 2018, 68, 394–424. [Google Scholar] [CrossRef] [PubMed] [Green Version]
  3. Hu, J.; Gao, S.; Chen, K.; Feng, J. Pulmonary Minimally Invasive High-Tech Diagnostic Manual Pathologized Hybridization Technique Illustration, 1st ed.; Zhejiang University Press: Hangzhou, China, 2021; pp. 272–278. ISBN 9787308214742. [Google Scholar]
  4. DiMaio, S.P.; Salcudean, S.E. Needle insertion modeling and simulation. IEEE Trans. Robot. Autom. 2003, 19, 864–875. [Google Scholar] [CrossRef] [Green Version]
  5. DiMaio, S.P.; Salcudean, S.E. Needle steering and motion planning in soft tissues. T-BME 2005, 52, 965–974. [Google Scholar] [CrossRef] [PubMed]
  6. Duan, X.; Wen, H.; He, R.; Li, X.; Qiu, J. Research progress and key technology analysis of thoracoabdominal percutaneous puncture robot. Robotics 2021, 43, 567–584. Available online: https://kns.cnki.net/kcms/detail/detail.aspx?FileName=JQRR202105006&DbName=DKFX2021 (accessed on 2 January 2023).
  7. Pinzi, M.; Galvan, S.; Rodriguez y Baena, F. The Adaptive Hermite Fractal Tree (AHFT): A novel surgical 3D path planning approach with curvature and heading constraints. Int. J. Comput. Assist. Radiol. Surg. 2019, 14, 659–670. [Google Scholar] [CrossRef] [PubMed] [Green Version]
  8. Fu, M.; Solovey, K.; Salzman, O.; Alterovitz, R. Resolution-Optimal Motion Planning for Steerable Needles. In Proceedings of the 2022 International Conference on Robotics and Automation (ICRA), Philadelphia, PA, USA, 23–27 May 2022; pp. 9652–9659. [Google Scholar]
  9. Zhang, Y.; Qi, Z.; Zhang, H. An improved RRT* algorithm combining motion constraint and artificial potential field for robot-assisted flexible needle insertion in 3D environment. In Proceedings of the 2021 3rd International Conference on Industrial Artificial Intelligence (IAI), Shenyang, China, 8–11 November 2021; pp. 1–6. [Google Scholar]
  10. Zhang, Y.; Ju, Z.; Zhang, H.; Qi, Z. 3-D Path Planning Using Improved RRT* Algorithm for Robot-Assisted Flexible Needle Insertion in Multilayer Tissues. IEEE Can J. Elect. Com. 2021, 45, 50–62. [Google Scholar] [CrossRef]
  11. LaValle, S.M.; Kuffner, J.J., Jr. Randomized Kinodynamic Planning. Int. J. Robotics Res. 1999, 20, 378–400. [Google Scholar] [CrossRef]
  12. Seiler, K.M.; Singh, S.P.; Sukkarieh, S.; Durrant-Whyte, H. Using Lie group symmetries for fast corrective motion planning. Int. J. Robotics Res. 2010, 13, 151–166. [Google Scholar]
  13. Favaro, A.; Cerri, L.; Galvan, S.; Baena, F.R.Y.; De Momi, E. Automatic Optimized 3D Path Planner for Steerable Catheters with Heuristic Search and Uncertainty Tolerance. In Proceedings of the 2018 IEEE International Conference on Robotics and Automation (ICRA), Brisbane, QLD, Australia, 21–25 May 2018; pp. 9–16. [Google Scholar]
  14. Liu, F.; Garriga-Casanovas, A.; Secoli, R.; y Baena, F.R. Fast and Adaptive Fractal Tree-Based Path Planning for Programmable Bevel Tip Steerable Needles. IEEE Robot. Autom. Lett. 2016, 1, 601–608. [Google Scholar] [CrossRef] [Green Version]
  15. Fu, M.; Salzman, O.; Alterovitz, R. Toward Certifiable Motion Planning for Medical Steerable Needles. arXiv 2021, arXiv:2107.04939. [Google Scholar]
  16. Hoelscher, J.; Fu, M.; Fried, I.; Emerson, M.; Ertop, T.E.; Rox, M.; Alterovitz, R. Backward Planning for a Multi-Stage Steerable Needle Lung Robot. IEEE Robot Autom. Let. 2021, 6, 3987–3994. [Google Scholar] [CrossRef] [PubMed]
  17. Wu, K.; Li, B.; Zhang, Y.; Dai, X. Review of research on path planning and control methods of flexible steerable needle puncture robot. Comput. Assist. Surg. 2022, 27, 91–112. [Google Scholar] [CrossRef] [PubMed]
  18. Abolhassani, N.; Patel, R.; Moallem, M. Patel and Mehrdad Moallem. Needle insertion into soft tissue: A survey. Med. Eng. Phys. 2007, 29, 413–431. [Google Scholar] [CrossRef] [PubMed]
  19. Gao, D.; Lei, Y.; Zheng, H. Needle steering for robot-assisted insertion into soft tissue: A survey. Chin. J. Mech. Eng. 2012, 25, 629–638. [Google Scholar] [CrossRef]
  20. Duindam, V.; Alterovitz, R.; Sastry, S.; Goldberg, K. Screw-based motion planning for bevel-tip flexible needles in 3D environments with obstacles. In Proceedings of the 2008 IEEE International Conference on Robotics and Automation, Pasadena, CA, USA, 19–23 May 2008; pp. 2483–2488. [Google Scholar]
  21. Duindam, V.; Xu, J.; Alterovitz, R.; Sastry, S.; Goldberg, K. Three-dimensional Motion Planning Algorithms for Steerable Needles Using Inverse Kinematics. Int. J. Robotics Res. 2010, 29, 789–800. [Google Scholar] [CrossRef]
  22. Adagolodjo, Y.; Goffin, L.; De Mathelin, M.; Courtecuisse, H. Robotic Insertion of Flexible Needle in Deformable Structures Using Inverse Finite-Element Simulation. IEEE T Robot. 2019, 35, 697–708. [Google Scholar] [CrossRef] [Green Version]
  23. Misra, S.; Reed, K.B.; Schafer, B.W.; Ramesh, K.T.; Okamura, A.M. Mechanics of Flexible Needles Robotically Steered through Soft Tissue. Int. J. Robotics Res. 2010, 29, 1640–1660. [Google Scholar] [CrossRef] [PubMed] [Green Version]
  24. Fan, X.; Yun, J.; Guo, S. Research on Force Analysis and Path Planning of Flexible Needle Puncture Bending Modeling. J. Phys. Conf. Ser. 2021, 1952. [Google Scholar] [CrossRef]
  25. Fu, M.; Kuntz, A.; Webster, R.J.; Alterovitz, R. Safe Motion Planning for Steerable Needles Using Cost Maps Automatically Extracted from Pulmonary Images. In Proceedings of the 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Madrid, Spain, 1–5 October 2018; pp. 4942–4949. [Google Scholar]
  26. Huang, H.; Huang, E.; Li, X.; Li, C.; He, Q.; He, Y. Study on the Direction and Angle of Venous Puncture. 2009. Available online: https://kns.cnki.net/kcms/detail/detail.aspx?FileName=HLXZ200901029&DbName=CJFQ2009 (accessed on 2 January 2023).
Figure 1. General surgical planning based on pulmonary nodules. Techniques such as High-Resolution CT (HRCT), endobronchial ultrasonography (EBUS), and electromagnetic navigation bronchoscope (ENB) are commonly used for lung cancer screening. Transthoracic needle aspiration (TTNA) and bronchial needle aspiration (TBNA) are commonly used for lung cancer treatment; the former is less invasive but requires the needle to be passed through the chest wall from outside the body, which may lead to pneumothorax; the latter is less dangerous but often fails to reach the outer regions of the lung.
Figure 1. General surgical planning based on pulmonary nodules. Techniques such as High-Resolution CT (HRCT), endobronchial ultrasonography (EBUS), and electromagnetic navigation bronchoscope (ENB) are commonly used for lung cancer screening. Transthoracic needle aspiration (TTNA) and bronchial needle aspiration (TBNA) are commonly used for lung cancer treatment; the former is less invasive but requires the needle to be passed through the chest wall from outside the body, which may lead to pneumothorax; the latter is less dangerous but often fails to reach the outer regions of the lung.
Sensors 23 00671 g001
Figure 2. Three key technologies for robot-assisted puncture.
Figure 2. Three key technologies for robot-assisted puncture.
Sensors 23 00671 g002
Figure 3. (Right): Effect of different puncture directions at fixed puncture points (light blue), both reaching the nodes of the lung parenchyma (pink) while avoiding important anatomical structures such as bronchi (yellow) and other tissues (gray). (Top left): Enlarged view of the effect after RCS* planning for different puncture directions. Each trajectory corresponds to the best trajectory for a certain puncture direction, with the red trajectory corresponding to the best direction. (Bottom left): The paths after planning for different puncture directions (black, green, yellow, purple) at the starting point (blue) can all reach the target point (pink) while avoiding obstacles (red), and the path corresponding to the lowest cost is chosen as the best puncture direction.
Figure 3. (Right): Effect of different puncture directions at fixed puncture points (light blue), both reaching the nodes of the lung parenchyma (pink) while avoiding important anatomical structures such as bronchi (yellow) and other tissues (gray). (Top left): Enlarged view of the effect after RCS* planning for different puncture directions. Each trajectory corresponds to the best trajectory for a certain puncture direction, with the red trajectory corresponding to the best direction. (Bottom left): The paths after planning for different puncture directions (black, green, yellow, purple) at the starting point (blue) can all reach the target point (pink) while avoiding obstacles (red), and the path corresponding to the lowest cost is chosen as the best puncture direction.
Sensors 23 00671 g003
Figure 4. The kinematics of a bevel-tip flexible needle.
Figure 4. The kinematics of a bevel-tip flexible needle.
Sensors 23 00671 g004
Figure 5. Feasible angle and effective area for flexible needle puncture. (a) describes the minimum puncture physiological angle α . A denotes the punctured plane, gray represents the tissue, red represents the obstacle and τ is the target tolerance. (b) describes the effective puncture region (green), the yellow region corresponds to the α region in (a), and the point cloud normal vector (red) points from the center of the sphere to the sphere with the opposite puncture direction (blue).
Figure 5. Feasible angle and effective area for flexible needle puncture. (a) describes the minimum puncture physiological angle α . A denotes the punctured plane, gray represents the tissue, red represents the obstacle and τ is the target tolerance. (b) describes the effective puncture region (green), the yellow region corresponds to the α region in (a), and the point cloud normal vector (red) points from the center of the sphere to the sphere with the opposite puncture direction (blue).
Sensors 23 00671 g005
Figure 6. All possible puncture directions are shown in (a). In (b), all valid directions are shown in green, with red in the obstacle environment denoting the direction in which a viable puncture path is present and blue denoting the direction in which a viable puncture path is absent.
Figure 6. All possible puncture directions are shown in (a). In (b), all valid directions are shown in green, with red in the obstacle environment denoting the direction in which a viable puncture path is present and blue denoting the direction in which a viable puncture path is absent.
Sensors 23 00671 g006
Figure 7. Results after RCS* planning, where the starting point (light blue) and all light green represent all valid paths of x g o a l _ 2 (dark green). Purple represents all valid puncture paths of x g o a l _ 1 (pink). Red and dark blue are the best paths.
Figure 7. Results after RCS* planning, where the starting point (light blue) and all light green represent all valid paths of x g o a l _ 2 (dark green). Purple represents all valid puncture paths of x g o a l _ 1 (pink). Red and dark blue are the best paths.
Sensors 23 00671 g007
Figure 8. (ac) represent the directions of the effective paths (blue) and the best puncture directions (red) obtained by running the algorithm with the starting point position p s t a r t and the puncture effective direction (yellow) at the target point x g o a l _ 1 for RCS, RCS* and RRT. Similarly, (df) represent the case when the starting point position is p s t a r t and target point is x g o a l _ 2 .
Figure 8. (ac) represent the directions of the effective paths (blue) and the best puncture directions (red) obtained by running the algorithm with the starting point position p s t a r t and the puncture effective direction (yellow) at the target point x g o a l _ 1 for RCS, RCS* and RRT. Similarly, (df) represent the case when the starting point position is p s t a r t and target point is x g o a l _ 2 .
Sensors 23 00671 g008
Figure 9. Puncture trajectory cost line chart. (a) represents the line graph of three sets of “Cost” in Table 2 and similarly, (b) represents the line chart of “Cost” in Table 3.
Figure 9. Puncture trajectory cost line chart. (a) represents the line graph of three sets of “Cost” in Table 2 and similarly, (b) represents the line chart of “Cost” in Table 3.
Sensors 23 00671 g009
Table 1. Comparison table of characteristics of flexible needle motion planning algorithms.
Table 1. Comparison table of characteristics of flexible needle motion planning algorithms.
CharacteristicAFTAHFTRRTRRT*RCSRCS*
Completeness
Probabilistic completeness
Optimality
Asymptotic optimality
Optimal resolution
In the column of application, “✓” means yes, “✕” means no.
Table 2. Costs of planning results for different puncture directions at starting point position p s t a r t and target point x g o a l _ 1 .
Table 2. Costs of planning results for different puncture directions at starting point position p s t a r t and target point x g o a l _ 1 .
CSRCS*RRT
Direction ( q start x , q start y , q start z ) CostDirection ( q start x , q start y , q start z ) CostDirection ( q start x , q start y , q start z ) Cost
10.9914650.001096−0.13036964.61930.9914650.001096−0.13036963.11180.9914650.001096−0.13036964.2937
20.957829−0.256209−0.13007662.90140.957829−0.256209−0.13007661.38530.957829−0.256209−0.13007663.3354
30.9656960.001197−0.25967362.56390.9656960.001197−0.25967360.61940.9656960.001197−0.25967362.5386
40.837163−0.482563−0.25747065.02250.933537−0.249225−0.25767360.02650.933537−0.249225−0.25767361.1850
50.933537−0.249225−0.25767361.12410.9244660.001275−0.38126360.17700.9244660.001275−0.38126361.4550
60.9244660.001275−0.38126361.19490.892368−0.238261−0.38328959.87600.892368−0.238261−0.38328961.0429
70.892368−0.238261−0.38328961.05480.8658510.001334−0.50029960.61040.8658510.001334−0.50029962.0652
80.8658510.001334−0.50029962.41230.836002−0.223848−0.50099260.21920.7928780.001369−0.60937964.4184
90.836002−0.223848−0.50099261.50180.7928780.001369−0.60937963.04870.766228−0.205047−0.60897463.6609
100.7928780.001369−0.60937964.53350.766228−0.205047−0.60897462.3829
110.766228−0.205047−0.60897462.3829
Table 3. Costs of planning results for different puncture directions at starting point position p s t a r t and target point x g o a l _ 2 .
Table 3. Costs of planning results for different puncture directions at starting point position p s t a r t and target point x g o a l _ 2 .
RCSRCS*RRT
Direction ( q start x , q start y , q start z ) CostDirection ( q start x , q start y , q start z ) CostDirection ( q start x , q start y , q start z ) Cost
10.9999990.000978−0.00097880.76440.9999990.000978−0.00097879.32780.9999990.000978−0.00097880.3665
20.9914650.001096−0.13036974.98350.9914650.001096−0.13036973.41510.9914650.001096−0.13036974.8899
30.9578290.256209−0.13007680.46730.957829−0.256209−0.13007674.44010.9578290.256209−0.13007680.4152
40.957829−0.256209−0.13007676.55720.9656960.001197−0.25967371.80500.957829−0.256209−0.13007675.7056
50.9656960.001197−0.25967373.00240.837163−0.482563−0.25747081.93600.9656960.001197−0.25967373.2365
60.9335370.249225−0.25767377.14770.933537−0.249225−0.25767372.33980.9335370.249225−0.25767376.1870
70.837163−0.482563−0.25747081.89520.9244660.001275−0.38126371.58480.933537−0.249225−0.25767374.3561
80.933537−0.249225−0.25767374.68540.892368−0.238261−0.38328971.91680.9244660.001275−0.38126372.7260
90.9244660.001275−0.38126372.75100.8658510.001334−0.50029971.80180.8923680.238261−0.38328974.9402
100.8923680.238261−0.38328975.48710.836002−0.223848−0.50099272.37050.892368−0.238261−0.38328973.0592
110.892368−0.238261−0.38328972.94160.7928780.001369−0.60937973.38590.8658510.001334−0.50029973.1431
120.8658510.001334−0.50029973.13580.766228−0.205047−0.60897474.52850.8360020.223848−0.50099275.9681
130.8360020.223848−0.50099276.6867 0.836002−0.223848−0.50099273.9458
140.836002−0.223848−0.50099273.6244 0.7928780.001369−0.60937975.3445
150.7928780.001369−0.60937974.9628 0.7662280.205047−0.60897478.4385
160.7662280.205047−0.60897478.7849 0.766228−0.205047−0.60897475.6471
170.766228−0.205047−0.60897475.8855
Table 4. Cost statistics for puncture trajectories.
Table 4. Cost statistics for puncture trajectories.
Table 2-Cost Table 3-Cost
RCSRCS*RRT RCSRCS*RRT
Mean62.7956061.1457062.66610 76.1037074.0710075.52310
Before Lowest438.4809365.1960373.8506 692.2541524.8486607.8828
Disclaimer/Publisher’s Note: The statements, opinions and data contained in all publications are solely those of the individual author(s) and contributor(s) and not of MDPI and/or the editor(s). MDPI and/or the editor(s) disclaim responsibility for any injury to people or property resulting from any ideas, methods, instructions or products referred to in the content.

Share and Cite

MDPI and ACS Style

Feng, S.; Wang, S.; Jiang, W.; Gao, X. Planning of Medical Flexible Needle Motion in Effective Area of Clinical Puncture. Sensors 2023, 23, 671. https://doi.org/10.3390/s23020671

AMA Style

Feng S, Wang S, Jiang W, Gao X. Planning of Medical Flexible Needle Motion in Effective Area of Clinical Puncture. Sensors. 2023; 23(2):671. https://doi.org/10.3390/s23020671

Chicago/Turabian Style

Feng, Shuai, Shigang Wang, Wanxiong Jiang, and Xueshan Gao. 2023. "Planning of Medical Flexible Needle Motion in Effective Area of Clinical Puncture" Sensors 23, no. 2: 671. https://doi.org/10.3390/s23020671

APA Style

Feng, S., Wang, S., Jiang, W., & Gao, X. (2023). Planning of Medical Flexible Needle Motion in Effective Area of Clinical Puncture. Sensors, 23(2), 671. https://doi.org/10.3390/s23020671

Note that from the first issue of 2016, this journal uses article numbers instead of page numbers. See further details here.

Article Metrics

Back to TopTop