A method of wind field estimation and trajectory correction online in DR/GPS/RP integrated navigation of UAV

To deal with wind field disturbance in DR/GPS/RP integrated navigation of UAV, a method of wind field estimation and trajectory correction online based on the relation of position vector is presented. In addition, in order to obtain more accurate wind field information, a method about estimating the calculation step considering Shannon sampling theory is introduced. The results of simulation and experiments show that the method above can accurately estimate the wind field and thus restrain the divergence of DR and improve the accuracy of integrated navigation and the ability of anti-disturbance.