LAUSR

This article presents a geometric approach for path planning of serpentine manipulator for real-time control in confined spaces. Firstly, the mechanical design of a serpentine manipulator is introduced, and its kinematics is analyzed. As the serpentine manipulator usually has more than 10 degrees of freedom, the motion control and obstacle avoidance are difficult considering its inverse kinematics. Follow-the-leader is an ideal path planning method for serpentine manipulator, as the manipulator moves forward, all the sections follow the path that the tip of manipulator has passed, which simplifies the obstacle avoidance. The realization of follow-the-leader method is to find the new configurations of the manipulator that can fit the ideal path with small errors. In this article, a novel geometric approach for follow-the-leader motion is proposed to solve new configurations with high precision of location and less computation time. The method is validated through simulation and the deviation from the ideal path is analyzed, simulation results show that calculation time for per step is less than 0.5 ms for a serpentine manipulator with 10 sections. To verify the follow-the-leader method, a 13-degree-of-freedom serpentine manipulator system with 6 sections was built, and 12 magnetic rotary encoders were embedded into the universal joints to collect data of rotation angles of each section. Experimental results show that the manipulator can carry out follow-the-leader motion as expected in real time.