Path planning for flexible needle based on both insertion mechanism kinematics and needle bending model

Abstract

Objective. Due to the limited operating space in the magnetic resonance (MR) environment, there is coupled motion in the insertion mechanism, which not only reduces the flexibility of the robot but also challenges the insertion path planning. Meanwhile, the path planning is also restricted by the bending rule of the flexible needle, thus the bending model of the needle is also essentially built. Approach. This paper proposes a path planner for the flexible needle based on both the coupled motion kinematics of the insertion robot and the bending model of the flexible needle. A kinematic analysis for the coupled motion of insertion robot is performed. And the bending model of flexible needle is established based on the needle-tissue interactions. The position and posture of the needle insertion at the entry point are obtained by the calculation of the target position and the analysis of the bending model. And the rotation or translation coordinates of each robot joint are calculated by the inverse kinematics of the insertion robot. Then the path planning based on the coupled kinematics and the bending model is realized. Main results. The insertion experiments were performed for each target of G1 and G2. The root mean square errors were 0.83 mm and 0.74 mm, and the maximum errors were 1.1 mm and 0.9 mm for G1 and G2, respectively. The experimental results show that the effectiveness and accuracy of the path planning can meet the requirements for a general minimally invasive surgery, so the proposed path planning algorithm is feasible. Significance. This study provides a new solution for the path planning of insertion robots for the minimally invasive surgery. This method can meet the insertion mechanism working within the limited operating space in the MR environment and has a high application value in future clinical medicine.