Patent ID: 9726499
Date: 2017-08-08
CPC Classifications: G01C,G01S

Claim:
1. A method of determining at least one radius of protection associated with a respective navigation parameter of a hybrid inertial navigation system for a vehicle using Kalman filtering, comprising: receiving at a filter input of a Kalman filter, a safe position measurement and an inertial measurement from the hybrid inertial navigation system comprising a triaxial accelerometer measurement and a triaxial rate gyro measurement; producing an inertial platform from the inertial measurements to obtain at least one navigation parameter from a set of parameters comprising position, speed, attitude and altitude of the vehicle from the hybrid inertial navigation system; performing Kalman filtering including updating of a state vector including an estimate of the errors of the navigation parameter or parameters and a covariance matrix associated with states of the state vector, propagation of the state vector, hybridizing the inertial navigation data with the safe position measurement received by means of the following iterative substeps: performing an update of the state vector based on an observation of the difference between the inertial measurement and the safe position measurement, wherein a safe position bias state is introduced into the state vector of the Kalman filter, representing an uncertainty associated with the input measured safe position measurement; decorrelating the safe position bias state of all of the other states of the state vector by means of the following substeps: rendering the safe position bias state independent of the other states during two successive propagations by increasing a model noise associated with the safe position bias state; cancelling the correlations present in the covariance matrix of the Kalman filter of the safe position bias state with all the other states; and reinitializing a diagonal element of the covariance matrix associated with the safe position bias state with the input safe position measurement uncertainty; propagating the state vector until the diagonal element of the covariance matrix associated with the position error state estimated by the Kalman filter is equal to the covariance associated with the safe position bias state; computing the safe navigation parameter or parameters of the vehicle by adding to the inertial navigation parameters from the inertial platform the estimated navigation errors contained in the state vector of the Kalman filter; and computing the radius or radii of protection associated with respective safe navigation parameter or parameters for the vehicle using the covariance matrix of the Kalman filter to thereby provide the vehicle operator with safe navigation parameters.