摘要 |
The terrain referenced navigation system uses data from a global positioning system (GPS) to determine a vehicles position, velocity and height above ground. The system uses input data from an altimeter device, a digital terrain elevation data, and a GPS position, velocity and time data. The system applies a GPS error process model in addition to a TRN measurement model, to obtain a state vector which includes estimates of current errors in the GPS data. The PVT data input from a GPS receiver is used to determine a current vehicle position and height in geographic axis. Using specifically constructed Kalman filter states, a geographical position and height of the vehicle is reference to the digital terrain elevation data, and an estimated ground clearance at the vehicle position is determined. The ground clearance is differenced with a radar altimeter output, and the residual is processed by Kalman filter to determine a new state vector, including estimates of current errors in the GPS data. The output can be configured to be either referenced to navigation axis, or to the digital terrain database for use by other digital terrain system functions. |