| 摘要 |
A device to aid navigation comprises: at least one inertial navigation unit; an integration module estimating the position, speed and orientation of the carrier on the basis of the data supplied by the inertial navigation unit; a digitized map of the locations in which the carrier moves, said map storing a navigable network along which the carrier may move; a module for generating position pseudo-measurements on the basis of the position estimated by the integration module and cartographic data supplied by the digitized map, a position pseudo-measurement indicating the position which should be estimated by the integration module in the presence of movement constraints imposed by the digitized map of the locations; an indirect extended Kalman filter connected to the module for generating position pseudo-measurements by a switch, said filter estimating the errors relating to the position, speed and orientation, and also any other variable associated with the inertial navigation unit, estimated by the integration model on the basis of the position pseudo-measurements produced by the module; a module indicating the availability of a pseudo-measurement of the module controlling the closing of the switch when a pseudo-measurement is available and opening it in the opposite case; the output of the integration module, indicating the position, speed and orientation estimation, being connected to the module for generating position pseudo-measurements, to the Kalman filter and to the positive input of a filter of a subtractor. |
