A method for planning an autonomous landing safe trajectory suitable for UAV inspection is proposed. After the UAV takes off, it acquires the current
pose of the UAV, the
point cloud map information of the surrounding environment, and the spatial orientation of the target point. By establishing the
spatial transformation relationship between the camera coordinate
system and the body coordinate
system, the orientation vector relative to the ground target is calculated, and the target point is generated within the
radar-sensible area. Based on the generated target point, an optimization function that minimizes the fourth derivative is constructed based on multiple high-order polynomials to generate a smooth trajectory with continuous position, velocity, and acceleration. The initial trajectory is transformed into a B-spline curve, and local trajectory segments with
collision risk are optimized. A segmented penalty mechanism is designed based on the boundary threshold to guide the trajectory away from the boundary area. The time span is adjusted by calculating the trajectory derivative over-limit ratio, and a trajectory similarity cost function is introduced to ensure that the final optimized trajectory maintains the original geometric structure, thereby achieving
trajectory control optimization and safe landing of the UAV.