Autonomous Navigation and Path Tracking Control on Field Roads in Hilly Areas

Hilly areas necessitate a field road vehicle with high automation to reduce the amount of labor required to transport agricultural products and to increase productivity. In this paper, an adaptive integrated navigation method (combining global navigation satellite system (GNSS) and inertial navigation system (INS)) and path tracking control strategy of field road vehicles are studied in view of the problems of frequent GNSS outages and high automatic control precision requirement in hilly areas. An indirect Kalman filter (KF) is designed for the GNSS/INS information fusion. A modified method for calculating the KF adaptive factor is proposed to effectively suppress the divergence of the KF and a threshold judgement method to abandon the abnormal GNSS measurement is proposed to deal with GNSS interruptions. To achieve automated driving, a five-layer fuzzy neural network controller, which takes the lateral deviation, heading deviation, and path curvature as input and the steering angle as output, is proposed to control vehicle autonomous tracking of the navigation trajectory accurately. The proposed system was evaluated through simulation and experimental tests on a field road. The simulation results showed that the adjusted KF fusion algorithm can effectively reduce the deviation of a single GNSS measurement and improve the overall accuracy. The test results showed the maximum deviation of the actual travel trajectory from the expected trajectory of the vehicle in the horizontal direction was 12.2 cm and the average deviation was 5.3 cm. During GNSS outages due to obstacles, the maximum deviation in the horizontal direction was 12.7 cm and the average deviation was 6.1 cm. The results show that the designed GNSS/INS integrated navigation system and trajectory tracking control strategy can control a vehicle automatically while driving along a field road in a hilly area.

[1]  Aboelmagd Noureldin,et al.  GPS/INS integration utilizing dynamic neural networks for vehicular navigation , 2011, Inf. Fusion.

[2]  Cheng Liu,et al.  Trajectory tracking of underactuated surface vessels based on neural network and hierarchical sliding mode , 2015 .

[3]  Auday Al-Mayyahi,et al.  Adaptive Neuro-Fuzzy Technique for Autonomous Ground Vehicle Navigation , 2014, Robotics.

[4]  H. Qiu,et al.  A DYNAMIC PATH SEARCH ALGORITHM FOR TRACTOR AUTOMATIC NAVIGATION , 2004 .

[5]  Gai Meng,et al.  Adaptive fading Kalman filter based on innovation covariance , 2011 .

[6]  Elliott D. Kaplan.  Understanding GPS : principles and applications , 1996 .

[7]  Xu Cheng-wei.  Research on information fusion , 2008 .

[8]  Arto Visala,et al.  Navigation system for agricultural machines: Nonlinear Model Predictive path tracking , 2012 .

[9]  Prabir Bhattacharya,et al.  A novel hybrid fusion algorithm to bridge the period of GPS outages using low-cost INS , 2014, Expert Syst. Appl..

[10]  Rudolph van der Merwe,et al.  The square-root unscented Kalman filter for state and parameter-estimation , 2001, 2001 IEEE International Conference on Acoustics, Speech, and Signal Processing. Proceedings (Cat. No.01CH37221).

[11]  Jing Li,et al.  Improving positioning accuracy of vehicular navigation system during GPS outages utilizing ensemble learning algorithm , 2017, Inf. Fusion.

[12]  Ahmed El-Shafie,et al.  Amplified wavelet-ANFIS-based model for GPS/INS integration to enhance vehicular navigation system , 2013, Neural Computing and Applications.

[13]  Xiaoji Niu,et al.  Tightly-Coupled Integration of Multi-GNSS Single-Frequency RTK and MEMS-IMU for Enhanced Positioning Performance , 2017, Sensors.

[14]  Carl E. Rasmussen,et al.  Model based learning of sigma points in unscented Kalman filtering , 2010, 2010 IEEE International Workshop on Machine Learning for Signal Processing.

[15]  Feng Qin,et al.  Performance Improvement of Receivers Based on Ultra-Tight Integration in GNSS-Challenged Environments , 2013, Sensors.

[16]  Jian Wang,et al.  Performance Analysis on Carrier Phase-Based Tightly-Coupled GPS/BDS/INS Integration in GNSS Degraded and Denied Environments , 2015, Sensors.

[17]  Jafar Keighobadi,et al.  In-move aligned SINS/GNSS system using recurrent wavelet neural network (RWNN)-based integration scheme , 2018, Mechatronics.

[18]  Deng Xiaotao.  Research on GPS Navigational System Anti-interference Technology , 2006 .

[19]  Mathieu Joerger,et al.  Kalman filter-based INS monitor to detect GNSS spoofers capable of tracking aircraft position , 2016, 2016 IEEE/ION Position, Location and Navigation Symposium (PLANS).

[20]  D. Titterton,et al.  Strapdown inertial navigation technology - 2nd edition - [Book review] , 2005, IEEE Aerospace and Electronic Systems Magazine.

[21]  A. Noureldin,et al.  Bridging GPS outages using neural network estimates of INS position and velocity errors , 2006 .

[22]  S. L. Ho,et al.  Speed estimation of an induction motor drive using an optimized extended Kalman filter , 2002, IEEE Trans. Ind. Electron..

[23]  Liang Li,et al.  An innovative information fusion method with adaptive Kalman filter for integrated INS/GPS navigation of autonomous vehicles , 2018 .

[24]  Zhang Jun-tao.  Quaternion-based Kalman filter and its performance analysis in integrated navigation , 2013 .

[25]  Agus Budiyono,et al.  Principles of GNSS, Inertial, and Multi-sensor Integrated Navigation Systems , 2012 .

[26]  Guoqing Xia,et al.  INS/GNSS Tightly-Coupled Integration Using Quaternion-Based AUPF for USV , 2016, Sensors.

[27]  Zhongjiu Zheng,et al.  Nussbaum-Based Adaptive Fuzzy Tracking Control of Unmanned Surface Vehicles with Fully Unknown Dynamics and Complex Input Nonlinearities , 2018, Int. J. Fuzzy Syst..

[28]  Jian Wang,et al.  GPS/INS/Odometer Integrated System Using Fuzzy Neural Network for Land Vehicle Navigation Applications , 2014, Journal of Navigation.