Advertisement

Autonomous Robots

, Volume 37, Issue 1, pp 81–96 | Cite as

Detection of robustly collision-free trajectories in unpredictable environments in real-time

  • Rayomand VatchaEmail author
  • Jing Xiao
Article

Abstract

One of the ultimate goals in robotics is to make robots of high degrees of freedom (DOF) work autonomously in real world environments. However, real world environments are unpredictable, i.e., how the objects move are usually not known beforehand. Thus, whether a robot trajectory is collision-free or not has to be checked on-line based on sensing as the robot moves. Moreover, in order to guarantee safe motion, the motion uncertainty of the robot has to be taken into account. This paper introduces a general approach to detect if a high-DOF robot trajectory is continuously collision-free even in the presence of robot motion uncertainty in an unpredictable environment in real time. Our method is based on the novel concept of dynamic envelope, which takes advantage of progressive sensing over time without predicting motions of objects in an environment or assuming specific object motion patterns. The introduced approach can be used by general real-time motion planners to check if a candidate robot trajectory is continuously and robustly collision-free (i.e., in spite of uncertainty in the robot motion).

Keywords

Continuously collision-free trajectory High DOF robot  Unpredictable environment Motion uncertainty 

Notes

Acknowledgments

This work was supported under the U.S. National Science Foundation grant IIS-0742610.

Supplementary material

Supplementary material 1 (WMV 693 KB)

References

  1. Baginski, B. (1997). Efficient dynamic collision detection using expanded geometry models. In IEEE/RSJ international conference on intelligent robots and systems, pp. 1714–1719.Google Scholar
  2. Bennewitz, M., Burgard, W., Cielniak, G., & Thrun, S. (2005). Learning motion patterns of people for compliant robot motion. International Journal of Robotics Research, 24(1), 31–48.CrossRefGoogle Scholar
  3. Brent, R. P. (1971). An algorithm with guaranteed convergence for finding a zero of a function. Computer Journal, 14, 422–425.CrossRefzbMATHMathSciNetGoogle Scholar
  4. Brockett, R. W. (1983). Asymptotic stability and feedback stabilization. Boston: Birkhauser.Google Scholar
  5. Broquère, X., Sidobre, D., & Herrera-Aguilar, I. (2008). Soft motion trajectory planner for service manipulator robot. In IEEE/RSJ international conference on intelligent robots and systems, pp. 2808–2813.Google Scholar
  6. Bus, J. C. P., & Dekker, T. J. (1975). Two efficient algorithms with guaranteed convergence for finding a zero of a function. ACM Transactions on Mathematical Software, 1(4), 330–345.CrossRefzbMATHMathSciNetGoogle Scholar
  7. Cameron, S. (1990). Collision detection by four-dimensional intersection testing. IEEE Transactions on Robotics and Automation, 6(3), 291–302.CrossRefGoogle Scholar
  8. Chang, C. C., & Song, K. T. (1997). Environment prediction for a mobile robot in a dynamic environment. IEEE Transactions on Robotics and Automation, 13(6), 862–872.CrossRefGoogle Scholar
  9. Chen, Z., Ngai, D. C. K., Yung, N. H. C. (2008). Behavior prediction based on obstacle motion patterns in dynamically changing environments. In IEEE/WIC/ACM international conference on intelligent agent technology, pp. 132–135.Google Scholar
  10. Cohen, J. D., Lin, M. C., Manocha, D., & Ponamgi, M. (1995). I-collide: An interactive and exact collision detection system for large-scale environments. In ACM interactive 3D graphics conference, pp. 189–196.Google Scholar
  11. Craig, J. J. (1989). Introduction to robotics: Mechanics and control. Boston, MA: Addison-Wesley Longman Publishing Co. Inc.zbMATHGoogle Scholar
  12. Dixon, W., Walker, I., & Dawson, D., (2001). Fault detection for wheeled mobile robots with parametric uncertainty. In IEEE/ASME international conference on advanced intelligent mechatronics, Vol. 2, pp. 1245–1250.Google Scholar
  13. Du Toit, N., & Burdick, J. (2012). Robot motion planning in dynamic, uncertain environments. IEEE Transactions on Robotics, 28(1), 101–115.Google Scholar
  14. Elnagar, A., & Hussein, A. (2003). An adaptive motion prediction model for trajectory planner systems. In International conference on robotics and automation, pp. 2442–2447.Google Scholar
  15. Elnagar, A., & Gupta, K. (1998). Motion prediction of moving objects based on autoregressive model. IEEE Transactions on Systems, Man, and Cybernetics, Part A, 28(6), 803–810.CrossRefGoogle Scholar
  16. Ess, A., Leibe, B., Schindler, K., & Gool, L. V. (2009). Moving obstacle detection in highly dynamic scenes. In IEEE international conference on robotics and automation, pp. 56–63.Google Scholar
  17. Fiorini, P., & Shiller, Z. (1998). Motion planning in dynamic environments using velocity obstacles. International Journal of Robotics Research, 17, 760–772.CrossRefGoogle Scholar
  18. Foisy, A., & Hayward, V. (1993). A safe swept volume method for collision detection. In Sixth international symposium of robotics research, pp. 61–68.Google Scholar
  19. Foka, A.F., Trahanias, P.E. (2002). Predictive autonomous robot navigation. In IEEE/RSJ international conference on intelligent robots and systems, pp. 490–495.Google Scholar
  20. Fraichard, T., & Kuffner, J. (2012). Guaranteeing motion safety for robots. Autonomous Robots, 1–3.Google Scholar
  21. Fraichard, T., & Mermond, R. (1998). Path planning with uncertainty for car-like robots. In IEEE international conference on robotics and automation, Vol. 1, pp. 27–32.Google Scholar
  22. Fraichard, T., & Asama, H. (2004). Inevitable collision states—a step towards safer robots? Advanced Robotics, 18(10), 1001–1024.CrossRefGoogle Scholar
  23. Gallagher, G., Srinivasa, S. S., Bagnell, J. A., & Ferguson, D. (2009). Gatmo: A generalized approach to tracking movable objects. In IEEE international conference on robotics and automation, pp. 2043–2048.Google Scholar
  24. Govea, V., Alejandro, D., Large, F., Fraichard, T., & Laugier, C. (2004a). High-speed autonomous navigation with motion prediction for unknown moving obstacles. In IEEE/RSJ international conference on intelligent robots and systems, pp. 82–87.Google Scholar
  25. Govea, V., Alejandro, D., Large, F., Fraichard, T., & Laugier, C. (2004b). Moving obstacles’ motion prediction for autonomous navigation. In International conference on control, automation, robotics and vision. Google Scholar
  26. Haddadin, S., Urbanek, H., Parusel, S., Burschka, D., Roßmann, J., & Albu-Schäffer, A., et al. (2010). Real-time reactive motion generation based on variable attractor dynamics and shaped velocities. In IEEE/RSJ international conference on intelligent robots and systems, pp. 3109–3116.Google Scholar
  27. Huang, Y., & Gupta, K. (2008). RRT-SLAM for motion planning with motion and map uncertainty for robot exploration. In IEEE/RSJ international conference on intelligent robots and systems, pp. 1077–1082.Google Scholar
  28. Jiménez, P., Thomas, F., & Torras, C. (2000). 3D collision detection: A survey. Computers and Graphics, 25, 269–285.CrossRefGoogle Scholar
  29. Kröger, T. (2010). On-line trajectory generation in robotic systems, Springer tracts in advanced robotics (Vol. 58). Berlin, Heidelberg, Germany: Springer.CrossRefGoogle Scholar
  30. Kurniawati, H., Yanzhu, D., Hsu, D., & Wee, S. L. (2011). Motion planning under uncertainty for robotic tasks with long time horizons. The International Journal of Robotics Research, 30(3), 308–323.CrossRefGoogle Scholar
  31. Kushleyev, A., & Likhachev, M. (2009). Time-bounded lattice for efficient planning in dynamic environments. In IEEE international conference on robotics and automation, pp. 1662–1668.Google Scholar
  32. Kuwata, Y., Schouwenaars, T., Richards, A., & How, J. P. (2005). Robust constrained receding horizon control for trajectory planning. In AIAA guidance, navigation, and control conference.Google Scholar
  33. Large, F., Sckhavat, S., Shiller, Z., & Laugier, C. (2002) Using non-linear velocity obstacles to plan motions in a dynamic environment. In IEEE international conference on control, automation, robotics and vision, pp. 734–739.Google Scholar
  34. Latombe, J. (1991). Robot motion planning. Dordrecht: Kluwer Academic Publishers.CrossRefGoogle Scholar
  35. LaValle, S., & Sharma, R. (1994). Robot motion planning in a changing, partially predictable environment. In IEEE international symposium on intelligent control, pp. 261–266.Google Scholar
  36. LaValle, S. M. (2006). Planning algorithms. Cambridge: Cambridge University Press.CrossRefzbMATHGoogle Scholar
  37. Le, D. (1985). An efficient derivative-free method for solving nonlinear equations. ACM Transactions on Mathematical Software, 11(3), 250–262.CrossRefzbMATHGoogle Scholar
  38. Leven, P., & Hutchinson, S. (2002). A framework for real-time path planning in changing environments. International Journal of Robotics Research, 21, 999–1030.CrossRefGoogle Scholar
  39. Li, J., & Xiao, J. (2012). Exact and efficient collision detection for a multi-section continuum manipulator. In IEEE international conference on robotics and automation, pp. 4340–4346.Google Scholar
  40. Lin, M. C., & Gottschalk, S. (1998). Collision detection between geometric models: A survey. In IMA conference on mathematics of surfaces, pp. 37–56.Google Scholar
  41. Lozano-Pérez, T., & Wesley, M. A. (1979). An algorithm for planning collision-free paths among polyhedral obstacles. Communications of the Association for Computing Machinery (ACM), 22(10), 560–570.Google Scholar
  42. Macfarlane, S. E., & Croft, E. A. (2003). Jerk-bounded manipulator trajectory planning: Design for real-time applications. IEEE Transactions on Robotics, 19(1), 42–52.CrossRefGoogle Scholar
  43. Missiuro, P., & Roy, N. (2006). Adapting probabilistic roadmaps to handle uncertain maps. In IEEE international conference on robotics and automation, pp. 1261–1267.Google Scholar
  44. Miura, J., & Shirai, Y. (2000). Modeling motion uncertainty of moving obstacles for robot motion planning. In IEEE international conference on robotics and automation, Vol. 3, pp. 2258–2263.Google Scholar
  45. Miura, J., Uozumi, H., & Shirai, Y. (1999). Mobile robot motion planning considering the motion uncertainty of moving obstacles. In IEEE international conference on systems, man, and, cybernetics, pp. 692–697.Google Scholar
  46. Nam, Y. S., Lee, B. H., & Kim, M. S. (1996). View-time based moving obstacle avoidance using stochastic prediction of obstacle motion. In IEEE international conference on robotics and automation, pp. 1081–1086.Google Scholar
  47. O’Rourke, J. (1998). Computational geometry in C (Second Edition). Cambridge: Cambridge University Press.CrossRefGoogle Scholar
  48. Page, L., & Sanderson, A. (1995). Robot motion planning for sensor-based control with uncertainties. In IEEE international conference on robotics and automation, Vol. 2, pp. 1333–1340.Google Scholar
  49. Pan, J., Chitta, S., & Manocha, D. (2011). Probabilistic collision detection between noisy point clouds using robust classification. International symposium on robotics research.Google Scholar
  50. Press, W. H., Teukolsky, S. A., Vetterling, W. T., & Flannery, B. P. (2007). Numerical recipes: The art of scientific computing. Cambridge: Cambridge University Press.Google Scholar
  51. Redon, S., Lin, M. C., Manocha, D., & Kim, Y. J. (2005). Fast continuous collision detection for articulated models. Journal of Computing and Information Science in Engineering, 5(2), 126–137.Google Scholar
  52. Roy, N., Burgard, W., Fox, D., & Thrun, S. (1999). Coastal navigation-mobile robot navigation with uncertainty in dynamic environments. In IEEE international conference on robotics and automation, Vol. 1, pp. 35–40.Google Scholar
  53. Schwarzer, F., Saha, M., & Latombe, J. (2005). Adaptive dynamic collision checking for single and multiple articulated robots in complex environments. IEEE Transactions on Robotics, 21(3), 338–353.CrossRefGoogle Scholar
  54. Schweikard, A. (1991). Polynomial time collision detection for manipulator paths specified by joint motions. IEEE Transactions on Robotics and Automation, 7, 865–870.CrossRefGoogle Scholar
  55. Terdiman, P. (2003). Optimized collision detection (opcode). Web http://www.codercorner.com/Opcode.htm.
  56. Thrun, S. (2002). Robotic mapping: A survey. In G. Lakemeyer & B. Nebel (Eds.), Exploring artificial intelligence in the New Millenium. San Francisco: Morgan Kaufmann.Google Scholar
  57. van den Bergen, G. (1999). A fast and robust gjk implementation for collision detection of convex objects. Journal of Graphics Tools, 4(2), 7–25.Google Scholar
  58. van den Bergen, G. (2001). Proximity queries and penetration depth computation on 3d game objects. Game developers conference.Google Scholar
  59. van den Berg, J., & Overmars, M. (2008). Planning time-minimal safe paths amidst unpredictably moving obstacles. Internatinal Journal on Robotics Research, 1274–1294.Google Scholar
  60. Vannoy, J., & Xiao, J. (2007). Real-time motion planning of multiple mobile manipulators with a common task objective in shared work environments. In IEEE international conference on robotics and automation, pp. 20–26.Google Scholar
  61. Vannoy, J., & Xiao, J. (2008). Real-time adaptive motion planning (RAMP) of mobile manipulators in dynamic environments with unforeseen changes. IEEE Transactions on Robotics, 24(5), 1199–1212.CrossRefGoogle Scholar
  62. Vatcha, R., & Xiao, J. (2009). Discovering guaranteed continuously collision-free robot trajectories in an unknown and unpredictable environment. In IEEE/RSJ international conference on intelligent robots and systems, pp. 1433–1438.Google Scholar
  63. Vatcha, R., & Xiao, J. (2010a). An efficient algorithm for on-line determination of collision-free configuration-time points directly from sensor data. In IEEE international conference on robotics and automation, pp. 4041–4047.Google Scholar
  64. Vatcha, R., & Xiao, J. (2010b). Practical motion planning in unknown and unpredictable environment. In O. Khatib, V. Kumar, & G. Sukhatme (Eds.), In 12th international symposium on experimental robotics (pp. 883–897). Springer.Google Scholar
  65. Widyotriatmo, A., Pamosoaji, A., & Hong, K. S. (2011). Robust configuration control of a mobile robot with uncertainties. In 8th Asian control conference, pp. 1036–1041.Google Scholar
  66. Yang, Y., & Brock, O. (2006). Elastic roadmaps: Globally task-consistent motion for autonomous mobile manipulation in dynamic environments. In G. Sukhatme, S. Schaal, W. Burgard, & S. Thrun (Eds.), In Robotics science and systems II (pp. 279–286). The MIT Press. Google Scholar
  67. Zucker, M., Kuffner, J., & Branicky, M. (2007). Multipartite rrts for rapid replanning in dynamic environments. In IEEE international conference on robotics and automation, pp. 1603–1609.Google Scholar

Copyright information

© Springer Science+Business Media New York 2014

Authors and Affiliations

  1. 1.University of North Carolina at CharlotteCharlotteUSA

Personalised recommendations