Augmented Radar Odometry by Nested Optimal Filter Aided Navigation for UAVS in GNSS Denied Environment

Abstract

Now a days, Unmanned Aerial Vehicles (UAVs) have been exploited in numerous civil and military aspects such as disaster management and border monitoring. Although most of these UAVs are equipped with Global Navigation Satellite System (GNSS) / Inertial Navigation System (INS) reliable integrated system for localization proposes, they are susceptible to lose their GNSS signals under some environmental and artificial challenging circumstances such as, flying in urban areas, jamming, and spoofing. In such complicated scenarios, the navigation solution will degrade rapidly due to the accumulated INS drift errors. Although various aiding sensors such as cameras, and radar are employed to mitigate the INS drift errors, their estimated positioning accuracy is still affected by some factors. This paper presents a nested optimal filter approach (G-H filter, Extended Kalman Filter (EKF)) for UAVs in GNSS denied environment, to enhance the estimated positioning accuracy by integrating the Radar Odometry (RO)/INS/MAG to sustain a reliable navigation solution during GNSS outage. First, the UAV relative velocity is calculated based on image processing approach from the radar range doppler map, then the G-H filter is deployed to improve the accuracy of the vehicle estimated forward velocities based on the vehicle dynamic characteristics to reduce the effect of unrealistic velocity estimate from the radar. These improved velocities are then fused with the Inertial Measurement Unit (IMU), magnetometer, and barometer via EKF to mitigate the positioning RMS errors during the GNSS signals outages. The experimental results demonstrate the proposed system's ability to notably enhance the 3D positioning accuracy during the GNSS signal outage by more than 99% when compared to a stand-alone IMU dead reckoning solution.