In order to effectively improve the accuracy and efficiency of unstructured environment navigation and trajectory calibration, a multi data fusion based unstructured environment navigation and trajectory calibration method was studied. Described the basic principles of the Strapdown Inertial Navigation System and Doppler Log. After introducing DVL velocity information and relative position information of underwater robots into SINS, the Kalman filter fusion algorithm was used to obtain the system's state equation and measurement equation. The navigation parameter error and device error parameters of the system were selected as the state variables. The difference between SINS output speed and DVL measurement speed, as well as the difference between SINS output position and relative position, are used as the speed and position measurements of the measurement system. Error estimation is obtained through indirect filtering, and the accuracy of navigation and positioning is improved through output correction. The experimental results show that the proposed method has a good calibration effect and can effectively improve the accuracy and efficiency of trajectory calibration in unstructured environments.
Read full abstract