مجله ی مهندسی مکانیک شریف

مجله ی مهندسی مکانیک شریف

مکان‌یابی ربات متحرک با ترکیب داده‌های حسگر‌های انکودر و قطب‌نما توسط فیلتر کالمن توسعه‌یافته و بی بو

نوع مقاله : مقاله پژوهشی

نویسندگان
گروه دینامیک و کنترل، دانشکده‌ی مهندسی مکانیک، دانشگاه یزد، یزد، ایران
10.24200/j40.2026.68104.1755
چکیده
مکان­یابی ربات­های متحرک در محیط‌های داخلی به‌دلیل وجود نویز و موانع، با چالش‌های متفاوتی، مانند انباشتگی خطاها و نوسان‌های زیاد مواجه است. در نوشتار حاضر، به بررسی استفاده از فیلتر کالمن توسعه‌یافته (EKF) و فیلتر کالمن بی‌بو (UKF) برای پیش‌بینی مختصات یک ربات متحرک چرخ‌دار با استفاده از مدل­های غیرخطی پرداخته شده است. در این راستا، روشی برای ترکیب داده‌های AHRS با خروجی مدل سینماتیکی مبتنی بر داده‌های انکودر جهت تخمین موقعیت دقیق ربات ارائه شده است؛ که در آن، مدل سینماتیکی ربات از داده‌های انکودر برای تعیین موقعیت و جهت­گیری ربات استفاده می‌کند. به ربات دستور داده می­شود تا در مسیر­های مشخص حرکت کند و با استفاده از داده­های انکودر­های چرخ­ها، مختصات ربات و مسافت پیموده‌‍شده پیش‌بینی می­شود؛ در حالی که داده‌های AHRS به‌عنوان اندازه‌گیری بیرونی برای تصحیح پیش‌بینی‌ها در فیلتر‌های کالمن استفاده می­شوند. برای ارزیابی عملکرد فیلتر‌ها، مسیر حرکت ربات با استفاده از یک سیستم تصویربرداری ثبت و تخمین موقعیت حاصل از فیلترها با داده‌های سیستم تصویربرداری مذکور مقایسه شده است. نتایج نشان داده‌اند که در ابتدای مسیر، موقعیت تخمین‌زده‌شده توسط توسط فیلترهای EKF و UKF تطابق نزدیکی با مسیر مرجع داشته است؛ اما با افزایش مسافت حرکت، به‌دلیل انباشتگی خطای انکودر، میزان خطای موقعیت افزایش یافته است. با این ‌حال، هر دو فیلتر با ترکیب اطلاعات انکودر و قطب‌نما توانسته‌اند اثر خطا‌های تجمعی را کاهش دهند و دقت تخمین موقعیت و زاویه‌ی جهت‌گیری ربات را بهبود بخشند. مقایسه‌ی نتایج نشان داده است که فیلتر UKF در هر دو مسیر آزمایشی، عملکرد بهتری نسبت به EKF داشته و کاهش بیشتری در خطای کلی مکان‌یابی ارائه داده است؛ اگرچه، به دلیل محدودبودن غیرخطی‎بودن مدل حرکت ربات، اختلاف عملکرد دو روش نسبتاً محدود بوده است.
کلیدواژه‌ها
موضوعات

عنوان مقاله English

Localization of a Mobile Robot by Fusing Encoder and Digital Compass Data Using Extended and Unscented Kalman Filters

نویسندگان English

Samaneh Maleki Koopaei
S. Mohammad Bozorg
Department of Dynamics and Control, Faculty of Mechanical Engineering, Yazd University, Yazd, Iran.
چکیده English

This study investigates the Extended Kalman Filter (EKF) and Unscented Kalman Filter (UKF) for fusing wheel encoder and digital compass measurements in a differential-drive mobile robot. A nonlinear kinematic model predicts position and heading from encoder data, while compass measurements correct the estimated heading. The algorithms are implemented in MATLAB using Arduino-acquired data. A camera-based tracking system provides the reference position for two predefined trajectories. For Path 1, the overall position root-mean-square error (RMSE) decreases from 1.2016 m for encoder-only localization to 1.1453 m with EKF and 1.1007 m with UKF, corresponding to reductions of 4.69% and 8.40%. For Path 2, RMSE decreases from 0.9184 m to 0.8367 m and 0.8099 m, corresponding to reductions of 8.89% and 11.81%. UKF additionally reduces RMSE relative to EKF by 3.90% and 3.20% for the two paths. Although UKF provides the lowest error, its improvement over EKF is limited under the investigated conditions. The results indicate that encoder-compass fusion improves localization accuracy and that UKF can provide a modest advantage over EKF.

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

Mobile Robot
Localization
Sensor Fusion
Extended Kalman Filter
Unscented Kalman Filter
 1.  Kheirandish, M., Yazdi, E.A., Mohammadi, H. and Mohammadi, M., 2023. A fault-tolerant sensor fusion in mobile robots using multiple model Kalman filters. Robotics and Autonomous Systems, 161, p.104343. DOI: https://doi.org/10.1016/j.robot.2022.104343
2.  Zunaidi, I., Kato, N., Nomura, Y. and Matsui, H., 2006. Positioning system for 4-wheel mobile robot: encoder, gyro and accelerometer data fusion with error model method. CMU. Journal, 5 (1), pp. 1–14.
3.    Sadeghi Boroujeni, P., Nejat Pishkenari, H., Moradi, H. and Vossoughi, G., 2023. Boundary feedback trajectory tracking control of rigid bodies with interior shallow-water sloshing. Sharif Journal of Mechanical Engineering (SJME), 39 (2), pp. 57–63. DOI: https://doi.org/10.24200/j40.2023.61340.1657
4.  Mobarhani, A. and Taghirad, H.D., 2014. Mobile robot semantic mapping using histogram based frontier exploration. Sharif Journal of Mechanical Engineering (SJME), 30 (3), pp. 115–124.
5.  Nasir, A.K. and Roth, H., 2012. Pose estimation by multisensor data fusion of wheel encoders, gyroscope, accelerometer and electronic compass. IFAC Proceedings Volumes, 45 (4), pp. 49–54. DOI: https://doi.org/10.3182/20120403-3-DE-3010.00068
6.  Ahmad, H. and Namerikawa, T., 2013. Extended Kalman filter-based mobile robot localization with intermittent measurements. Systems Science and Control Engineering, 1 (1), pp. 113–126. DOI: https://doi.org/10.1080/21642583.2013.864249
7.  Al Khatib, E.I., Jaradat, M.A., Abdel-Hafez, M. and Roigari, M., 2015. Multiple sensor fusion for mobile robot localization and navigation using the extended Kalman filter. In 2015 10th International Symposium on Mechatronics and its Applications (ISMA), pp. 1–5. IEEE. DOI: https://doi.org/10.1109/ISMA.2015.7373480
8.  Mahmud, M.A., Aman, M.S., Jiang, H., Abdelgawad, A. and Yelamarthi, K., 2016. Kalman filter based indoor mobile robot navigation. In International Conference on Electrical, Electronics, and Optimization Techniques (ICEEOT), pp. 1949–1953. IEEE. DOI: https://doi.org/10.1109/ICEEOT.2016.7755029
9.  Qian, J., Zi, B., Wang, D., Ma, Y. and Zhang, D., 2017. The design and development of an omni-directional mobile robot oriented to an intelligent manufacturing system. Sensors, 17 (9), p. 2073. DOI: https://doi.org/10.3390/s17092073
10. Chen, W. and Zhang, T., 2017. An indoor Chen, W. and Zhang, T., 2017. An indoor mobile robot navigation technique using odometry and electronic compass. International Journal of Advanced Robotic Systems, 14 (3), pp. 1–15. DOI: https://doi.org/10.1177/1729881417711643
11. Chand, P., 2022. Integrating an electronic compass for position tracking on a wheeled tricycle mobile robot. Drone Systems and Applications, 10 (1), pp. 179–199. DOI: https://doi.org/10.1139/dsa-2021-0049
12. Erfani, S., Jafari, A. and Hajiahmad, A., 2019. Localization and controlling the mobile robot by sensory data fusion. Agricultural Engineering International: CIGR Journal, 21 (2), pp. 86–97.
13. Xu, Y., Shmaliy, Y.S., Ma, W., Jiang, X., Shen, T., Bi, S. and Guo, H., 2021. Improving tightly LiDAR/compass/encoder-integrated mobile robot localization with uncertain sampling period utilizing EFIR filter. Mobile Networks and Applications, 26 (1), pp. 440–448. DOI: https://doi.org/10.1007/s11036-020-01680-7
14. Silaa, M.Y., Bencherif, A. and Barambones, O., 2024. Indirect adaptive control using neural network and discrete extended Kalman filter for wheeled mobile robot. Actuators, 13 (2), p. 51. DOI: https://doi.org/10.3390/act13020051
15. Doumbia, M. and Cheng, X., 2020. State estimation and localization based on sensor fusion for autonomous robots in indoor environment. Computers, 9 (4), p. 84. DOI: https://doi.org/10.3390/computers9040084
16.   Brigadnov, I., Lutonin, A. and Bogdanova, K., 2023. Error state extended Kalman filter localization for underground mining environments. Symmetry, 15 (2), p. 344. DOI: https://doi.org/10.3390/sym15020344
17.   Housein, A.A., Xingyu, G., Li, W. and Huang, Y., 2022. Extended Kalman filter sensor fusion in practice for mobile robot localization. International Journal of Advanced Computer Science and Applications, 13 (2). DOI: https://doi.org/10.14569/IJACSA.2022.0130204
18.  Nemec, D., Šimák, V., Janota, A., Hruboš, M. and Bubeníková, E., 2019. Precise localization of the mobile wheeled robot using sensor fusion of odometry, visual artificial landmarks and inertial sensors. Robotics and Autonomous Systems, 112, pp. 168–177. DOI: https://doi.org/10.1016/j.robot.2018.11.019
19.    Wu, Z., Wen, M., Peng, G., Tang, X. and Wang, D., 2019. Magnetic-assisted initialization for infrastructure-free mobile robot localization. In 2019 IEEE International Conference on Cybernetics and Intelligent Systems (CIS) and IEEE Conference on Robotics, Automation and Mechatronics (RAM), pp. 518–523. IEEE. DOI: https://doi.org/10.1109/CIS-RAM47153.2019.9095809
20.   Tran, H.T., Vo, T.C., Tran, D.L., Nguyen, Q.N., Ha, D.M., Pham, Q.N., Le, T.Q., Nguyen, T.K., Do, H.T. and Nguyen, M.T., 2022. Extended Kalman filter (EKF) based localization algorithms for mobile robots utilizing vision and odometry. In 2022 IEEE 21st Mediterranean Electrotechnical Conference (MELECON), pp. 91–96. IEEE. DOI: https://doi.org/10.1109/MELECON53508.2022.9843066
21.   Kaviani, S., Salarieh, H., Alasty, A. and Abediny, M., 2018. Comparison of nonlinear filtering techniques for inertial sensors error identification in INS/GPS integration. Scientia Iranica B: Mechanical Engineering, 25 (3), pp. 1281–1295. DOI: https://doi.org/10.24200/sci.2017.4328
22.  Khosravi, N., Khosravi, N. and Bozorg, S.M., 2020. Cooperative localization of two mobile robots using data exchange based on the Kalman filter. In Proceedings of the 7th International Conference on Mechanical Engineering of Iran (ISME 2020), Tehran, Iran, 27–29 May 2020.
23.    Fariña, B., Toledo, J. and Acosta, L., 2023. Sensor fusion algorithm selection for an autonomous wheelchair based on EKF/UKF comparison. International Journal of Mechanical Engineering and Robotics Research, 12 (1), pp. 1–7. DOI: https://doi.org/10.18178/ijmerr.12.1.1-7
24.   Wan, E.A. and Van Der Merwe, R., 2000. The unscented Kalman filter for nonlinear estimation. In Proceedings of the IEEE 2000 Adaptive Systems for Signal Processing, Communications, and Control Symposium (Cat. No. 00EX373), pp. 153–158. IEEE. DOI: https://doi.org/10.1109/ASSPCC.2000.882463
25.   Ullah, I., Shen, Y., Su, X., Esposito, C. and Choi, C., 2019. A localization based on unscented Kalman filter and particle filter localization algorithms. IEEE access, 8, pp.2233-2246. Doi: https://doi.org/10.1109/ACCESS.2019.2961740