RACK-AWARE, PAYLOAD-AWARE LOCAL PATH PLANNING ALGORITHM FOR WAREHOUSE ROBOTS IN MULTI-ROBOT, HUMAN-SHARED ENVIRONMENTS
DOI:
https://doi.org/10.5281/zenodo.23888843Abstract
The paper addresses local path planning for autonomous mobile robots that carry loads in a warehouse shared by people and several robots. A planar LiDAR mounted close to the floor observes only the legs of a load-carrying rack, so the costmap marks the space beneath the rack as free and a loaded robot may strike the deck. We propose the RAP method (Rack-Aware, Payload-aware Planning): a two-channel convolutional neural network separates rack legs from people and other robots, the rack pose is recovered from two to four legs by a Procrustes estimator, confirmed with a depth camera, a 3D LiDAR or a monocular camera, and projected into the costmap as a load-carrying volume with a certified safety margin. Depending on the payload height, the robot either passes under the rack or goes around it. The estimator is proved to attain the Cramér–Rao bound, and all theoretical results are verified numerically. In 640 paired episodes RAP achieved 95.0 % success with 1.9 % safety violations, and in Gazebo/ROS 2 experiments the loaded robot never struck a rack deck.Keywords
warehouse robots, local path planning, load-carrying rack, LiDAR, depth camera, convolutional neural network, ROS 2, GazeboReferences
1. Fragapane, G., de Koster, R., Sgarbossa, F., & Strandhagen, J. O. (2021). Planning and control of autonomous mobile robots for intralogistics: Literature review and research agenda. European Journal of Operational Research, 294(2), 405–426.
2. Elfes, A. (1989). Using occupancy grids for mobile robot perception and navigation. Computer, 22(6), 46–57.
3. Marder-Eppstein, E., Berger, E., Foote, T., Gerkey, B., & Konolige, K. (2010). The office marathon: Robust navigation in an indoor office environment. In Proceedings of the IEEE International Conference on Robotics and Automation (pp. 300–307).
4. Lu, D. V., Hershberger, D., & Smart, W. D. (2014). Layered costmaps for context-sensitive navigation. In Proceedings of the IEEE/RSJ International Conference on Intelligent Robots and Systems (pp. 709–715).
5. Macenski, S., Martín, F., White, R., & Ginés Clavero, J. (2020). The Marathon 2: A navigation system. In Proceedings of the IEEE/RSJ International Conference on Intelligent Robots and Systems (pp. 2718–2725).
6. Al-Tawil, B., Candemir, A., Jung, M., & Al-Hamadi, A. (2025). Mobile robot navigation with enhanced 2D mapping and multi-sensor fusion. Sensors, 25(8), 2408.
7. Nobile, L., Randazzo, M., Colledanchise, M., Monorchio, L., Villa, W., Puja, F., & Natale, L. (2021). Active exploration for obstacle detection on a mobile humanoid robot. Actuators, 10(9), 205.
8. Macenski, S., Moore, T., Lu, D. V., Merzlyakov, A., & Ferguson, M. (2023). From the desks of ROS maintainers: A survey of modern & capable mobile robotics algorithms in the robot operating system 2. Robotics and Autonomous Systems, 168, 104493.
9. Fox, D., Burgard, W., & Thrun, S. (1997). The dynamic window approach to collision avoidance. IEEE Robotics & Automation Magazine, 4(1), 23–33.
10. Williams, G., Drews, P., Goldfain, B., Rehg, J. M., & Theodorou, E. A. (2018). Information-theoretic model predictive control: Theory and applications to autonomous driving. IEEE Transactions on Robotics, 34(6), 1603–1622.
11. Hornung, A., Wurm, K. M., Bennewitz, M., Stachniss, C., & Burgard, W. (2013). OctoMap: An efficient probabilistic 3D mapping framework based on octrees. Autonomous Robots, 34(3), 189–206.
12. Zhao, Y., Li, X., Lu, W., & Hu, L. (2024). A method for autonomous shelf recognition and docking of mobile robots based on 2D LiDAR. In C. Chen (Ed.), Artificial Intelligence Technologies and Applications (pp. 104–112). IOS Press.
13. Hong, S., & Park, D. (2024). ML-based fast and precise embedded rack detection software for docking and transport of autonomous mobile robots using 2-D LiDAR. IEEE Embedded Systems Letters, 16(4), 401–404.
14. Arras, K. O., Martínez Mozos, Ó., & Burgard, W. (2007). Using boosted features for the detection of people in 2D range data. In Proceedings of the IEEE International Conference on Robotics and Automation (pp. 3402–3407).
15. Beyer, L., Hermans, A., & Leibe, B. (2017). DROW: Real-time deep learning-based wheelchair detection in 2-D range data. IEEE Robotics and Automation Letters, 2(2), 585–592.
16. Guerrero-Higueras, Á. M., Álvarez-Aparicio, C., Calvo Olivera, M. C., Rodríguez-Lera, F. J., Fernández-Llamas, C., Martín Rico, F., & Matellán, V. (2019). Tracking people in a mobile robot from 2D LIDAR scans using full convolutional neural networks for security in cluttered environments. Frontiers in Neurorobotics, 12, 85.
17. Kruse, T., Pandey, A. K., Alami, R., & Kirsch, A. (2013). Human-aware robot navigation: A survey. Robotics and Autonomous Systems, 61(12), 1726–1743.
18. Blackmore, L., Ono, M., & Williams, B. C. (2011). Chance-constrained optimal path planning with obstacles. IEEE Transactions on Robotics, 27(6), 1080–1094.
19. Kozłowski, K., & Pazderski, D. (2004). Modeling and control of a 4-wheel skid-steering mobile robot. International Journal of Applied Mathematics and Computer Science, 14(4), 477–496.
20. Mandow, A., Martínez, J. L., Morales, J., Blanco, J. L., García-Cerezo, A., & González, J. (2007). Experimental kinematics for wheeled skid-steer mobile robots. In Proceedings of the IEEE/RSJ International Conference on Intelligent Robots and Systems (pp. 1222–1227).
21. Umeyama, S. (1991). Least-squares estimation of transformation parameters between two point patterns. IEEE Transactions on Pattern Analysis and Machine Intelligence, 13(4), 376–380.
22. Kay, S. M. (1993). Fundamentals of statistical signal processing: Estimation theory. Prentice Hall.
23. Koenig, N., & Howard, A. (2004). Design and use paradigms for Gazebo, an open-source multi-robot simulator. In Proceedings of the IEEE/RSJ International Conference on Intelligent Robots and Systems (pp. 2149–2154).
24. Macenski, S., Foote, T., Gerkey, B., Lalancette, C., & Woodall, W. (2022). Robot Operating System 2: Design, architecture, and uses in the wild. Science Robotics, 7(66), eabm6074.
25. Wilson, E. B. (1927). Probable inference, the law of succession, and statistical inference. Journal of the American Statistical Association, 22(158), 209–212.
26. McNemar, Q. (1947). Note on the sampling error of the difference between correlated proportions or percentages. Psychometrika, 12(2), 153–157.

