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.