Fast Path Planning for Kinematic Smoothing of Robotic Manipulator Motion

The Rapidly-exploring Random Tree Star (RRT*) algorithm is widely applied in robotic manipulator path planning, yet it does not directly consider motion control, where abrupt changes may cause shocks and vibrations, reducing accuracy and stability. To overcome this limitation, this paper proposes the Kinematically Smoothed, dynamically Biased Bidirectional Potential-guided RRT* (KSBB-P-RRT*) algorithm, which unifies path planning and motion control and introduces three main innovations. First, a fast path search strategy on the basis of Bi-RRT* integrates adaptive sampling and steering to accelerate exploration and improve efficiency. Second, a triangle-inequality-based optimization reduces redundant waypoints and lowers path cost. Third, a kinematically constrained smoothing strategy adapts a Jerk-Continuous S-Curve scheme to generate smooth and executable trajectories, thereby integrating path planning with motion control. Simulations in four environments show that KSBB-P-RRT* achieves at least 30% reduction in planning time and at least 3% reduction in path cost, while also requiring fewer iterations compared with Bi-RRT*, confirming its effectiveness and suitability for complex and precision-demanding applications such as agricultural robotics.