https://123dok.net/document/4zp0gk7q-non-linear-filtering-approaches-for-ins-gps-integration.html