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

Pei Wang, Lian Hu, Jie He, Siqi Ke, Zhongxian Man, Tuanpeng Tu, Luning Yang, Yuanyuan Li, YangLing Yi, Weicong Li, Xiwen Luo

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.
Keywords: steering wheel angle, MEMS gyroscope, Kalman filter, agricultural machinery navigation, agricultural machinery
DOI: 10.25165/j.ijabe.20221506.7523

Citation: Wang P, Hu L, He J, Ke S Q, Man Z X, Tu T P, et al. Method for measuring the steering wheel angle of paddy field agricultural machinery by integrating RTK-GNSS and dual-MEMS gyroscope. Int J Agric & Biol Eng, 2022; 15(6): 197–205.

Keywords


steering wheel angle, MEMS gyroscope, Kalman filter, agricultural machinery navigation, agricultural machinery

Full Text:

PDF

References


Hu J T, Gao L, Bai X P, Li T C, Liu X G. Review of research on automatic guidance of agricultural vehicles. Transactions of the CSAE, 2015; 31(10): 1–10. (in Chinese)

Ursula K V, Ana S A, Danielle V H, Douglas G, Sophie F, Guillermo J, et al. A review of unmanned vehicles for the detection and monitoring of marine fauna. Marine Pollution Bulletin, 2019; 140: 17–29.

Yin C Q, Wang S R, Li X W, Yuan G, Jiang C. Trajectory tracking based on adaptive sliding mode control for agricultural tractor. IEEE Access, 2020; 8, 113021–113029.

Nguyen Q V. INS/GPS integration system using street return algorithm and compass sensor. Procedia Computer Science, 2017; 103,475–482.

Wang Y X, Li J Q, Wang X, Jin C Q, Yin X. Development and test of a steering angle measuring device for wheeled tractor. Journal of China Agricultural University, 2022; 27(1): 203–211. (in Chinese)

Zhang Z G, Wang G M, Luo X W, He J, Wang J, Wang H. Detection method of steering wheel angle for tractor automatic driving. Transactions of CSAM, 2019; 50(3): 352–357. (in Chinese)

Yin X, Noguchi N. Development and evaluation of a general-purpose electric off-road robot based on agricultural navigation. Int J Agri & Biol Eng, 2014; 7(5): 14–21.

He J, Zhu, J G, Luo X W; Zhang Z G, Hu L, Gao Y. Design of steering control system for rice transplanter equipped with steering wheel-like motor. Transactions of CSAE, 2019; 35(6): 10–17. (in Chinese)

Hu J T, Li T C. Cascaded navigation control for agricultural vehicles tracking straight paths. Int J Agri & Biol Eng, 2014; 7(1): 36–44.

Nagasaka Y, Saito H, Tamaki K, Seki M, Kobayashi K, Taniwaki K. An autonomous rice transplanter guided by global positioning system and inertial measurement unit. Journal of Field Robotics, 2009; 26(6-7): 537–548.

Yang Y, Zhang G, Zha J Y, Li Y K, Zhang T, Chen L Q. Design of automatic steering system based on direct connection of DC motor and full hydraulic steering gear. Transactions of CSA, 2020; 51(8): 44–54, 61. (in Chinese)

Wu D, Zhang Q, Reid J. Adaptive steering controller using a Kalman estimator for wheel-type agricultural tractors. Robotica, 2001; 19(5): 527–533.

Ding Y, Wang L, Li Y W, Li D L. Model predictive control and its application in agriculture: a review. Computers and Electronics in Agriculture, 2018, 151: 104–117.

Brewer D E. Vehicle gyro based steering assembly angle and angular rate sensor. CA 20070088477.

Yin X, Du J, Noguchi N, Yang T X, Jin C Q. Development of autonomous navigation system for rice transplanter. Int J Agri & Biol Eng, 2018; 11(6): 89–94.

Han H Z, Wang J, Du M Y. GPS/BDS/INS tightly coupled integration accuracy improvement using an improved adaptive interacting multiple model with classified measurement update. Chinese Journal of Aeronautics, 2018; 31(3): 556–566.

Chen Y, He Y. Development of agricultural machinery steering wheel angle measuring system based on GNSS attitude and motor encoder. Transactions of CSAE, 2021; 37(10): 10–17. (in Chinese)

Chen Q J, Niu X J, Kuang J, Liu J N. IMU Mounting angle calibration for pipeline surveying apparatus. IEEE Transactions on Instrumentation and Measurement, 2020; 69(4): 1765–1774.

Miao C X, Chu H X, Sun Z H, Xu J Y, Ma F. Wheel turning angle measurement system based on double GNSS antennas and single gyro. Transactions of CSAM, 2017; 48(9): 17–23. (in Chinese)

Miao C X, Chu H X, Cao J J, Sun Z H, Yi R R. Steering angle adaptive estimation system based on GNSS and MEMS gyro. Computers and Electronics in Agriculture, 2018; 153: 196–201.

Si J Q, Niu Y X, Lu J Z, Zhang H. High-precision estimation of steering angle of agricultural tractors using GPS and low-accuracy MEMS. IEEE Transactions on Vehicular Technology, 2019; 68(12): 11738–11745.

Xing H F< Hou B, Lin Z H, Guo M F. Modeling and compensation of random drift of MEMS gyroscopes based on least squares support vector machine optimized by chaotic particle swarm optimization. Sensors, 2017; 17(10): 2335–2350.

Xu Q M. The research of GNSS dual-antenna/MIMU integrated algorithm. Master dissertation. Nanjing: Southeast University, 2019; 75p. (in Chinese)

Cui J, Zhao Q C. Bias thermal stability improvement of MEMS gyroscope with quadrature motion correction and temperature self-sensing compensation. Micro & Nano Letters, 2020; 15(4): 234–238.

Xu Q, Xiao D B, Hou Z Q, Zhou M, Li W Y, Xu X M, et al. A novel high-sensitivity butterfly gyroscope driven by horizontal driving force. IEEE Sensors Journal, 2019; 19(6): 2064–2071.

Guo X T, Sun C K, Wang P, Huang L. Hybrid methods for MEMS gyro signal noise reduction with fast convergence rate and small steady-state error. Sensors & Actuators: A: Physical, 2018; 269: 145–159.

Fu J, Han H X. Modified adaptive real-time filtering algorithm for MEMS gyroscope random noise. Acta Photonica Sinica, 2019; 48(12): 183–191. (in Chinese)

Gautam D, Lucieer A, Watson C, McCoull C. Lever-arm and boresight correction, and field of view determination of a spectroradiometer mounted on an unmanned aircraft system. ISPRS Journal of Photogrammetry and Remote Sensing, 2019; 155: 25–36.

Sotelo M A. Lateral control strategy for autonomous steering of Ackerman-like vehicles. Robotics and Autonomous Systems, 2003; 45: 223–233.

Huang X P, Mao J M. Analytical design on steering motion of wheeled vehicle. Journal of Nanjing Forestry University (Natural Science Edition), 2002; 6: 49–53. (in Chinese)

Li L M, Zhao L Y, Tang X H, He W, Li F R. A compensation algorithm of gyroscope error based on modified Kalman filter. Chinese Journal of Sensors and Actuators, 2018; 31(4): 538–544. (in Chinese)

Wang Q, Yang C S, Wu S E, Wang Y X. Lever arm compensation of autonomous underwater vehicle for fast transfer alignment. Computers, Materials & Continua, 2019; 59(1): 105–118.

Fu Q W, Li S H, Liu Y, Zhou Q, Wu F. Automatic estimation of dynamic lever arms for a position and orientation system. Sensors (Basel, Switzerland), 2018; 18(12): 4230. doi: 10.3390/s18124230.

He J, Gao W W, Wang H, Yue B B, Zhang F, Zhang Z G. Steering wheel angle measurement method of agricultural machinery based on dual MEMS gyroscope. Journal of Chinese Agricultural Mechanization, 2020; 41(4): 123–129. (in Chinese)

He J, Gao W W, Wang H, Yue B B, Zhang F, Zhang Z G. Wheel steering angle measurement method based on GNSS heading differential and MEMS gyroscope. Journal of South China Agricultural University, 2020; 41(5): 91–98. (in Chinese)




Copyright (c) 2022 International Journal of Agricultural and Biological Engineering

Creative Commons License
This work is licensed under a Creative Commons Attribution 4.0 International License.

2023-2026 Copyright IJABE Editing and Publishing Office