Continuous Motion Planning for Service Robots with Multiresolution in Time

  • Ricarda Steffens
  • Matthias Nieuwenhuisen
  • Sven Behnke
Conference paper
Part of the Advances in Intelligent Systems and Computing book series (AISC, volume 302)


We present an approach to continuous motion planning with multiresolution in time. Our approach is based on stochastic trajectory optimization for motion planning (STOMP) and designed to decrease the optimization time in order to enable frequent replanning. Since service robots operate in environments with dynamic obstacles, it is likely that planned trajectories become invalid over time. Thus, it is not necessary to provide trajectories with a uniform high resolution. Our multiresolutional approach implicitly considers the uncertainty of the future by providing a trajectory with a gradually coarser schedule, which is refined trough replanning. In addition to employing temporal multiresolution, we speed up trajectory optimization by initializing replanning with the previous plan. The proposed multiresolution STOMP is evaluated in simulation in comparison to the original STOMP implementation. Our experiments show that multiresolution STOMP reduces the planning time and, hence, is able to avoid dynamic obstacles.


Motion planning Service robots Multiresolution 


  1. 1.
    Kalakrishnan, M., Chitta, S., Theodorou, E., Pastor, P., Schaal, S.: STOMP: Stochastic trajectory optimization for motion planning. In: Proc. of IEEE Int. Conf. on Robotics and Automation (ICRA). (2011)Google Scholar
  2. 2.
    Chitta, S., Jones, E.G., Ciocarlie, M.T., Hsiao, K.: Mobile manipulation in unstructured environments: Perception, planning, and execution. IEEE Robotics & Automation Magazine 19(2) (2012) 58–71Google Scholar
  3. 3.
    Şucan, I.A., Moll, M., Kavraki, L.E.: The Open Motion Planning Library. IEEE Robotics & Automation Magazine 19(4) (2012) 72–82Google Scholar
  4. 4.
    Şucan, I.A., Kavraki, L.E.: Kinodynamic motion planning by interior-exterior cell exploration. In: Algorithmic Foundation of Robotics VIII, Int. Workshop on the Algorithmic Foundations of Robotics (WAFR). Volume 57 of Springer Tracts in Advanced Robotics., Springer (2008) 449–464Google Scholar
  5. 5.
    Ratliff, N.D., Zucker, M., Bagnell, J.A., Srinivasa, S.: CHOMP: Gradient optimization techniques for efficient motion planning. In: Proc. of IEEE Int. Conf. on Robotics and Automation (ICRA). (2009)Google Scholar
  6. 6.
    Park, C., Pan, J., Manocha, D.: ITOMP: Incremental trajectory optimization for real-time replanning in dynamic environments. In: ICAPS, AAAI (2012)Google Scholar
  7. 7.
    Brock, O., Khatib, O.: Elastic strips: A framework for motion generation in human environments. The Int. Journal of Robotic Research 21(12) (2002) 1031–1052Google Scholar
  8. 8.
    Dietrich, A., Wimböck, T., Albu-Schäffer, A., Hirzinger, G.: Reactive whole-body control: Dynamic mobile manipulation using a large number of actuated degrees of freedom. IEEE Robotics & Automation Magazine 19(2) (2012) 20–33Google Scholar
  9. 9.
    Behnke, S.: Local multiresolution path planning. In: RoboCup 2003: Robot Soccer World Cup VII. Volume 3020 of LNCS., Springer (2004) 332–343Google Scholar
  10. 10.
    He, K., Martin, E., Zucker, M.: Multigrid CHOMP with local smoothing. In: Proc. of 13th IEEE-RAS Int. Conference on Humanoid Robots (Humanoids). (2013)Google Scholar
  11. 11.
    Stückler, J., Behnke, S.: Integrating indoor mobility, object manipulation, and intuitive interaction for domestic service tasks. In: Proceedings of 9th IEEE-RAS International Conference on Humanoid Robots (Humanoids). 506–513Google Scholar
  12. 12.
    Nieuwenhuisen, M., Droeschel, D., Holz, D., Stückler, J., Berner, A., Li, J., Klein, R., Behnke, S.: Mobile bin picking with an anthropomorphic service robot. In: Proc. of IEEE Int. Conf. on Robotics and Automation (ICRA). (2013)Google Scholar
  13. 13.
    Fornberg, B.: Generation of finite difference formulas on arbitrarily spaced grids. Mathematics of computation 51(184) (1988) 699–706Google Scholar

Copyright information

© Springer International Publishing Switzerland 2016

Authors and Affiliations

  • Ricarda Steffens
    • 1
  • Matthias Nieuwenhuisen
    • 1
  • Sven Behnke
    • 1
  1. 1.Autonomous Intelligent Systems GroupInstitute for Computer Science VI, University of BonnBonnGermany

Personalised recommendations