This is a algorithm about SINS/GPS EKF Integrated navigation to 16 states - View it on GitHub