Method for measuring the steering wheel angle of paddy field agricultural machinery by integrating RTK-GNSS and dual-MEMS gyroscope

Abstract

Aiming at the application environment of paddy agricultural machinery with bumpy and undulating changes, the problems affecting the method for steering wheel angle measurement by MEMS gyroscope were analyzed, and a wheel angle measurement method combining Dual-MEMS gyroscope (dual MEMS gyroscope) and RTK-GNSS was designed. The adaptive weighting method was used to fuse the heading angle differentiation of RTK-GNSS, the MEMS gyroscope angle rate, and velocity data, and the rod-arm compensation was performed to accurately obtain the angle rates of the body and steering wheels of agricultural machinery; the difference between the combined angular rate of the steering wheel of the agricultural machinery and the angular rate of the agricultural machinery body was obtained, and the integrator is used to integrate the difference to get the wheel steering angle value, and the Kalman filter was designed to make feedback correction for the integration process of angle calculation to eliminate the errors caused by the gyroscope zero bias, random drift, and gyroscope rod arm effect, and to obtain the accurate value of wheel steering angle. A comparative test with the connecting rod wheel angle sensor was designed, and the results show that the maximum deviation is 4.99°, the average absolute average value is 1.61°, and the average standard deviation is 0.98°. The method in this study and the connecting rod wheel angle sensor were used on paddy farm machinery. The wheel angle measurement deviation of the proposed method and the connecting rod wheel angle sensor was not more than 1°, which is relatively small. It has good stability, speed adaptability, and dynamic responsiveness that meets the accuracy requirements of steering wheel angle measurement for paddy field agricultural machinery unmanned driving and can be used instead of connecting rod angle sensors for unmanned agricultural machinery.