The algorithm of INS positioning and using kalman filter to correct the bias - View it on GitHub