This paper presents a sensor fusion algorithm based on a Kalman Filter to estimate geodetic coordinates and reconstruct a car test trajectory in environments where there is no GPS signal. The sensor fusion algorithm is based on low-grade strapdown inertial sensors (i.e. accelerometers and gyroscopes) and an incremental odometer, from which, velocity measurements is obtained. Since the dynamic system is non linear, an Extended Kalman Filter (EKF) is used to estimate the states (i.e. latitude, longitude and altitude) and reconstruct the test trajectory. The relevance of this work is given by the fact that, in the current literature, much has been published about the merger Inertial Sensors and GPS, however, currently no literature that addresses the form of sensor fusion proposed here is available. Another aspect that could be emphasized is that the proposed algorithm has potential to be applied in environments where GPS signals are not available, such as Pipeline Inspection Gauge (PIG) as depicted below in figure 2. The inertial navigation system developed and tested, shows that only with inertial sensors measurements, a closed tested trajectory can not be reconstructed satisfactorily, however when it uses the sensor fusion, the trajectory can be reconstructed with relative success. On preliminary experiments, it was possible reconstruct a closed trajectory of approximately 2800m, attaining a final error of 13m.
[1]
John Weston,et al.
Strapdown Inertial Navigation Technology
,
1997
.
[2]
A. B. Chatfield.
Fundamentals of high accuracy inertial navigation
,
1997
.
[3]
P. Savage.
Strapdown Inertial Navigation Integration Algorithm Design Part 1: Attitude Algorithms
,
1998
.
[4]
Kenneth R Britting,et al.
Inertial navigation systems analysis
,
1971
.
[5]
Dan Simon,et al.
Optimal State Estimation: Kalman, H∞, and Nonlinear Approaches
,
2006
.
[6]
Robert M. Rogers,et al.
Applied Mathematics in Integrated Navigation Systems
,
2000
.
[7]
Eun-Hwan Shin,et al.
Navigation kalman filter design for pipeline pigging
,
2005
.
[8]
Richard A. Brown,et al.
Introduction to random signals and applied kalman filtering (3rd ed
,
2012
.
[9]
Douglas Daniel Sampaio Santana.
NAVEGAÇÃO TERRESTRE USANDO UNIDADE DE MEDIÇÃO INERCIAL DE BAIXO DESEMPENHO E FUSÃO SENSORIAL COM FILTRO DE KALMAN ADAPTATIVO SUAVIZADO
,
2011
.
[10]
Fredrik Gustafsson,et al.
Particle filters for positioning, navigation, and tracking
,
2002,
IEEE Trans. Signal Process..