Abstract
Recently, robot planning methods based on Safe Corridors (a series of overlapping convex shapes) showed promising results in fast navigation for micro-aerial vehicles. However, state-of-the art methods for Safe Corridor generation either generate “unsafe” Safe Corridors, or are not generic enough. In this paper we propose a new algorithm for decomposing free 3D space into overlapping convex polyhedra based on a voxel-grid representation of the 3D space. It introduces the concept of “convex grid/inscribed polyhedron” duality that allows for an efficient and safe convex polyhedron generation. We showed that our method generates Safer Corridors than the state-of-the-art with guarantees that no intersection exists between the Safe Corridor and the real world obstacles, while staying within real-time constraints. We also showed that our method outperforms the state-of-the-art in terms of number of constraints per polyhedron and number of polyhedra per Safe Corridor, which translates into faster computation time in the planning/optimization phase.
Similar content being viewed by others
Data availability
No data/material available.
Code availability
Currently no code available. Possible future release.
References
Banerjee, N., Long, X., Du, R., Polido, F., Feng, S., Atkeson, C.G., Gennert, M., Padir, T.: Human-supervised control of the atlas humanoid robot for traversing doors. In: 2015 IEEE-RAS 15th International Conference on Humanoid Robots (Humanoids), pp. 722–729 (2015)
Commons, W.: Polyhedron chamfered 6 edeq (2018). https://upload.wikimedia.org/wikipedia/commons/9/94/Polyhedron_chamfered_6_edeq.png. Accessed 04 Apr 2022
Deits, R., Tedrake, R.: Computing large convex regions of obstacle-free space through semidefinite programming. In: Algorithmic foundations of robotics XI, pp. 109–124. Springer (2015)
Gao, F., Wu, W., Gao, W., Shen, S.: Flying on point clouds: Online trajectory generation and autonomous navigation for quadrotors in cluttered environments. Journal of Field Robotics 36(4), 710–733 (2019)
Gao, F., Wu, W., Lin, Y., Shen, S.: Online safe trajectory generation for quadrotors using fast marching method and bernstein basis polynomial. In: 2018 IEEE International Conference on Robotics and Automation (ICRA), pp. 344–351. IEEE (2018)
Gao, H., Cheng, B., Wang, J., Li, K., Zhao, J., Li, D.: Object classification using cnn-based fusion of vision and lidar in autonomous vehicle environment. IEEE Transactions on Industrial Informatics 14(9), 4224–4231 (2018)
Gao, H., Lv, C., Zhang, T., Zhao, H., Jiang, L., Zhou, J., Liu, Y., Huang, Y., Han, C.: A structure constraint matrix factorization framework for human behavior segmentation. IEEE Transactions on Cybernetics (2021)
Gao, H., Su, H., Cai, Y., Wu, R., Hao, Z., Xu, Y., Wu, W., Wang, J., Li, Z., Kan, Z.: Trajectory prediction of cyclist based on dynamic bayesian network and long short-term memory model at unsignalized intersections. Science China Information Sciences 64(7), 1–13 (2021)
Han, L., Gao, F., Zhou, B., Shen, S.: Fiesta: Fast incremental euclidean distance fields for online motion planning of aerial robots. arXiv:1903.02144 (2019)
Harabor, D.D., Grastien, A.: Online graph pruning for pathfinding on grid maps. In: Twenty-Fifth AAAI Conference on Artificial Intelligence (2011)
Hornung, A., Wurm, K.M., Bennewitz, M., Stachniss, C., Burgard, W.: Octomap: An efficient probabilistic 3d mapping framework based on octrees. Autonomous robots 34(3), 189–206 (2013)
Chen, J., Liu, T., Shen, S.: Online generation of collision-free trajectories for quadrotor flight in unknown cluttered environments. In: 2016 IEEE International Conference on Robotics and Automation (ICRA), pp. 1476–1483 (2016)
Liu, S., Atanasov, N., Mohta, K., Kumar, V.: Search-based motion planning for quadrotors using linear quadratic minimum time control. In: 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 2872–2879. IEEE (2017)
Liu, S., Mohta, K., Atanasov, N., Kumar, V.: Search-based motion planning for aggressive flight in se (3). IEEE Robotics and Automation Letters 3(3), 2439–2446 (2018)
Liu, S., Mohta, K., Atanasov, N., Kumar, V.: Towards search-based motion planning for micro aerial vehicles. arXiv:1810.03071 (2018)
Liu, S., Watterson, M., Mohta, K., Sun, K., Bhattacharya, S., Taylor, C.J., Kumar, V.: Planning dynamically feasible trajectories for quadrotors using safe flight corridors in 3-d complex environments. IEEE Robotics and Automation Letters 2(3), 1688–1695 (2017)
Oleynikova, H., Burri, M., Taylor, Z., Nieto, J., Siegwart, R., Galceran, E.: Continuous-time trajectory optimization for online uav replanning. In: 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 5332–5339. IEEE (2016)
Oleynikova, H., Taylor, Z., Fehr, M., Siegwart, R., Nieto, J.: Voxblox: Incremental 3d euclidean signed distance fields for on-board mav planning. In: 2017 Ieee/rsj International Conference on Intelligent Robots and Systems (iros), pp. 1366–1373. IEEE (2017)
Robotics, K.: Mrsl jump point search planning library v1.1. https://github.com/KumarRobotics/jps3d, Accessed 2020-05-09
Tordesillas, J., Lopez, B.T., Everett, M., How, J.P.: Faster: Fast and safe trajectory planner for flights in unknown environments. arXiv:2001.04420 (2020)
Toumieh, C., Lambert, A.: High-speed planning in unknown environments for multirotors considering drag. In: 2021 IEEE International Conference on Robotics and Automation (ICRA), pp. 7844–7850 (2021). https://doi.org/10.1109/ICRA48506.2021.9560773
Toumieh, C., Lambert, A.: Gpu accelerated voxel grid generation for fast mav exploration (2022)
Zhou, B., Gao, F., Wang, L., Liu, C., Shen, S.: Robust and efficient quadrotor trajectory generation for fast autonomous flight. IEEE Robotics and Automation Letters 4(4), 3529–3536 (2019)
Funding
This work was funded by the doctoral school Sciences and Technologies of Information and Communication at Université Paris-Saclay.
Author information
Authors and Affiliations
Contributions
CT and AL conceived this research. CT wrote the code and did the experiments.
Corresponding author
Ethics declarations
Conflicts of interest
No conflict of interest/competing interests.
Ethics approval
Not applicable.
Consent to participate
Not applicable.
Consent for publication
Not applicable.
Additional information
Publisher's note
Springer Nature remains neutral with regard to jurisdictional claims in published maps and institutional affiliations.
Rights and permissions
Springer Nature or its licensor holds exclusive rights to this article under a publishing agreement with the author(s) or other rightsholder(s); author self-archiving of the accepted manuscript version of this article is solely governed by the terms of such publishing agreement and applicable law.
About this article
Cite this article
Toumieh, C., Lambert, A. Voxel-Grid Based Convex Decomposition of 3D Space for Safe Corridor Generation. J Intell Robot Syst 105, 87 (2022). https://doi.org/10.1007/s10846-022-01708-y
Received:
Accepted:
Published:
DOI: https://doi.org/10.1007/s10846-022-01708-y