Development of a Multi-sensor Navigation Filter for High Accuracy Positioning in all Environments

The aim of the SPACE project is to develop a mobile test bed that can position to within centimetres in all conditions and environments. To achieve this goal, a number of different positioning technologies have to be integrated together including GNSS, INS, pseudolites and other technologies such as Ultra Wideband and Bluetooth ranging. The integration of these sensors is achieved by the development a 'plug and play' filter that will optimally combine measurements from each sensor to form an accurate position solution. The filter has been designed so that the sensors are integrated at the measurement level wherever possible, so partial measurements from different systems can be used together. This paper describes the development of the plug and play filter, focussing in particular on how the states are defined, how the measurements are used, and how a generic filter can be developed that can integrate all types of positioning sensor. Some early results from the filter are shown integrating GPS, INS and simulated measurements from an Ultra Wideband system. A prototype version of the mobile test bed is also described.