The present invention provides an intersection condition-orientated unmanned vehicle
trajectory planning method based on the Bezier curve and the VFH
algorithm. The method includes the following steps that: 1) the starting point
pose P0 (x0,y0,theta0) and destination point
pose P3 (x3,y3,theta3) of current
trajectory planning are acquired; 2) a trajectory cluster A1 from the starting point
pose P0 (x0,y0,theta0) to the destination point pose P3 (x3,y3,theta3) is generated through adopting a three-order Bezier curve model; 3) the trajectory cluster A1 is screened according to a maximum curvature constraint, so that a trajectory cluster A2 is obtained,
collision detection is performed on A2, so that a collision-free trajectory cluster A3 is obtained; 4) if A3 is not empty, an
optimal trajectory is selected from A3 according to a trajectory smoothest principle and is outputted to a
control layer, and the method is terminated, otherwise, the method shifts to step 5; 5) a movement region in the original VFH
algorithm is improved, so that a fan-shaped movement region is built; 6) obstacle information is utilized to establish a grid map; 7) the fan-shaped movement region is divided into a plurality of fan-shaped regions, and whether an obstacle exists is judged; 8) the Bezier curve is used in combination, and
optimal trajectory points are selected; and 9) with a discrete
point set generated in the step 8 adopted as control points, a B-spline curve is generated, and the B-spline curve is adopted as the final trajectory of an unmanned vehicle.