Non-Linear Complementary SO(3) Filters for Attitude Estimation and Navigation of Ground Vehicles

Abstract:

The use of Inertial Navigational System (INS) has been proven to be suitable for vehicular stability and control. The same system can be used for inertial based navigation in the absence of GPS. In this paper, the problem of obtaining good attitude estimates from low cost sensors used for car navigation in the absence of GPS data is discussed. The states to be estimated are using angular velocity and linear accleration signals obtained from the sets of gyros and accelerometers of the INS. The special orthogonal group, the SO(3)-based complementary filters, have been used as the estimators as they are most suited for embedded systems to generate highly efficient algorithms for navigation. The INS has also been integrated with a set of magnetometers to assist in achieving global navigation. This integration requires kinematics equations as well as the inclusion of the gyro and accelerometer calibration and filtering. By using the quatronion representation, not only highly compact algorithms for integration can be generated, but it can also estimate and remove the effects of other biases and misalignments caused by, for instance, inaccurate installations and inherent sensors problems. The results obtained through simulation indicate better performance then Kalman filter approach as well as iterative recursive least square approach even with low grade sensors. The results are comparable with attitude estimation using roll index but with much less computations and better performance.

• Periodical: Applied Mechanics and Materials (Volume 663)
• Pages: 254-258
• DOI: https://doi.org/10.4028/www.scientific.net/AMM.663.254
• Online since: October 2014
• Authors: Fargham Sandhu*, Hazlina Selamat, Yahaya Md Sam
• Keywords: Complementary Filter, Non-Linear Observer, Quatranions, Special Orthogonal Group, Vehicle Attitude Estimation

References

[1] D. Kim, S.B. Choi, J. Oh, Integrated vehicle mass estimation using longitudinal and roll dynamics, International Conference on Control, Automation and Systems, 2012, pp.862-867.

[2] W.J. Manning, D.A. Crolla, A review of yaw rate and sideslip controllers for passenger vehicles, Transactions of the Institute of Measurement and Control. 2 (2007) 117-135.

DOI: 10.1177/0142331207072989

[3] David M. Bevly, J. Christian Gerdes, The use of GPS based velocity measurements for improved vehicle state estimation, Proceedings of the American Control Conference, 2000, pp.2538-2542.

DOI: 10.1109/acc.2000.878665

[4] A. Hac, M.D. Simpson, Estimation of vehicle side slip angle and yaw rate, Society of Automotive Engineers. 6 (2000) 1-7.

DOI: 10.4271/2000-01-0696

[5] H-S. Kim, S-C. Bu, G-I. Jee, C-G. Park, An ultra-tightly coupled GPS/INS integration using federated Kalman filter, Proceedings of the 16th International Technical Meeting of the Satellite Division of the Institute of Navigation (ION GPS/GNSS 2003), Portland, OR, September 2003, pp.2878-2885.

DOI: 10.33012/2018.15988

[6] D-J. Jwo, C-F. Yang, C-H. Chuang, K-C. Lin, A novel design for the ultra-tightly coupled GPS/INS navigation system, Journal of Navigation. 65 (2012) 717-747.

DOI: 10.1017/s0373463312000161

[7] R. Toledo-Moreo, D. Bétaille, F. Peyret, Lane-level integrity provision for navigation and map matching with GNSS, dead reckoning, and enhanced maps, IEEE Transactions on Intelligent Transport Systems. 11 (2010) 100-112.

DOI: 10.1109/tits.2009.2031625

[8] J.A. Farell, Aided Navigation GPS with High Data Rate Sensors, 1st edition, McGraw Hill, NewYork, (2008).

[9] K. Cho, H. Son, S.B. Choi, S. Kang, Lateral acceleration compensation of a vehicle based on roll angle estimation, IEEE International Conference on Control Applications, 2010, pp.1363-1368.

DOI: 10.1109/cca.2010.5611095

[10] R. Toledo-Moreo, M.A. Zamora-Izquierdo, B. Úbeda-Miñarro, A.F. Gómez-Skarmeta, High-integrity IMM-EKF-based road vehicle navigation with low-cost GPS/SBAS/INS, IEEE Transactions on Intelligent Transportation Systems. 8 (2007) 491-510.

DOI: 10.1109/tits.2007.902642

[11] J. Oh, S.B. Choi, Vehicle roll and pitch angle estimation using a cost-effective six-dimensional inertial measurement unit, Journal of Automobile Engineering. 9 (2012) 577-590.

DOI: 10.1177/0954407012459138

[12] J. Oh, S.B. Choi, Vehicle velocity observer design using 6-D IMU and multiple-observer approach, IEEE Transactions on intelligent transportation systems. 13 (2012) 1865-1879.

DOI: 10.1109/tits.2012.2204984

[13] R. Mahony, T. Hamel, J-M. Pflimlin, A study on non-linear filter design for kinematic systems on the special orthogonal group, Project SAM, I2S Laboratory, 2006, pp.1-38.