Smooth joint motion planning for redundant fiber placement manipulator based on improved RRT*

Abstract

In automated fiber placement (AFP), addressing the continuous motion planning challenge of redundant layup manipulators in complex environments, this paper proposes an offline redundancy optimization algorithm based on improved RRT* (Rapidly-exploring Random Trees). This algorithm maximizes the utilization of kinematic redundancy to derive smooth joint trajectories devoid of collisions and singularities. Firstly, the algorithm entails constructing a search map by eliminating joint configurations that violate constraints, and subsequently planning and optimizing the joint path by minimizing a multi-objective cost under the map constraint. Furthermore, several strategies are introduced to enhance RRT* for redundancy optimization. These strategies include a piecewise Gaussian sampling strategy (PGSS) to guide efficient tree growth within complex channels and enable joint sampling constrained by task coordinates. Additionally, the improved Steering and Local Optimization method are proposed to plan joint motion while considering intermediate task sequences. The effectiveness of the proposed algorithm is demonstrated in handling complex motion planning scenarios, such as layup involving complex path curves or dense obstacles. Experimental results validate the algorithm's capability to find feasible collision-free and singularity-free paths in relevant scenarios, provided such paths exist. Moreover, trajectory smoothness is optimized with increasing iterations.