This project is aimed to allow for misalignment-tolerant AUV navigation based on an UKF framework. A Nonlinear Least Squares (NLS)-based technique is employed to find an initial solution for beacon localization and sensor alignment.
The associated paper has been submitted to RAL.