Anomaly detection method based on kinematics model and nonholonomic constraint of vehicle

Abstract

A method used to detect anomaly and estimate the state of vehicle in driving was proposed. The kinematics model of the vehicle was constructed and nonholonomic constraint conditions were added, which refer to that once the vehicle encounters the faults that could not be controlled, the constraint conditions are violated. Estimation equations of the velocity errors of the vehicle were given out to estimate the velocity errors of side and forward. So the stability of the whole vehicle could be judged by the velocity errors of the vehicle. Conclusions were validated through the vehicle experiment. This method is based on GPS/INS integrated navigation system, and can provide foundation for fault detections in unmanned autonomous vehicles.

Keywords

kinematics model / nonholonomic constraint / error mapping / state estimation

References

[1] BrandtA., GardnerJ. F.. Constrained navigation algorithms for strap down inertial navigation systems with reduced set of sensors [C]. Proceedings of the American Control Conference, 1998, New York, IEEE Engineering Society: 1848-1852

[2] SukkariehS.Low cost, high integrity, aided inertial navigation systems for autonomous land vehicles [D], 2000, Sydney, Australian Centre for Field Robotics, University of Sydney

[3] DissanayakeG., SukkariehS., NebotE., DurrantW. H.. The aiding of a low-cost strap down inertial measurement unit using vehicle model constraints for land vehicle applications [J]. IEEE Transactions on Robotics and Automation, 2001, 17(5): 731-747

[4] ShinE. H.Accuracy improvement of low cost INS/GPS for land applications [D], 2001, Calgary, Alberta, Department of Geomantic Engineering, Calgary University

[5] SolovievA., GraasF. V.. Use of deeply integrated GPS/INS architecture and laser scanners for the identification of multi-path reflections in urban environments [J]. IEEE Journal of Selected Topics in Signal Processing, 2009, 3(5): 786-797

[6] KurnazS., CetinO., KaynakO.. Adaptive neuro-fuzzy inference system based autonomous flight control of unmanned air vehicles [J]. Expert Systems with Applications, 2010, 37(2): 1229-1234

[7] HerediaG., OlleroA., BejarM., MahtaniR.. Sensor and actuator fault detection in small autonomous helicopters [J]. Mechatronics, 2008, 18(2): 90-99

[8] GodhaS., CannonM. E.. GPS/MEMS INS integrated system for navigation in urban areas [J]. GPS Solutions, 2007, 11(3): 1080-5370

[9] WesemeierD., RolfsermannS.. Identification of vehicle parameters using stationary driving maneuvers [J]. Control Engineering Practice, 2009, 17(12): 1426-1431

[10] SeungH. Y., JinO. H., LeeH.. New adaptive approaches to real-time estimation of vehicle side slip angle [J]. Control Engineering Practice, 2009, 17(12): 1367-1379

[11] FranS., BatemanC., NouraH., OuladsineM.. Active fault detection and isolation strategy for an unmanned aerial vehicle with redundant flight control surfaces [C]. 16th Mediterranean Conference on Control and Automation, 2008, New York, IEEE Society: 1246-1251

[12] RenX.-d., FengZ.-r., ChangH., MuR.-feng.. Kinematics modeling and analysis for three-wheel omnidirectional, mobile robot [C]. Proceedings of the 7th World Congress on Intelligent Control and Automation, 2008, New York, IEEE: 2608-2613

[13] STARNETO TECHNOLOGY DEVELOPMENT CORPORATION. Manual of XW-ADU5630 GPS/INS integrated system [EB/OL]. [2010-05-27]. http://www.3dgps.com.cn/proshow.asp?ArticleID=278.

[14] RenX.-p., CaiZ.-xing.. Using the Ackerman principle for kinematics modeling of wheeled mobile robots [J]. CAAI Transactions on Intelligent Systems, 2009, 4(6): 534-537

[15] MengGang.. Analysis of turning characteristic and the principle of Ackerman turning for vehicle [J]. Mechanical Research & Application, 2007, 20(4): 36-38

[16] DengZ.-w., ZhangF.-xing.. The analysis of steady-state steering characteristic turning radius-based in vehicle [J]. Agricultural Equipment & Vehicle Engineering, 2007, 1: 23-26

[17] RenX.-p., CaiZ.-xing.. Kinematics model of unmanned driving vehicle [C]. Proceedings of the 8th World Congress on Intelligent Control and Automation, 2010, New York, IEEE Society: 5910-5914

[18] WangJ. H., GaoY.. GPS-based land vehicle navigation system assisted by a low-cost gyro-free INS using neural metwork [J]. Journal of Navigation, 2004, 57(3): 417-428

[19] CHANGFENG CORPORATION. Manual of CFA6470MA [EB/OL]. [2010-05-27]. http://www.cfmotors.com/index.html?id=2.