Skip to main content
Top
Published in: Autonomous Robots 6/2019

08-10-2018

Anticipative kinodynamic planning: multi-objective robot navigation in urban and dynamic environments

Authors: Gonzalo Ferrer, Alberto Sanfeliu

Published in: Autonomous Robots | Issue 6/2019

Log in

Activate our intelligent search to find suitable subject content or patents.

search-config
loading …

Abstract

This paper presents the anticipative kinodynamic planning (AKP) approach for robot navigation in urban environments, while satisfying both dynamic and nonholonomic constraints. Our main motivation is to minimize the impact that the robot is doing to the environment, i.e. other pedestrians, while successfully achieving a navigation goal. To this end, we require a better understanding of the environment, and thus, we propose to integrate seamlessly a human motion prediction algorithm into the planning algorithm. In addition, we are able to anticipate for each of the robot’s calculated paths or actions the corresponding people’s future trajectories, which is essential to reduce the impact to nearby pedestrians. Multi-objective cost functions are proposed and we describe a well-posed procedure to build joint cost functions. Plenty of simulations and real experiments have been carried out to demonstrate the success of the AKP, compared to other navigation approaches.

Dont have a licence yet? Then find out more about our products and how to get one now:

Springer Professional "Wirtschaft+Technik"

Online-Abonnement

Mit Springer Professional "Wirtschaft+Technik" erhalten Sie Zugriff auf:

  • über 102.000 Bücher
  • über 537 Zeitschriften

aus folgenden Fachgebieten:

  • Automobil + Motoren
  • Bauwesen + Immobilien
  • Business IT + Informatik
  • Elektrotechnik + Elektronik
  • Energie + Nachhaltigkeit
  • Finance + Banking
  • Management + Führung
  • Marketing + Vertrieb
  • Maschinenbau + Werkstoffe
  • Versicherung + Risiko

Jetzt Wissensvorsprung sichern!

Springer Professional "Technik"

Online-Abonnement

Mit Springer Professional "Technik" erhalten Sie Zugriff auf:

  • über 67.000 Bücher
  • über 390 Zeitschriften

aus folgenden Fachgebieten:

  • Automobil + Motoren
  • Bauwesen + Immobilien
  • Business IT + Informatik
  • Elektrotechnik + Elektronik
  • Energie + Nachhaltigkeit
  • Maschinenbau + Werkstoffe




 

Jetzt Wissensvorsprung sichern!

Literature
go back to reference Arechavaleta, G., Laumond, J.-P., Hicheur, H., & Berthoz, A. (2008). An optimality principle governing human walking. IEEE Transactions on Robotics, 24(1), 5–14.CrossRef Arechavaleta, G., Laumond, J.-P., Hicheur, H., & Berthoz, A. (2008). An optimality principle governing human walking. IEEE Transactions on Robotics, 24(1), 5–14.CrossRef
go back to reference Bahram, M., Wolf, A., Aeberhard, M., & Wollherr, D. (2014). A prediction-based reactive driving strategy for highly automated driving function on freeways. In Intelligent vehicles symposium (pp. 400–406). IEEE. Bahram, M., Wolf, A., Aeberhard, M., & Wollherr, D. (2014). A prediction-based reactive driving strategy for highly automated driving function on freeways. In Intelligent vehicles symposium (pp. 400–406). IEEE.
go back to reference Barraquand, J., & Latombe, J.-C. (1991). Robot motion planning: A distributed representation approach. The International Journal of Robotics Research, 10(6), 628–649.CrossRef Barraquand, J., & Latombe, J.-C. (1991). Robot motion planning: A distributed representation approach. The International Journal of Robotics Research, 10(6), 628–649.CrossRef
go back to reference Bennewitz, M., Burgard, W., Cielniak, G., & Thrun, S. (2005). Learning motion patterns of people for compliant robot motion. The International Journal of Robotics Research, 24(1), 31–48.CrossRef Bennewitz, M., Burgard, W., Cielniak, G., & Thrun, S. (2005). Learning motion patterns of people for compliant robot motion. The International Journal of Robotics Research, 24(1), 31–48.CrossRef
go back to reference Brock, O., & Khatib, O. (1999). High-speed navigation using the global dynamic window approach. In Proceedings of the IEEE international conference on robotics and automation (Vol. 1, pp. 341–346). Brock, O., & Khatib, O. (1999). High-speed navigation using the global dynamic window approach. In Proceedings of the IEEE international conference on robotics and automation (Vol. 1, pp. 341–346).
go back to reference Chen, Y. F., Liu, M., Everett, M., & How, J. P. (2017). Decentralized non-communicating multiagent collision avoidance with deep reinforcement learning. In Proceedings of the IEEE international conference on robotics and automation (pp. 285–292). IEEE. Chen, Y. F., Liu, M., Everett, M., & How, J. P. (2017). Decentralized non-communicating multiagent collision avoidance with deep reinforcement learning. In Proceedings of the IEEE international conference on robotics and automation (pp. 285–292). IEEE.
go back to reference Deb, K. (2014). Multi-objective optimization. Search methodologies (pp. 403–449). New York: Springer. Deb, K. (2014). Multi-objective optimization. Search methodologies (pp. 403–449). New York: Springer.
go back to reference Ferrer, G., Garrell, A., Herrero, F., & Sanfeliu, A. (2017). Robot social-aware navigation framework to accompany people walking side-by-side. Autonomous Robots, 41(4), 775–793. Ferrer, G., Garrell, A., Herrero, F., & Sanfeliu, A. (2017). Robot social-aware navigation framework to accompany people walking side-by-side. Autonomous Robots, 41(4), 775–793.
go back to reference Ferrer, G., Garrell, A., & Sanfeliu, A. (2013). Social-aware robot navigation in urban environments. In European conference on mobile robotics, ECMR (pp. 331–336). Ferrer, G., Garrell, A., & Sanfeliu, A. (2013). Social-aware robot navigation in urban environments. In European conference on mobile robotics, ECMR (pp. 331–336).
go back to reference Ferrer, G., & Sanfeliu, A. (2014a). Behavior estimation for a complete framework of human motion prediction in crowded environments. In Proceedings of the IEEE international conference on robotics and automation (pp. 5940–5945). Ferrer, G., & Sanfeliu, A. (2014a). Behavior estimation for a complete framework of human motion prediction in crowded environments. In Proceedings of the IEEE international conference on robotics and automation (pp. 5940–5945).
go back to reference Ferrer, G., & Sanfeliu, A. (2014b). Proactive kinodynamic planning using the extended social force model and human motion prediction in urban environments. In Proceedings of the IEEE/RSJ international conference on intelligent robots and systems (pp. 1730–1735). Ferrer, G., & Sanfeliu, A. (2014b). Proactive kinodynamic planning using the extended social force model and human motion prediction in urban environments. In Proceedings of the IEEE/RSJ international conference on intelligent robots and systems (pp. 1730–1735).
go back to reference Ferrer, G., & Sanfeliu, A. (2014c). Bayesian human motion intentionality prediction in urban environments. Pattern Recognition Letters, 44, 134–140.CrossRef Ferrer, G., & Sanfeliu, A. (2014c). Bayesian human motion intentionality prediction in urban environments. Pattern Recognition Letters, 44, 134–140.CrossRef
go back to reference Ferrer, G., & Sanfeliu, A. (2015). Multi-objective cost-to-go functions on robot navigation in dynamic environments. In Proceedings of the IEEE/RSJ international conference on intelligent robots and systems (pp. 3824–3829). Ferrer, G., & Sanfeliu, A. (2015). Multi-objective cost-to-go functions on robot navigation in dynamic environments. In Proceedings of the IEEE/RSJ international conference on intelligent robots and systems (pp. 3824–3829).
go back to reference Foka, A., & Trahanias, P. (2010). Probabilistic autonomous robot navigation in dynamic environments with human motion prediction. International Journal of Social Robotics, 2(1), 79–94.CrossRef Foka, A., & Trahanias, P. (2010). Probabilistic autonomous robot navigation in dynamic environments with human motion prediction. International Journal of Social Robotics, 2(1), 79–94.CrossRef
go back to reference Fox, D., Burgard, W., & Thrun, S. (1997). The dynamic window approach to collision avoidance. Robotics & Automation Magazine, 4(1), 23–33.CrossRef Fox, D., Burgard, W., & Thrun, S. (1997). The dynamic window approach to collision avoidance. Robotics & Automation Magazine, 4(1), 23–33.CrossRef
go back to reference Fulgenzi, C., Spalanzani, A., & Laugier, C. (2009). Probabilistic motion planning among moving obstacles following typical motion patterns. In Proceedings of the IEEE/RSJ international conference on intelligent robots and systems (pp. 4027–4033). IEEE. Fulgenzi, C., Spalanzani, A., & Laugier, C. (2009). Probabilistic motion planning among moving obstacles following typical motion patterns. In Proceedings of the IEEE/RSJ international conference on intelligent robots and systems (pp. 4027–4033). IEEE.
go back to reference Gindele, T., Brechtel, S., Schroder, J., & Dillmann, R. (2009). Bayesian occupancy grid filter for dynamic environments using prior map knowledge. In Intelligent vehicles symposium (pp. 669–676). IEEE. Gindele, T., Brechtel, S., Schroder, J., & Dillmann, R. (2009). Bayesian occupancy grid filter for dynamic environments using prior map knowledge. In Intelligent vehicles symposium (pp. 669–676). IEEE.
go back to reference Glassman, E., & Tedrake, R. (2010). A quadratic regulator-based heuristic for rapidly exploring state space. In Proceedings of the IEEE international conference on robotics and automation (pp. 5021–5028). IEEE. Glassman, E., & Tedrake, R. (2010). A quadratic regulator-based heuristic for rapidly exploring state space. In Proceedings of the IEEE international conference on robotics and automation (pp. 5021–5028). IEEE.
go back to reference Helbing, D., & Molnár, P. (1995). Social force model for pedestrian dynamics. Physical Review E, 51(5), 4282.CrossRef Helbing, D., & Molnár, P. (1995). Social force model for pedestrian dynamics. Physical Review E, 51(5), 4282.CrossRef
go back to reference Hsu, D., Kindel, R., Latombe, J.-C., & Rock, S. (2002). Randomized kinodynamic motion planning with moving obstacles. The International Journal of Robotics Research, 21(3), 233–255.CrossRefMATH Hsu, D., Kindel, R., Latombe, J.-C., & Rock, S. (2002). Randomized kinodynamic motion planning with moving obstacles. The International Journal of Robotics Research, 21(3), 233–255.CrossRefMATH
go back to reference Khatib, O. (1986). Real-time obstacle avoidance for manipulators and mobile robots. The International Journal of Robotics Research, 5(1), 90–98.CrossRef Khatib, O. (1986). Real-time obstacle avoidance for manipulators and mobile robots. The International Journal of Robotics Research, 5(1), 90–98.CrossRef
go back to reference Kim, E., Choi, S., & Oh, S. (2015). Structured low-rank matrix approximation in Gaussian process regression for autonomous robot navigation. In Proceedings IEEE international conference on robotics and automation (pp. 69–74). IEEE. Kim, E., Choi, S., & Oh, S. (2015). Structured low-rank matrix approximation in Gaussian process regression for autonomous robot navigation. In Proceedings IEEE international conference on robotics and automation (pp. 69–74). IEEE.
go back to reference Koren, Y., & Borenstein, J. (1991). Potential field methods and their inherent limitations for mobile robot navigation. In Proceedings IEEE international conference on robotics and automation (pp. 1398–1404). IEEE. Koren, Y., & Borenstein, J. (1991). Potential field methods and their inherent limitations for mobile robot navigation. In Proceedings IEEE international conference on robotics and automation (pp. 1398–1404). IEEE.
go back to reference Kretzschmar, H., Spies, M., Sprunk, C., & Burgard, W. (2016). Socially compliant mobile robot navigation via inverse reinforcement learning. The International Journal of Robotics Research, 35(11), 1289–1307.CrossRef Kretzschmar, H., Spies, M., Sprunk, C., & Burgard, W. (2016). Socially compliant mobile robot navigation via inverse reinforcement learning. The International Journal of Robotics Research, 35(11), 1289–1307.CrossRef
go back to reference Kuderer, M., Sprunk, C., Kretzschmar, H., & Burgard, W. (2014). Online generation of homotopically distinct navigation paths. In Proceedings of the IEEE international conference on robotics and automation (pp. 6462–6467). Kuderer, M., Sprunk, C., Kretzschmar, H., & Burgard, W. (2014). Online generation of homotopically distinct navigation paths. In Proceedings of the IEEE international conference on robotics and automation (pp. 6462–6467).
go back to reference Kunz, B., & Stilman, M. (2014). Probabilistically complete kinodynamic planning for robot manipulators with acceleration limits. In Proceedings of the IEEE/RSJ international conference on intelligent robots and systems (pp. 3713–3719). Kunz, B., & Stilman, M. (2014). Probabilistically complete kinodynamic planning for robot manipulators with acceleration limits. In Proceedings of the IEEE/RSJ international conference on intelligent robots and systems (pp. 3713–3719).
go back to reference LaValle, S. M., & Kuffner, J. J. (2001). Randomized kinodynamic planning. The International Journal of Robotics Research, 20(5), 378–400.CrossRef LaValle, S. M., & Kuffner, J. J. (2001). Randomized kinodynamic planning. The International Journal of Robotics Research, 20(5), 378–400.CrossRef
go back to reference Luber, M., Spinello, L., Silva, J., & Arras, K. O. (2012). Socially-aware robot navigation: A learning approach. In Proceedings of the IEEE/RSJ international conference on intelligent robots and systems (pp. 902–907). Luber, M., Spinello, L., Silva, J., & Arras, K. O. (2012). Socially-aware robot navigation: A learning approach. In Proceedings of the IEEE/RSJ international conference on intelligent robots and systems (pp. 902–907).
go back to reference Marler, R. T., & Arora, J. S. (2004). Survey of multi-objective optimization methods for engineering. Structural and Multidisciplinary Optimization, 26(6), 369–395.MathSciNetCrossRefMATH Marler, R. T., & Arora, J. S. (2004). Survey of multi-objective optimization methods for engineering. Structural and Multidisciplinary Optimization, 26(6), 369–395.MathSciNetCrossRefMATH
go back to reference Moussaïd, M., Helbing, D., & Theraulaz, G. (2011). How simple rules determine pedestrian behavior and crowd disasters. Proceedings of the National Academy of Sciences, 108(17), 6884–6888.CrossRef Moussaïd, M., Helbing, D., & Theraulaz, G. (2011). How simple rules determine pedestrian behavior and crowd disasters. Proceedings of the National Academy of Sciences, 108(17), 6884–6888.CrossRef
go back to reference Perez, A., Platt, R., Konidaris, G., Kaelbling, L., & Lozano-Perez, T. (2012). LQR-RRT*: Optimal sampling-based motion planning with automatically derived extension heuristics. In Proceedings of the IEEE international conference on robotics and automation (pp. 2537–2542). IEEE. Perez, A., Platt, R., Konidaris, G., Kaelbling, L., & Lozano-Perez, T. (2012). LQR-RRT*: Optimal sampling-based motion planning with automatically derived extension heuristics. In Proceedings of the IEEE international conference on robotics and automation (pp. 2537–2542). IEEE.
go back to reference Roijers, D. M., Vamplew, P., Whiteson, S., & Dazeley, R. (2013). A survey of multi-objective sequential decision-making. Journal of Artificial Intelligence Research, 48, 67–113.MathSciNetCrossRefMATH Roijers, D. M., Vamplew, P., Whiteson, S., & Dazeley, R. (2013). A survey of multi-objective sequential decision-making. Journal of Artificial Intelligence Research, 48, 67–113.MathSciNetCrossRefMATH
go back to reference Simmons, R. (1996). The curvature-velocity method for local obstacle avoidance. In Proceedings of the IEEE international conference on robotics and automation (Vol. 4, pp. 3375–3382). Simmons, R. (1996). The curvature-velocity method for local obstacle avoidance. In Proceedings of the IEEE international conference on robotics and automation (Vol. 4, pp. 3375–3382).
go back to reference Sisbot, E. A., Marin-Urias, L. F., Alami, R., & Simeon, T. (2007). A human aware mobile robot motion planner. IEEE Transactions on Robotics, 23(5), 874–883.CrossRef Sisbot, E. A., Marin-Urias, L. F., Alami, R., & Simeon, T. (2007). A human aware mobile robot motion planner. IEEE Transactions on Robotics, 23(5), 874–883.CrossRef
go back to reference Stachniss, C. & Burgard, W. (2002). An integrated approach to goal-directed obstacle avoidance under dynamic constraints for dynamic environments. In Proceedings of the IEEE/RSJ international conference on intelligent robots and systems (pp. 508–513). Stachniss, C. & Burgard, W. (2002). An integrated approach to goal-directed obstacle avoidance under dynamic constraints for dynamic environments. In Proceedings of the IEEE/RSJ international conference on intelligent robots and systems (pp. 508–513).
go back to reference Svenstrup, M., Bak, T., & Andersen, H. J. (2010). Trajectory planning for robots in dynamic human environments. In Proceedings of the IEEE/RSJ international conference on intelligent robots and systems (pp. 4293–4298). Svenstrup, M., Bak, T., & Andersen, H. J. (2010). Trajectory planning for robots in dynamic human environments. In Proceedings of the IEEE/RSJ international conference on intelligent robots and systems (pp. 4293–4298).
go back to reference Trautman, P., Ma, J., Murray, R. M., & Krause, A. (2013). Robot navigation in dense human crowds: The case for cooperation. In Proceedings of the IEEE international conference on robotics and automation (pp. 2145–2152). Trautman, P., Ma, J., Murray, R. M., & Krause, A. (2013). Robot navigation in dense human crowds: The case for cooperation. In Proceedings of the IEEE international conference on robotics and automation (pp. 2145–2152).
go back to reference Van den Berg, J., Lin, M., & Manocha, D. (2008). Reciprocal velocity obstacles for real-time multi-agent navigation. In Proceedings of the IEEE international conference on robotics and automation (pp. 1928–1935). IEEE. Van den Berg, J., Lin, M., & Manocha, D. (2008). Reciprocal velocity obstacles for real-time multi-agent navigation. In Proceedings of the IEEE international conference on robotics and automation (pp. 1928–1935). IEEE.
go back to reference Vasquez, D. (2016). Novel planning-based algorithms for human motion prediction. In IEEE conference on robotics and automation. Vasquez, D. (2016). Novel planning-based algorithms for human motion prediction. In IEEE conference on robotics and automation.
go back to reference Zanlungo, F., Ikeda, T., & Kanda, T. (2011). Social force model with explicit collision prediction. EPL (Europhysics Letters), 93(6), 68005.CrossRef Zanlungo, F., Ikeda, T., & Kanda, T. (2011). Social force model with explicit collision prediction. EPL (Europhysics Letters), 93(6), 68005.CrossRef
go back to reference Ziebart, B., Ratliff, N., Gallagher, G., Mertz, C., Peterson, K., Bagnell, J., Hebert, M., Dey, A., & Srinivasa, S. (2009). Planning-based prediction for pedestrians. In Proceedings of the IEEE/RSJ international conference on intelligent robots and systems (pp. 3931–3936). Ziebart, B., Ratliff, N., Gallagher, G., Mertz, C., Peterson, K., Bagnell, J., Hebert, M., Dey, A., & Srinivasa, S. (2009). Planning-based prediction for pedestrians. In Proceedings of the IEEE/RSJ international conference on intelligent robots and systems (pp. 3931–3936).
Metadata
Title
Anticipative kinodynamic planning: multi-objective robot navigation in urban and dynamic environments
Authors
Gonzalo Ferrer
Alberto Sanfeliu
Publication date
08-10-2018
Publisher
Springer US
Published in
Autonomous Robots / Issue 6/2019
Print ISSN: 0929-5593
Electronic ISSN: 1573-7527
DOI
https://doi.org/10.1007/s10514-018-9806-6

Other articles of this Issue 6/2019

Autonomous Robots 6/2019 Go to the issue