
This project designs a full-stack system architecture encompassing mapping and localization, path planning, and control modules. Built on Ubuntu 22.04 and the ROS2 Humble environment, it utilizes MAVROS to establish an efficient communication link between the upper-level planning algorithms and the lower-level APM flight controller. This achieves low-latency transmission of command instructions and state feedback, ensuring decoupling and collaborative operation between functional modules. For mapping and localization, current mainstream SLAM algorithms are deployed, with a focus on LiDAR-inertial odometry (such as the FAST-LIO series), visual-inertial odometry (such as the VINS-Fusion series), and feature-point-based visual SLAM (such as the ORB-SLAM3 series). The front-end implements search-based A* and JPS algorithms, as well as the sampling-based RRT* algorithm. The back-end uses B-spline interpolation and minimum control effort (Minimum Snap) numerical optimization methods to generate smooth, flyable trajectories that satisfy the drone's dynamic constraints. Control is achieved using methods such as PID, LQR, and MPC.
Scientific-grade UAV path planning and multi-objective optim...