Patent ID: 7181323

Claim:
A computerized method for generating nominally unbiased estimates of at least one of position, velocity, acceleration, and specific mass flow rate of a vehicle, said computerized method comprising the steps of: setting parameters of the states of said vehicle based on previously determined information relating to a vehicle model; acquiring from at least one sensor a stream of time-tagged input information relating to the current state of said vehicle, said stream of information also being source identified if produced by plural sensors; propagating a previous state of said vehicle to the time of the current time tag of said information to produce a current state estimate; propagating a covariance of the vehicle state estimate to the time of the current time tag of said information to produce a current covariance estimate; determining if a staging event has occurred using parameter reference sets, and if a staging event has occurred, adopting a new vehicle model; estimating sensor registration bias states for each of the reporting sensors to generate sensor bias state information; correcting sensor information for each of the reporting sensors in response to said sensor bias state information, to thereby generate corrected sensor measurement information; generating a sensor-dependent measurement matrix which relates the time-tagged input information or measurements to a state error; determining the “measurement” residual which relates the current state estimate to the error in the current state estimate; determining the extended Kalman gain matrix, which is dependent upon the current vehicle model and the noise covariance of the time-tagged input information; determining the state update based upon the Kalman matrix and the “measurement” residual, and generating a new current state by applying the state update; determining the state covariance update based upon the Kalman matrix and the “measurement” residual, and generating a new current state covariance by applying the state covariance update; repeating said steps of acquiring measurements or data from at least one sensor, propagating a previous state of said vehicle, propagating a covariance of the vehicle state estimate, determining if a staging event has occurred, estimating sensor registration bias states, correcting sensor information for each of the reporting sensors, generating a sensor-dependent measurement matrix, determining the “measurement” residual, determining the extended Kalman gain matrix, determining the state update based upon the Kalman matrix, and determining the state covariance update, thereby producing said at least one of nominally unbiased vehicle position, velocity, acceleration, and specific mass flow rate for use in conjunction with said vehicle model to estimate parameters of said vehicle.