Multiple Threats Sense and Avoid Algorithm for Static and Dynamic Obstacles

Abstract

This paper presents a new computationally efficient S&A algorithm for implementation in real-time applications for UAV. Based on a simplified optimisation approach, the proposed algorithm aims to provide a reliable resolution manoeuvre (horizontal and vertical) for multiple threat scenarios which include both air and ground threats/obstacles. In presence of a conflict risk, the avoidance manoeuvre is defined as step variation in the heading angle or altitude variation of the autopilots command. This step command is optimised in order to keep a minimum distance of separation between the ownship and all threats during the overall manoeuvre. The algorithm computes the separation distance between the UAV and the threats by calculating the future trajectories at each time step of both the ownship and the threat, while always taking into account the ownship performance envelope constraints. The algorithms were validated in simulation, where the ground threats were derived from the ground elevation maps, while for the aerial threats the aircraft communicate their flight data through an ADS-B mode S transponder. The resolution manoeuvre optimisation technique takes about 0.1 second to compute. Hence enabling the algorithm to cope with any rapid changes in the aerial threat trajectory.