تعیین جهت و موقعیت تراکتور با تلفیق داده‌های IMU و GPS و قطب‌نمای دیجیتال به کمک فیلتر کالمن

نوع مقاله : کاربردی

نویسندگان

1 دانشیار، گروه مهندسی بیوسیستم، دانشکده کشاورزی، دانشگاه شهید چمران اهواز، اهواز، ایران. گروه مهندسی بیوسیستم، دانشکده کشاورزی، دانشگاه فردوسی مشهد، مشهد، ایران.

2 فارغ التحصیل مقطع کارشناسی ارشد، گروه مهندسی بیوسیستم، دانشکده کشاورزی، دانشگاه شهید چمران اهواز، اهواز، ایران

3 دانشیار، گروه مهندسی بیوسیستم، دانشکده کشاورزی، دانشگاه شهید چمران اهواز، اهواز، ایران

چکیده
هدایت خودکار تراکتورهای کشاورزی نیازمند تعیین دقیق جهت و موقعیت حرکت آنها است، که برای این کار می‌توان از حسگرهای مختلفی استفاده نمود. با ترکیب داده‌های GPS و IMU با فیلتر کالمن، موقعیت و جهت قرارگیری دقیق تراکتور تعیین می‌گردد. در این پژوهش، با هدف توسعه یک سامانه ناوبری اینرسی (INS) برای هدایت تراکتورهای کشاورزی، از ماژول GPS مدل NEO-6M، ماژول IMU مدل MPU6050 و ماژول قطب‌نما مدل CMPS03 استفاده شد. وظیفه اخذ داده از ماژول‌های GPS و IMU و قطب‌نما و ترکیب داده‌های آنها و نمایش و ذخیره نتایج بر عهده برد میکروکنترلر آردوینو مدل MEGA2560 بود. برنامه‌نویسی و پیاده‌سازی الگوریتم ترکیب داده‌ها و برنامه‌ریزی میکروکنترلر در محیط IDE آردوینو انجام شد. مطابق نتایج ارزیابی آزمایشگاهی، مقادیر زوایای بدست آمده از ژیروسکوپ در ابتدا بدون نویز و بدون آفست بودند، لیکن با گذشت زمان بدلیل خطاهای موجود در فرآیند انتگرال‌گیری، دچار انحراف از مقدار اولیه (دریفت) شدند. مقادیر زوایای پیچ و رول بدست آمده از داده‌های شتاب‌سنج دارای نویز و آفست بودند. استفاده از فیلتر کالمن توسعه‌یافته باعث حذف نویزها و دریفت از مقادیر زوایای پیچ و رول گردید. همچنین ترکیب مقادیر زاویه قطب‌نمای دیجیتال با مقدار زاویه یاو بدست آمده از داده‌های ژیروسکوپ با فیلتر کالمن، منجر به حذف دریفت از مقادیر زاویه یاو شد. با تلفیق داده‌های GPS و IMU به کمک فیلتر کالمن، دقت بالاتری در تعیین موقعیت تراکتور حاصل شد. جذر میانگین مربعات خطا (RMSE) در تعیین موقعیت تراکتور در جاده توسط سامانه در راستای X برابر با 61/4 متر، در راستای Y برابر با 50/3 متر و در کل 09/4 متر بدست آمد. همچنین حداکثر خطا در تعیین موقعیت (Emax) در راستای X برابر با 15/11 متر و در راستای Y برابر با 05/11 متر و در کل 15/11 متر بوده است. با تکمیل سامانه پیشنهادی در این پژوهش می‌توان از آن برای هدایت خودکار تراکتورهای کشاورزی استفاده نمود.

حقوق ناشر محفوظ است.

کلیدواژه‌ها

موضوعات

عنوان مقاله English

Estimation of Tractor Position and Heading Using Kalman Filter–Based Fusion of IMU, GPS, and Digital Compass Data

نویسندگان English

Hassan Masoudi 1
Seyedeh Amineh Sharifi 2
Mohamad Esmail Khorasani Ferdavani 3
1 Associate professor, Department of Biosystems Engineering, Faculty of Agriculture, Shahid Chamran University of Ahvaz, Ahvaz, Iran. Department of Biosystems Engineering, Faculty of Agriculture, Ferdowsi University of Mashhad, Mashhad, Iran.
2 Graduated M.Sc. student, Department of Biosystems Engineering, Faculty of Agriculture, Shahid Chamran University of Ahvaz, Ahvaz, Iran
3 Associate Professor, Department of Biosystems Engineering, Faculty of Agriculture, Shahid Chamran University of Ahvaz, Ahvaz, Iran
چکیده English

Introduction Automatic guidance of agricultural tractors requires accurate estimation of both position and heading, which can be achieved through the integration of multiple sensors. Combining data from an inertial measurement unit (IMU) with satellite-based positioning systems (GPS) using a Kalman filter significantly improves the performance of inertial navigation systems (INS). The GPS module provides global position information, while the IMU measures linear acceleration and angular velocity. By processing IMU outputs, the vehicle’s local position and orientation can also be estimated. Finally, fusing GPS and IMU data through a Kalman filter enables precise determination of the tractor’s position and heading. The aim of this research was to develop an INS for determining the position and heading of agricultural tractors by integrating GPS, IMU, and digital compass data using an Extended Kalman filter algorithm. The resulting outputs can be applied in automatic tractor guidance systems.

Materials and Methods In this study, a NEO-6M GPS module, an MPU6050 IMU module, and a CMPS03 digital compass were used to develop the INS. Data acquisition from the sensors, data fusion, as well as result display and storage, were managed using an Arduino MEGA2560 microcontroller. The implementation of the data fusion algorithm and system programming was carried out in the Arduino IDE environment. In general, IMU outputs contain noise and offset errors. First, the noise was reduced using a median filter, and the offset values were determined by recording the sensor outputs over 200 repetitions, calculating their average, and subtracting the resulting offset from the data. By integrating the gyroscope data, the system rotation angles about the three body axes, namely roll, pitch, and yaw, were obtained. Using the yaw angle derived from the gyroscope data, a rotation matrix was constructed to transform the accelerometer outputs from the body coordinate system to the global coordinate system, thereby obtaining the acceleration components in the global frame. Assuming that the experimental ground surface was flat and level, the gravitational acceleration component was removed only from the vertical acceleration data. The acceleration components in the global coordinate system were then integrated once over time to estimate velocity and integrated a second time to determine the tractor position in three directions. In addition, the tractor pitch and roll angles relative to the global coordinate system were calculated from the acceleration components in the global frame. Finally, the pitch and roll angles obtained from the accelerometer data were fused with the angular velocity measurements around the y- and x-axes, respectively, using an extended Kalman filter to achieve more accurate orientation estimates. Similarly, the digital compass output was combined with the angular velocity around the z-axis to improve the yaw angle estimation. Furthermore, the position estimates obtained from the GPS module were fused with those derived from the accelerometer data to provide a more accurate estimation of the tractor position. After preparation of the hardware and software components and completion of laboratory testing, the developed system was installed on a MF 285 tractor, and its performance in determining tractor position and heading was evaluated. The position and heading values recorded by the system were compared with the actual tractor values, and the corresponding errors were determined. Root mean square error (RMSE) and maximum error (Emax) were used to evaluate system accuracy.

Results and Discussion Laboratory evaluation results showed that gyroscope-derived angle measurements were initially free from noise and offset; however, they gradually deviated over time due to integration drift. In contrast, pitch and roll angles derived from accelerometer data exhibited both noise and offset. Application of the Kalman filter effectively reduced noise and compensated for drift in pitch and roll estimates. Furthermore, fusion of digital compass data with gyroscope-based yaw angles using the Kalman filter successfully eliminated yaw drift. Integration of GPS and IMU data through the Kalman filter also improved positional accuracy. During road tests, the system achieved an RMSE of In the X direction equal to 61.4 m, in the Y direction equal to 50.3 m and in total 4.09 m in estimating tractor position. The maximum error (Emax) in determining position was 11.15 m in the X direction and 11.05 m in the Y direction, resulting in a total maximum positional error of 11.15 m. These errors were mainly caused by interruptions in GPS signal reception at certain points along the test path, which disrupted system performance and resulted in inaccurate position estimation and Kalman filter outputs. Variance analysis of Emax values indicated that tractor forward speed had no significant effect on position determination in the X and Y directions or on total positional accuracy at the 5% probability level. Therefore, the developed system is capable of determining tractor position under different forward speed conditions.

Conclusion The developed INS demonstrated strong potential for application in the automatic guidance of agricultural tractors. To further improve system performance, the use of more accurate GPS and IMU modules is recommended. In addition, alternative noise reduction techniques and advanced versions of the Kalman filter, as well as other data fusion algorithms, should be investigated and evaluated.

کلیدواژه‌ها English

Agricultural tractors
Inertial navigation system
Data fusion
Kalman filter
Digital compass
IMU
  1. 2022. CMPS03 compass module. https://www.arduino.cc. (accessed June 2022) Arduino Company. 2019. Arduino MEGA 2560 Rev3. https://store.arduino.cc/products/arduino-mega-2560-rev3. (accessed October 2019)
  2. Asghari, A., Nasrollahi, S., and Ghahremani, N. 2019. Implementation of roll angle and angular velocity estimation algorithm for a high-speed projectile using accelerometers output data. Journal of Control, 13(2): 67-80. https://doi.org/10.29252/joc.13.2.67. (In Persian)
  3. Baek, S., Liu, Ch., Watta, P., and Murphey, Y.L. 2017. Accurate vehicle position estimation using a Kalman filter and neural network-based approach. IEEE Symposium Series on Computational Intelligence (SSCI), Honolulu, HI, USA. https://doi.org/10.1109/SSCI.2017.8285360
  4. Ghasemzadeh, S.V. 2019. Modelling and simulating of inertial navigation systems in INERTIAL, ECEF and NED coordinate systems. Aerospace Mechanics Journal, 14(4): 75-89. https://sid.ir/paper/101818/en. (In Persian)
  5. Ghasemzadeh, S.V. 2020. Precise navigation of a marine vessel using the integration of INS and GPS systems and the use of an extended Kalman filter. Aerospace Mechanics Journal, 15(1): 153-165. (In Persian)
  6. Goli, H., Minaei, S., Jafari, A., Keyhani, A.R., Hajiahmad, A., Abdolmaleki, H., and Borghaee, A.M. 2014. Comparison of four different methods for agricultural positioning using GPS and IMU. Journal of Agricultural Machinery, 4(2): 285-295. https://doi.org/10.22067/jam.v4i2.20849. (In Persian)
  7. Liu, Y., Fan, X., Lv, Ch., Wu, J., Li, L., and Ding, D. 2018. An innovative information fusion method with adaptive Kalman filtering for integrated INS/GPS navigation of autonomous vehicles. Mechanical Systems and Signal Processing, 100: 605-616. https://doi.org/10.1016/j.ymssp.2017.07.051
  8. Masoudi, H., and Khorasani Ferdavani, M.E. 2012. Tractor three angles measurement system using gyroscope. 7th National Congress on Agricultural Machinery Engineering and Mechanization, 5-7 September 2012, Shiraz University, Iran. (In Persian)
  9. Mazidi, M., Abbaspour-Fard, M.H., and Aqkhani, M.H. 2013. Investigation of automatic localization and guidance of agricultural vehicles using GPS data. 8th National Congress of Agricultural Machinery Engineering (Biosystems) and Mechanization of Iran, 29-31 February, Ferdowsi University of Mashhad. (In Persian)
  10. Mazidi, M., Abbaspour-Fard, M.H., and Akbarzadeh-T., M.R. 2021. Low-cost differential positioning for precision agriculture applications in less developed areas. Journal of Researches in Mechanics of Agricultural Machinery, 10(2): 23-32. (In Persian)
  11. Navidi, N., Landry, R. Jr., Cheng, J., and Gingras, D. 2016. A new technique for integrating MEMS-based low-cost IMU and GPS in vehicular navigation. Journal of Sensors, 2016: 1-16. https://doi.org/10.1155/2016/5365983
  12. Nezhadshahbodaghi, M., and Mosavi, M. R. 2019. Three-dimensional angles measurement using IME based on MEMS technology by adaptive Kalman filter. Electronic and Cyber Defense, 7(2): 81-91. https://sid.ir/paper/243224/en (In Persian)
  13. Park, K., Kim, W., and Seo, J. 2020. Effects of initial attitude estimation errors on loosely coupled smartphone GPS/IMU integration system. In 2020 20th International Conference on Control, Automation and Systems (ICCAS 2020), 13-16 October, BEXCO, Busan, Korea. pp. 800-803.
  14. Pedley, M. 2013. Tilt sensing using a three-axis accelerometer. Freescale Semiconductor Application Note, 1: 2012-2013.
  15. Romaniuk, S., and Gosiewski, Z. 2014. Kalman filter realization for orientation and position estimation on dedicated processor. ACTA Mechanica et Automatica, 8(2): 88-94. https://doi.org/10.2478/ama-2014-0016
  16. Sharifi, A., and Eslami, A. 2025. Implementation of a single degree of freedom rotary inertial navigation system based on low-cost inertial sensors. 23rd International Conference of the Iranian Aerospace Society, 20-22 May, Tehran, Iran. http://openaccess.ir/c/HN-AERO2025/paper_1515405
  17. Wang, Sh., Deng, Zh., and Yin, G. 2016. An accurate GPS-IMU/DR data fusion method for driverless car based on a set of predictive models and grid constraints. Sensors, 16(280): 1-13. https://doi.org/10.3390/s16030280
  18. Woodman, O.J. 2007. An introduction to inertial navigation. Technical report Number 696. Published by the University of Cambridge, Computer Laboratory. https://doi.org/10.1.1.63.7402
  19. Xiang, Y., and Noguchi, N. 2014. Development and evaluation of a general-purpose electric off-road robot based on agricultural navigation. International Journal of Agricultural and Biological Engineering, 7(5): 14-21. Retrieved from https://ijabe.org/index.php/ijabe/article/view/1328
  20. Yin, X., Du, J., Noguchi, N., Yang, T., and Jin, Ch. 2018. Development of autonomous navigation system for rice transplanter. International Journal of Agricultural and Biological Engineering, 11(6): 89–94. Retrieved from https://ijabe.org/index.php/ijabe/article/view/3023