Combining Safe Interval Path Planning and Constrained Path Following Control: Preliminary Results
We study the navigation problem for a robot moving amidst static and dynamic obstacles and rely on a hierarchical approach to solve it. First, the reference trajectory is planned by the safe interval path planning algorithm that is capable of handling any-angle translations and rotations. Second, the path following problem is treated as the constrained control problem and the original flatness-based approach is proposed to generate control. We suggest a few enhancements for the path planning algorithm aimed at finding trajectories that are more likely to be followed by a robot without collisions. Results of the conducted experimental evaluation show that the number of successfully solved navigation instances significantly increases when using the suggested techniques.
KeywordsPath planning Path finding AA-SIPP Differentially flat systems Point-to-point control problem
This work was partially supported by RFBR Grant no. 18-37-20032 and by the “RUDN University Program 5-100”.
- 1.Belinskaya, Y.S., Chetverikov, V.N.: Control of four-rotor helicopter. Sci. Educ. (BMSTU. Electr. J.) 5, 157–171 (2012). (in Russian)Google Scholar
- 2.Bokovoy, A.V., Fomin, M.B., Yakovlev, K.S.: Implementation of the pathfinding system for autonomous navigation of mobile ground robot. In: CEUR, vol. 2236, pp. 72–78. http://ceur-ws.org/Vol-2236/paper-09-009.pdf
- 9.Magid, E., Rivlin, E.: Cautiousbug: a competitive algorithm for sensory-based robot navigation. In: 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2004), vol. 3, pp. 2757–2762 (2004)Google Scholar
- 11.Nieuwenhuisen, M., Behnke, S.: Local multiresolution trajectory optimization for micro aerial vehicles employing continuous curvature transitions. In: Proceedings of the 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS-2016), pp. 3219–3224. IEEE (2016)Google Scholar
- 12.Phillips, M., Likhachev, M.: SIPP: safe interval path planning for dynamic environments. In: Proceedings of the 2011 IEEE International Conference on Robotics and Automation (ICRA-2011), pp. 5628–5635 (2011)Google Scholar
- 13.Sahoo, S.R., Chiddarwar, S.S.: Mobile robot control using bond graph and flatness based approach. Int. Conf. Robot. Smart Manuf. (RoSMa2018) 133, 213–221 (2018)Google Scholar
- 16.Wooden, D.T.: Graph-based path planning for mobile robots. Ph.D. thesis, Georgia Institute of Technology (2006)Google Scholar
- 17.Yakovlev, K., Andreychuk, A.: Any-angle pathfinding for multiple agents based on SIPP algorithm. In: Proceedings of the 27th International Conference on Automated Planning and Scheduling (ICAPS-2017), pp. 586–593 (2017)Google Scholar