In recent years, road collapse incidents owing to underground cavities have occurred frequently. To investigate underground cavities before accidents occur, periodic cavity inspections are conducted using ground penetrating radar (GPR) equipment. When cavity inspection is performed by humans directly moving a GPR-equipped hand cart in areas inaccessible to vehicles, such as sidewalks, the area that can be inspected simultaneously is limited, often resulting in missed inspections. To address this issue, we developed a robotic system with omnidirectional mobility using a four-wheel independent steering and driving mechanism, primarily aimed at automating sidewalk cavity inspection. Cavity inspection requires path tracking control along the designated survey line; however, conventional path tracking methods are mainly designed for robots with nonholonomic constraints, such as two-wheel independent driving systems, making them unsuitable for omnidirectional mobile robots. In this study, we propose a control method called simultaneous path and orientation tracking control, which considers omnidirectional mobility. The proposed method consists of feedforward control for the target path and orientation, combined with feedback control to correct deviations. By distributing the control inputs into two degrees of freedom for the translational velocity and one degree of freedom for the angular velocity, the position and orientation of the robot can be controlled independently. Several experiments were conducted in a real-world environment to evaluate the reproducibility of the tracking control, demonstrating the effectiveness of the proposed method in terms of path and orientation tracking performance.

1. [1] R. Kuwano and Y. Oohara, “A study on the process of generation, expansion and collapse of subsurface cavities in roads,” Japanese Geotechnical J., Vol.16, No.4, pp. 307-317, 2021 (in Japanese). https://doi.org/10.3208/jgs.16.307
2. [2] R. Kuwano, “Recent studies on the mechanism of sinkholes and ground cave-ins,” Seisan Kenkyu, Vol.71, No.4, pp. 825-828, 2019 (in Japanese). https://doi.org/10.11188/seisankenkyu.71.825
3. [3] T. Saarenketo and T. Scullion, “Road evaluation with ground penetrating radar,” J. of Applied Geophysics, Vol.43, No.2, pp. 119-138, 2000. https://doi.org/10.1016/S0926-9851(99)00052-X
4. [4] H. Lorenzo, F. Rial, M. Pereira, and M. Solla, “A full non-metallic trailer for GPR road surveys,” J. of Applied Geophysics, Vol.75, No.3, pp. 490-497, 2011. https://doi.org/10.1016/j.jappgeo.2011.07.021
5. [5] H. Liu, Z. Shi, J. Li, C. Liu, X. Meng, Y. Du, and J. Chen, “Detection of cavities in urban cities by 3D ground penetrating radar,” Geophysics, Vol.86, No.3, pp. 1MJ-WA152, 2021. https://doi.org/10.1190/geo2020-0384.1
6. [6] T. Kamoshita, K. Takahashi, S. Hada, and T. Fukatsu, “Quasi-real-time pavement inspection using GPR and AI in the cloud,” Artificial Intelligence and Data Science, Vol.3, No.J2, pp. 168-174, 2022 (in Japanese). https://doi.org/10.11532/jsceiii.3.J2_168
7. [7] S. Colagrande, D. Ranalli, and M. Tallini, “Ground penetrating radar assessment of flexible road pavement degradation,” Int. J. of Geophysics, Vol.11, No.2, Article No.989136, 2011. https://doi.org/10.1155/2011/989136
8. [8] P. M. Barone and C. Ferrara, “A posteriori GPR evaluation of tree stability: A case study in Rome (Italy),” Remote Sensing, Vol.11, No.11, Article No.1301, 2019. https://doi.org/10.3390/rs11111301
9. [9] A. P. Annan and S. Cosway, “Ground penetrating radar survey design,” Proc. of the 5th EEGS Symp. on the Application of Geophysics to Engineering and Environmental Problems, pp. 329-351, 1992. https://doi.org/10.4133/1.2921946
10. [10] B. Allred, J. Daniels, N. Fausey, C.-C. Chen, L. Peters, and H. Youn, “Important considerations for locating buried agricultural drainage pipe using ground penetrating radar,” Applied Engineering in Agriculture, Vol.21, No.1, pp. 71-87, 2005. https://doi.org/10.13031/2013.17915
11. [11] Y. Kanayama, A. Nilipour, and C. Lelm, “A locomotion control method for autonomous vehicles,” Proc. 1988 IEEE Int. Conf. on Robotics and Automation, Vol.2, pp. 1315-1317, 1988. https://doi.org/10.1109/ROBOT.1988.12248
12. [12] J. E. Normey-Rico, I. Alcalá, J. Gómez-Ortega, and E. F. Camacho, “Mobile robot path tracking using a robust PID controller,” Control Engineering Practice, Vol.9, No.11, pp. 1209-1214, 2001. https://doi.org/10.1016/S0967-0661(01)00066-1
13. [13] A. Khalaji, “PID-based target tracking control of a tractor-trailer mobile robot,” Proc. of the Institution of Mechanical Engineers, Vol.233, No.13, pp. 4776-4787, 2019. https://doi.org/10.1177/095440621983043
14. [14] R. C. Coulter, “Implementation of the pure pursuit path tracking algorithm,” Carnegie Mellon University, Tech. Rep. CMU-RI-TR-92-01, 1992.
15. [15] O. Amidi, “Integrated mobile robot control,” Carnegie Mellon University, Tech. Rep. CMU-RI-TR-90-17, 1990.
16. [16] M. Samuel, M. Hussein, and M. Binti, “A review of some pure-pursuit based path tracking techniques for control of autonomous vehicle,” Int. J. of Computer Applications, Vol.135, No.1, pp. 35-38, 2016. https://doi.org/10.5120/ijca2016908314
17. [17] L. Kong, “Adaptive pure pursuit model for autonomous vehicle path tracking,” Int. J. of Science, Vol.4, No.3, pp. 70-73, 2017.
18. [18] W.-J. Wang, T.-M. Hsu, and T.-S. Wu, “The improved pure pursuit algorithm for autonomous driving advanced system,” Proc. of the 2017 IEEE 10th Int. Workshop on Computational Intelligence and Applications (IWCIA), pp. 33-38, 2017. https://doi.org/10.1109/IWCIA.2017.8203557
19. [19] Y. Chen, Y. Shan, L. Chen, K. Huang, and D. Cao, “Optimization of pure pursuit controller based on PID controller and low-pass filter,” 2018 21st Int. Conf. on Intelligent Transportation Systems (ITSC), pp. 3294-3299, 2018. https://doi.org/10.1109/ITSC.2018.8569416
20. [20] H. Wang, X. Chen, Y. Chen, B. Li, and Z. Miao, “Trajectory tracking and speed control of cleaning vehicle based on improved pure pursuit algorithm,” 2019 Chinese Control Conf. (CCC), pp. 4348-4353, 2019. https://doi.org/10.23919/ChiCC.2019.8865255
21. [21] S. Macenski, S. Singh, F. Martín, and J. Ginés, “Regulated pure pursuit for robot path tracking,” Autonomous Robots, Vol.47, No.6, pp. 685-694, 2023. https://doi.org/10.1007/s10514-023-10097-6
22. [22] J. Wit, C. D. Crane III, and D. Armstrong, “Autonomous ground vehicle path tracking,” J. Robotic Systems, Vol.21, No.8, pp. 439-449, 2004. https://doi.org/10.1002/rob.20031
23. [23] S. Thrun, M. Montemerlo, H. Dahlkamp, D. Stavens, A. Aron, J. Diebel, P. Fong, J. Gale, M. Halpenny, and G. Hoffmann, “Stanley: The robot that won the DARPA Grand Challenge,” J. of Field Robotics, Vol.23, pp. 661-692, 2006. https://doi.org/10.1002/rob.20147
24. [24] A. Abdelmoneim, A. Osama, M. Abdelaziz, and S. Maged, “A path-tracking algorithm using predictive Stanley lateral controller,” Int. J. of Advanced Robotic Systems, Vol.17, No.6, 2020. https://doi.org/10.1177/1729881420974852
25. [25] J. Liu, Z. Yang, Z. Huang, W. Li, S. Dang, and H. Li, “Simulation performance evaluation of pure pursuit, stanley, lqr, mpc controller for autonomous vehicles,” 2021 IEEE Int. Conf. on Real-time Computing and Robotics (RCAR), pp. 1444-1449, 2021. https://doi.org/10.1109/RCAR52367.2021.9517448
26. [26] H. Shimizu, K. Takanezawa, N. Takesue, J. Hiruma, and J. Mikado, “Proposal of robot with independent four-wheel steering capable of overcoming steps using link mechanism,” Proc. of the 23rd SICE System Integration Division Annual Conf. (SI), Vol.23, pp. 2A2-B14, 2022 (in Japanese).
27. [27] R. Ozaki, K. Takanezawa, N. Takesue, J. Hiruma, and J. Mikado, “Detecting and overcoming step by wheeled mobile robot with step overcoming mechanism,” Proc. of the 2024 JSME Annual Conf. on Robotics and Mechatronics (ROBOMECH), Article No.1A1-L05, 2024 (in Japanese).
28. [28] H. Shimizu, K. Takanezawa, N. Takesue, J. Hiruma, and J. Mikado, “Wheeled mobile robot with step-overcoming function using link mechanism,” Proc. of the 9th KSME/JSME Int. Conf. on Manufacturing, Machine Design and Tribology (ICMDT2023), Article No.rPS-18, 2023.
29. [29] K. Tadakuma, “Omnidirectional mobile and driving mechanism,” J. of the Robotics Society of Japan, Vol.29, No.6, pp. 516-519, 2011 (in Japanese). https://doi.org/10.7210/jrsj.29.516
30. [30] K. Tadakuma, “Ingenious mechanisms for omnidirectional mobile and driving,” J. of the Robotics Society of Japan, Vol.32, No.4, pp. 354-357, 2014 (in Japanese). https://doi.org/10.7210/jrsj.32.354
31. [31] N. Yamada, H. Komura, G. Endo, H. Nabae, and K. Suzumori, “Spiral mecanum wheel achieving omnidirectional locomotion in step-climbing,” 2017 IEEE Int. Conf. on Advanced Intelligent Mechatronics (AIM), pp. 1285-1290, 2017. https://doi.org/10.1109/AIM.2017.8014195
32. [32] K. Kanjanawanishkul, “Omnidirectional wheeled mobile robots: Wheel types and practical applications,” Int. J. of Advanced Mechatronic Systems, Vol.6, No.6, pp. 289-302, 2015. https://doi.org/10.1504/IJAMECHS.2015.074788
33. [33] L. Tagliavini, A. Botta, G. Colucci, L. Baglieri, S. Duretto, and G. Quaglia, “Kinematic modelling of swerve-drive-based mobile robots,” Proc. of the 7th Jc-IFToMM Int. Symp. in conjunction with the 30th Jc-IFToMM Symp. on Theory of Machines and Mechanisms, Vol.7, pp. 225-231, 2024. https://doi.org/10.57272/jciftomm.7.0_225
34. [34] J. C. Léger, “Menger curvature and rectifiability,” Annals of Mathematics, Vol.149, No.3, p. 831-869, 1999. https://doi.org/10.2307/121074
35. [35] T. Shan, B. Englot, D. Meyers, W. Wang, C. Ratti, and D. Rus, “LIO-SAM: Tightly-coupled Lidar inertial odometry via smoothing and mapping,” Proc. of the 2020 IEEE/RSJ Int. Conf. on Intelligent Robots and Systems (IROS), pp. 5135-5142, 2020. https://doi.org/10.1109/IROS45743.2020.9341176
36. [36] H. M. Park, Y. T. Kim, and J. Y. Choi, “Full scale simulation of road collapse using accelerated pavement testing,” Proc. of the 11th Int. Conf. on Geosynthetics (ICG), 2018.
37. [37] T. Eiter and H. Mannila, “Computing discrete Fréchet distance,” Christian Doppler Laboratory for Expert Systems, Vienna University of Technology, Tech. Rep. CD-TR 94/64, 1994.
38. [38] Y. Tao, A. Both, R. I. Silveira, K. Buchin, S. Sijben, R. Purves, P. Laube, D. Peng, K. Toohey, and M. Duckham, “A comparative analysis of trajectory similarity measures,” GIScience & Remote Sensing, Vol.58, No.5, pp. 643-669, 2021. https://doi.org/10.1080/15481603.2021.1908927
39. [39] C. Hu, Y. Ru, X. Li, S. Fang, H. Zhou, X. Yan, M. Liu, and R. Xie, “Path tracking control for brake-steering tracked vehicles based on an improved pure pursuit algorithm,” Biosystems Engineering, Vol.242, No.2, pp. 1-15, 2024. https://doi.org/10.1016/j.biosystemseng.2024.04.006
40. [40] H. Alt and M. Godau, “Computing the Fréchet distance between two polygonal curves,” Int. J. of Computational Geometry & Applications, Vol.5, Nos.1-2, pp. 75-91, 1995. https://doi.org/10.1142/S0218195995000064