Trajectory Planning for Multiple UAVs and Hierarchical Collision Avoidance Based on Nonlinear Kalman Filters

Fully autonomous trajectory planning for multiple unmanned aerial vehicles (UAVs) is significant for building the next generation of the logistics industry without human control. This paper presents a method to enable multiple UAVs to fly in the same trajectory without collision. It benefits several applications, such as smart cities and transfer goods, during the COVID-19 pandemic. Different types of nonlinear state estimation are deployed to test the position estimation of drones by treating the information from AirSim as offline dynamic data. The obtained global positioning system sensor data and magnetometer sensor data are determined as the measurement model. The experiment in the simulation is separated into (1) the localization state, (2) the rendezvous state, in which the proposed rendezvous strategy is presented by using the relation between velocity and displacement through the setting area, and (3) the full mission state, which combines both the localization and rendezvous states. The localization state results show the best RMSE in the case of full GPS available at 0.21477 m and 0.25842 m in the case of a GPS outage during a period of time by implementing the ensemble Kalman filter. Similarly, the ensemble Kalman filter performs well with an RMSE of 0.5112414 m in the rendezvous state and demonstrates exceptional performance in the full mission state. Moreover, the experiment is implemented in a real-world situation with some basic drone kits as proof that the proposed rendezvous strategy can truly operate.