Flexible needle has been widely used in the therapy delivery because it can advance along the curved lines to avoid the obstacles like important organs and bones. However, most control algorithms for the flexible needle are still limited to address its motion along a set of arcs in the two-dimensional (2D) plane. To resolve this problem, this paper has proposed an improved duty-cycled spinning based three-dimensional (3D) motion control approach to ensure that the beveled-tip flexible needle can track a desired trajectory to reach the target within the tissue. Compared with the existing open-loop duty-cycled spinning method which is limited to tracking 2D trajectory comprised of few arcs, the proposed closed-loop control method can be used for tracking any 3D trajectory comprised of numerous arcs. Distinctively, the proposed method is independent of the tissue parameters and robust to such disturbances as tissue deformation. In the trajectory tracking simulation, the designed controller is tested on the helical trajectory, the trajectory generated by rapidly-exploring random tree (RRT) algorithm and the helical trajectory. The simulation results show that the mean tracking error and the target error are less than 0.02[Formula: see text]mm for the former two kinds of trajectories. In the case of tracking the helical trajectory, the mean tracking error target error is less than 0.5[Formula: see text]mm and 1.5[Formula: see text]mm, respectively. The simulation results prove the effectiveness of the proposed method.
A force/motion control approach based on trajectory planning for industrial robots with closed control architecture
