https://5dok.org/document/7qv76p0q-enhancement-positioning-attitude-estimation-using-extended-kalman-filter.html