Haversine Formula https://stackoverflow.com/questions/57104706/how-to-figure-out-kalman-filter-rotation-flip-problem
Notes