https://5dok.org/document/zwvrd3jl-eliminating-the-latency-using-different-kalman-filters.html