https://123dok.net/document/4yror58y-coupled-methods-nonlinear-estimation-control-applicable-terrain-navigation.html