, Volume 1, Issue 2, pp 130–140 | Cite as

A streamlined search algorithm for path modifications of a safe robot manipulator

  • Nima NajmaeiEmail author
  • Mehrdad R. Kermani
Research Article


In recent years, the interest in human-robot interactions has added a new dimension to the on-line path planning problem by requiring a method that guarantees a risk-free path. This paper presents a streamlined search algorithm for fast path modification. The algorithm is formulated as an optimization problem that evaluates alternative paths nearby each obstacle. Each path is evaluated based on the value of the danger assigned to that path. To reduce the size of the search space, the minimum number of via points necessary to alter the path is initially obtained using a geometrical method. Given the number of via points, the algorithm proceeds to locate the via points around the obstacle such that the resulting path through these via points satisfies all problem constraints. Obtaining a solution in this way renders a fast algorithm for path modification, while it better avoids problems often encountered in other gradient-based search algorithms. Case studies for two planar robots are provided to highlight some of the advantages of the proposed algorithm. Experimental results using a CRS-F3 robot manipulator validate the effectiveness of the algorithm for applications involving human-robot interactions.


robot control path planning & modification industrial manipulator optimization human-robot interactions 


Unable to display preview. Download preview PDF.

Unable to display preview. Download preview PDF.


  1. [1]
    A. De Santis, B. Siciliano, A. DeLuca, and A. Bicchi, “An atlas of human-robot interaction,” Mechanism and Machine Theory, vol. 43(3), pp. 253–270, 2008.zbMATHCrossRefGoogle Scholar
  2. [2]
    C. Lee, Z. Bien, G. Giralt, and P. Corke, “Technical challenges for dependable robots in human environments,” in Proc. of IARP IEEE Workshop, 2001.Google Scholar
  3. [3]
    American National Standards Institute, RIA/ANSI R15.06 1999 American National Standard for Industrial Robots Safety Requirement, 1999.Google Scholar
  4. [4]
    A. DeLuca, A. Albu-Schaffer, S. Haddadin, and G. Hirzinger, “Collision detection and safe reaction with the DLR-III lightweight manipulator arm,” in Proc. of IEEE/RSJ International Conference on Intelligent Robots and Systems, (Beijing, China), pp. 1623–1630, Oct 9–15, 2006.Google Scholar
  5. [5]
    A. Shafer and M. Kermani, “On the feasibility and suitability of MR and ER based actuators in human friendly manipulators,” in Proc. of IEEE/RSJ International Conference on Intelligent Robots and Systems, (St. Louis,MO, USA), pp. 2904–2909, Oct 11–15, 2009.Google Scholar
  6. [6]
    A. Bicchi and G. Tonietti, “Fast and Soft-Arm tactics [robot arm design],” IEEE Robotics & Automation Magazine, vol. 11, no. 2, pp. 22–33, 2004.CrossRefGoogle Scholar
  7. [7]
    J. Trafton, N. Cassimatis, M. Bugajska, and D. Brock, “Enabling effective human-robot interaction using perspective-taking in robots,” IEEE Transaction on Systems, Man and Cybernetics — Part A, vol. 35, pp. 460–470, 2005.CrossRefGoogle Scholar
  8. [8]
    T. Lozano-Perez, “Spatial Planning: A configuration space approach,” IEEE Transaction on Computers, vol. 32, no. 2, pp. 102–120, 1983.CrossRefMathSciNetGoogle Scholar
  9. [9]
    L. Kavraki and S. LaValle, Springer Handbook of Robotics, ch. 5. “Motion Planning”, pp. 109–131. Springer Verlag, 2008.Google Scholar
  10. [10]
    J. Barraquand and J. Latombe, “Robot Motion Planning: A distributed representation approach,” International Journal of Robotics Research, vol. 10(6), pp. 628–649, 1991.CrossRefGoogle Scholar
  11. [11]
    L. Blackmore and B. Williams, “Optimal manipulator path planning with obstacles using disjunctive programming,” in Proc. of the American Control Conference, (Minneapolis, MN, USA), Jun 14–16, 2006.Google Scholar
  12. [12]
    O. Khatib, “Real-time obstacle avoidance for manipulators and mobile robots,” The International Journal of Robotics Research, vol. 5, pp. 90–98, 1986.CrossRefGoogle Scholar
  13. [13]
    O. Brock and O. Khatib, “Real-time re-planning in highdimensional configuration spaces using sets of homotopic paths,” in Proc. of IEEE International Conference on Robotics and Automation, (San Francisco, CA, USA), pp. 550–555, Apr 24–28, 2000.Google Scholar
  14. [14]
    S. Ge and Y. Cui, “Dynamic motion planning for dynamic robots using potential field method,” Autonomous Robots, vol. 13, no. 3, pp. 207–222, 2002.zbMATHCrossRefGoogle Scholar
  15. [15]
    K. Ikuta and M. Nokata, “General evaluation method of safety for human-care robots,” in Proc. of IEEE International Conference on Robotics and Automation, (Detroit, MI, USA), pp. 2065–2072, May 10–15, 1999.Google Scholar
  16. [16]
    D. Kulic and E. Croft, “Affective state estimation for human-robot interaction,” IEEE Transaction on Robotics, vol. 23, pp. 991–1000, 2007.CrossRefGoogle Scholar
  17. [17]
    K. Ikuta and M. Nokata, “Safety evaluation method of design and control of human-care robots,” The International Journal of Robotics Research, vol. 22, pp. 281–297, 2003.CrossRefGoogle Scholar
  18. [18]
    M. Chen and A. Zalzala, “A genetic approach to motion planning for redundant mobile manipulator systems considering safety and configuration,” Journal of Robotics Systems, vol. 14, pp. 529–544, 1997.zbMATHCrossRefGoogle Scholar
  19. [19]
    O. Brock and O. Khatib, “Elastic Strips: A framework for motion generation in human environments,” The International Journal of Robotics Research, vol. 21, pp. 1031–1053, 2002.CrossRefGoogle Scholar
  20. [20]
    D. Kulic and E. Croft, “Pre-collision safety strategies for humanrobot interaction,” Autonomous Robots, vol. 22, pp. 149–164, 2007.CrossRefGoogle Scholar
  21. [21]
    N. Najmaei, S. Lele, M. R. Kermani, and R. Sobot, “Human factors for robot safety assessment,” in Proc. of IEEE/ASME International Conference on Advanced Intelligent Mechatronics, (Montreal, QC, Canada), Jul 6–9, 2010.Google Scholar
  22. [22]
    N. Najmaei and M. Kermani, “On superquadric human modeling and risk assessment for safe planning of human-safe robotic systems,” ASME Journal of Mechanisms and Robotics (in press), 2010.Google Scholar
  23. [23]
    N. Najmaei and M. Kermani, “Prediction-based reactive control strategy for human-robot interactions,” in Proc. of International Conference on Robotics and Automation, (Anchorage AL, USA), May 3–8, 2010.Google Scholar
  24. [24]
    S. Haddadian, A. Albu-Schaffer, and G. Hirzinger, “Requirements for safe robots: Measurements, analysis and new insights,” The International Journal of Robotics Research, vol. 28, pp. 1507–1527, 2009.CrossRefGoogle Scholar
  25. [25]
    V. Lumelsky and K. Sun, “Gross motion planning for a simple 3D articulated robot arm moving amidst unknown arbitrarily shaped obstacles,” in Proc. of IEEE International Conference on Robotics and Automation, pp. 1929–1934, 1987.Google Scholar
  26. [26]
    V. Lumelsky, M. Shur, and S. Wagner, “Sensitive skin,” IEEE Sensors Journal, vol. 1, no. 1, pp. 41–51, 2001.CrossRefGoogle Scholar
  27. [27]
    N. Najmaei and M. Kermani, “Superquadric obstacle modeling and a danger evaluation method with application in safe planning for human-safe robots,” in Proc. of IEEE International Conference on Technologies for Practical Robot Applications, (Woburn MA, USA), pp. 129–134, Apr 11–12, 2009.Google Scholar
  28. [28]
    J. Craig, Introduction to Robotics: Mechanics and Control. Addison-Wesley, Reading, MA, 2004.Google Scholar
  29. [29]
    L. Foulds, Optimization Techniques. Springer-Verlag New York Inc., 1981.Google Scholar
  30. [30]
    R. Schoenberg, “Optimization with Quasi-Newtonmethods,” tech. rep., Aptech Systems Inc., Maple Valley, WA, 2001.Google Scholar
  31. [31]
    S. LaValle, Robot Motion Planning. Kluwer Academic Publishers, 2006.Google Scholar
  32. [32]
    N. Najmaei and M. Kermani, “Optimal safe planning using a danger evaluation method,” in Proc. of the 14th IASTED International Conference on Robotics and Applications, (Boston, MA, USA), Nov 24, 2009.Google Scholar
  33. [33]
    E. Rimon and D. Koditscheck, “Exact robot navigation using artificial potential fields,” IEEE Transactions on Robotics and Automation, vol. 8(5), pp. 501–518, 1992.CrossRefGoogle Scholar
  34. [34]
    K. Al-Sultan and M. Aliyu, “A new potential field-based algorithm for path planning,” Journal of Intelligent and Robotic Systems, vol. 17, pp. 265–282, 1996.CrossRefGoogle Scholar
  35. [35]
    S. Carpin and G. Pillonetto, “Merging the adaptive random walks planner with the randomized potential field planner,” in Proc. IEEE International Workshop on Robot Motion and Control, pp. 151–156, Jun 23–25, 2005.Google Scholar
  36. [36]
    Thermo Electron Coroporation, Burlington, ON, Canada, CRS F3 Robot System user Guide, 2004.Google Scholar
  37. [37]
    M. DeBerg, M. Kreveld, M. Overmars, and O. Schwarzkopf, Computational Geometry, Algorithms and Applications. Springer, 2000.Google Scholar

Copyright information

© © Versita Warsaw and Springer-Verlag Wien 2010

Authors and Affiliations

  1. 1.Department of Electrical and Computer EngineeringUniversity of Western OntarioLondonCanada

Personalised recommendations