Adaptive UAV Navigation Method Based on AHRS

To address the inaccuracy of the Constant Acceleration/Constant Velocity (CA/CV) model as the state equation in describing the relative motion state in UAV relative navigation, an adaptive UAV relative navigation method is proposed, which is based on the UAV attitude information provided by Attitude and Heading Reference System (AHRS). The proposed method utilizes the AHRS output attitude parameters as the benchmark for dead reckoning and derives a relative navigation state equation with attitude error as process noise. By integrating the extended Kalman filter output for relative state estimation and employing an adaptive decision rule designed using the innovation of the filter update phase, the proposed method recalculates motion states deviating from the actual motion using the Tasmanian Devil Optimization (TDO) algorithm. The simulation results show that, compared with the CA/CV model, the proposed method reduces the relative position errors by 12%, 23%, and 32% in the X, Y, and Z directions, respectively, and that it reduces the relative velocity errors by 350%, 330%, and 300%, respectively. There is a significant improvement in the relative navigation accuracy.