Kalman filter design for integration of Phase III GPS with an Inertial Navigation System