https://5dok.org/document/zpn6lppr-pose-estimation-sensor-fusion-inertial-sonar-satellite-signals.html