Motion planning for autonomous vehicles relies heavily on perception and prediction results to find a safe, collision-free local trajectory that adheres to traffic rules. However, vehicle perception is frequently limited by occlusion, and the generation of safe local trajectories with restricted perception poses a significant challenge in the field of motion planning. This paper introduces a collision avoidance trajectory planning algorithm that considers potential collision risks, within a hierarchical framework of sampling and optimization. The primary objective of this work is to generate trajectories that are safer and align better with human driver behavior while considering potential collision risks in occluded regions. Specifically, in occlusion scenarios, the state space is discretized, and a dynamic programming algorithm is used for a sampling-based search to obtain initial trajectories. Additionally, the concept of a driving risk field is introduced to describe potential collision risk elements within the human-vehicle-road environment. By drawing inspiration from graph search algorithms, potential collision risk areas are accurately described, and a cost function is proposed for evaluating potential risks in occluded regions. Drivers typically exhibit conservative and cautious driving behavior when navigating through occluded regions. The proposed algorithm not only prioritizes driving safety but also considers driving efficiency, thereby reducing the vehicle’s conservativeness when passing through occlusions. The research results demonstrate that the ego vehicle can actively avoid blind spots and tends to move away from occluded regions, aligning more closely with human driver behavior.
To enhance the safety and stability of lane change maneuvers for autonomous vehicles in adverse weather conditions, this paper proposes a quadratic programming−based trajectory planning algorithm for lane changing in rainy weather. Initially, in order to mitigate the risk of potential collisions on wet and slippery road surfaces, we incorporate the concept of road adhesion coefficients and delayed reaction time to refine the establishment of the minimum safety distance. This augmentation establishes constraints on lane change safety distances and delineates the boundaries of viable lane change domains within inclement weather contexts. Subsequently, adopting a hierarchical trajectory planning framework, we incorporate visibility cost functions and safety distance constraints during dynamic programming sampling to ensure the safety of vehicle operation. Furthermore, the vehicle lane change sideslip phenomenon is considered, and the optimal lane change trajectory is obtained based on the quadratic programming algorithm by introducing the maneuverability objective function. In conclusion, to verify the effectiveness of the algorithm, lateral linear quadratic regulator (LQR) and longitudinal double proportional−integral−derivative (DPID) controllers are designed for trajectory tracking. The results demonstrate the algorithm’s capability to produce continuous, stable, and collision−free trajectories. Moreover, the lateral acceleration varies within the range of ±1.5 m/s2, the center of mass lateral deflection angle varies within the range of ±0.15°, and the yaw rate remains within the ±0.1°/s range.