GPS-INS state estimation for multi-robot systems with computational resource constraints
Abstract
A decoupled Kalman Filter for GPS-INS sensor fusion is developed for a high-speed multi-robot system with computational resource constraints. An eighth-order filter describing system and bias dynamics is decoupled into four second-order filters. Process and measurement noise statistics and first-order bias dynamics are derived from experimental data. The decoupled filter reduces computation time by a factor of seven over the coupled filter, enabling real-time implementation on an inexpensive processor at the required control update rate of 20 Hz. The decoupled filter is evaluated through simulation and experiments and provides sub-meter position error for over a minute, an order of magnitude improvement over GPS alone.
References
[1]
J.L. Baxter, E.K. Burke, J.M. Garibaldi, and M. Normal. Multi-Robot Search and Rescue: A Potential Field Approach. Autonomous Robots and Agents, vol. 76. Springer, Berlin, 2007.
[2]
B.S. Pimental and M. F. M. Campos. Cooperative Communication in ad hoc networked mobile robots. IEEE Int. Conf. on Intelligent Robots and Systems, 2876-2881, 2003.
[3]
J. Fink, N. Michael, V. Kumar. Composition of vector fields for multi-robot manipulation via caging. Proc. of Robotics: Science and Systems, Atlanta GA, June 2007.
[4]
L. Ray, D. Brande, J. Murphy, J. Joslin Cooperative Control of Autonomous mobile Robots in Unknown Terrain, ASME Int. Mech. Eng. Conf. and Exhibition, Chicago IL, Nov. 2006.
[5]
James Rankin. GPS and differential GPS: An error model for sensor simulation. IEEE Position Location and Nav. Symp., 260-266, 1994.
[6]
J.P. Murphy, L.M. Wachter, and L.R. Ray, Computational Resource Allocation in Cooperative Control of Mobile Robots, First Int. Conf. on Robot Communication and Coordination, Oct 2007.
[7]
M. George and S. Sukkarieh. Tightly coupled ins/gps with bias estimation for uav applications. Proc. Australiasian Conf. on Robotics and Automation (ACRA), 2005.
[8]
I. Ashokaraj, P. Silson, and A. Tsourdos. Application of an extended Kalman filter to multiple low cost navigation sensors in wheeled mobile robots. Sensors, 2:1660-1664, 2002.
[9]
F. Azizi and N. Houshangi. Sensor integration for mobile robot position determination. IEEE Int. Conf. on Systems, Man and Cybernetics, 2:1136-1140, 2003.
[10]
T. Aono, K. Fujii, S. Hatsumoto, and T. Kamiya. Positioning of vehicle on undulating ground using GPS and dead reckoning. IEEE Int. Conf. on Rob. and Automation, Belgium, 3443-3448, 1998.
[11]
J. Wang, H. K. Lee, and C. Rizos. GPS/INS integration: A performance sensitivity analysis. Wuhan University Journal of Nature Sciences, 8(2B):508-516, 2003.
[12]
D. M. Bevly. Global positioning system (gps): A low-cost velocity sensor for correcting inertial sensor errors on ground vehicles. J. Dynamic Systems, Measurement, and Control, 126:255-264, 2004.
[13]
Y. Yang and J. A. Farrell. Magnetometer and differential carrier phase GPS-aided INS for advanced vehicle control. IEEE Trans. on Robotics and Automation, 19(2):269-282, 2003.
[14]
L.M. Wachter. Design of a Motion Coordination Architecture for a Multi-Robot System with Hardware Constraints, M.S. Thesis, Dartmouth College, 2008.
[15]
R. F. Stengel. Stochastic Optimal Control. John Wiley & Sons, 1986.
[16]
P. Zarchan and H. Musoff. Fundamentals of Kalman Filtering, vol. 190 of Progress in Astronautics and Aeronautics. AIAA, Inc., 2000.
[17]
J. Farrell and M. Livstone. Exact calculation of discrete-time process noise statistics for hybrid continuous/discrete time applications. In Proc. Conf. on Decision and Control, pages 857-858, 1993.
[18]
H. Kim, J. Lee, and C. Park. Performance improvement of GPS/INS integrated system using Allan Variance analysis. Proc. of the International Symposium on GNSS/GPS, 2004.
[19]
K. Mohammadi and Mohammad Reza Zamani. Using GPS velocity information in enhancement of GPS position accuracy. Proc. Asian GPS Conference, 2002.
[20]
M. Phan, L. G. Horta, J.-N. Juang, and R. W. Longman. Improvement of observer/kalman filter identification (OKID) by residual whitening. J. Vibrations and Acoustics, 117:232-239, 1995.
[21]
F. E. Daum and R. J. Fitzgerald. Decoupled Kalman Filters for phase array radar tracking. IEEE Trans. on Aut. Cont., 28(3):269-283, 1983.
[22]
Steven R. Rogers. Steady-state performance of the decoupled Kalman Filter. Proc. Aerospace and Electronics Conference, 334-339, 1988.
[23]
M.J. Goris, D.A. Gray, and J.M.Y Mareels. Reducing the computational load of a Kalman Filter. Electronics Letters, 33(18):1540-1541, 1997.
Recommendations
An alternative FIR filter for state estimation in discrete-time systems
To overcome the resulting problems of existing finite impulse response (FIR) structure filters, this paper proposes an alternative FIR filter for state estimation in discrete-time systems, which is derived from the well-known Kalman filter with ...
Kalman filtering with statistical state constraints
For linear dynamic systems with white process and measurement noise, the Kalman filter is known to be the minimum variance linear state estimator. In the case that the random quantities are Gaussian, then the Kalman filter is the minimim variance state ...
A new FIR filter for state estimation and its application
This paper proposes a new FIR (finite impulse response) filter under a least squares criterion using a forgetting factor. The proposed FIR filter does not require information of the noise covariances as well as the initial state, and has some inherent ...
Comments
Please enable JavaScript to view thecomments powered by Disqus.Information & Contributors
Information
Published In
June 2009
5820 pages
ISBN:9781424445233
Publisher
IEEE Press
Publication History
Published: 10 June 2009
Qualifiers
- Article
Contributors
Other Metrics
Bibliometrics & Citations
Bibliometrics
Article Metrics
- 0Total Citations
- 0Total Downloads
- Downloads (Last 12 months)0
- Downloads (Last 6 weeks)0
Reflects downloads up to 14 Nov 2024
Other Metrics
Citations
View Options
View options
Get Access
Login options
Check if you have access through your login credentials or your institution to get full access on this article.
Sign in