ABSTRACT

Owing to the precision faults of underwater robot navigation and position which is caused by prior statistical characteristics and actual inconsistently, extended Kalman Particle Filter (EPF) federated filtering algorithm is put forward. Federated filter is established for SINS/DVL/DR integrated navigation system. Use EPF localized filtering. SINS/DVL/DR simulation experiments show that this algorithm confirms higher filtering precision and robustness.