Motion-Planning Algorithm for a Hyper-Redundant Manipulator in Narrow Spaces

Abstract

In this study, a hyper-redundant manipulator was designed for detection and searching in narrow spaces for aerospace and earthquake rescue applications. A forward kinematics equation for the hyper-redundant manipulator was derived using the homogeneous coordinate transformation method. Based on the modal function backbone curve method and the known path, an improved modal method for the backbone curves was proposed. First, the configuration of the backbone curve for the hyper-redundant manipulator was divided into two parts: a mode function curve segment of the mode function and a known path segment. By changing the discrete points along the known path, the backbone curve for the manipulator when it reached a specified path point was dynamically obtained, and then the joint positions of the manipulator were fitted to the main curve by dichotomy. Combined with engineering examples, simulation experiments were performed using the new algorithm to extract mathematical models for external narrow space environments. The experimental results showed that when using the new algorithm, the hyper-redundant manipulator could complete the tasks of passing through curved pipes and moving into narrow workspaces. The effectiveness of the algorithm was also proven by these experiments.