https://xia0sha.blogspot.com/2024/02/strapdown-inertial-navigation.html