Sequential Quadratic Programming based Global Path Re-Planner for a Mobile Manipulator

  • Lee Soo-Yong (Department of Mechanical and System Design Engineering, Hongik University)
  • Published : 2006.06.01

Abstract

The mobile manipulator is expected to work in partially defined or unstructured environments. In our global/local approach to path planning, joint trajectories are generated for a desired Cartesian space path, designed by the global path planner. For a local path planner, inverse kinematics for a redundant system is used. Joint displacement limit for the manipulator links is considered in the motion planner. In an event of failure to obtain feasible trajectories, the task cannot be accomplished. At the point of failure, a deviation in the Cartesian space path is obtained and a replanner gives a new path that would achieve the goal position. To calculate the deviation, a nonlinear optimization problem is formulated and solved by standard Sequential Quadratic Programming (SQP) method.

Keywords

References

  1. Y. Shan and Y. Koren, 'Obstacle accommodation motion planning,' IEEE Trans. on Robotics and Automation, vol. 11, no. 1, pp. 36-49, 1995 https://doi.org/10.1109/70.345936
  2. Y. Yamamoto and X. Yun, 'Control of mobile manipulators following a moving surface,' Proc. of IEEE International Conference on Intelligent Robots and Systems, vol. 3, pp. 1-6, 1993
  3. C. Altafini, 'Inverse kinematics along a geometric spline for a holonomic mobile manipulator,' Proc. of IEEE International Conference on Robotics and Automation, vol. 2, pp. 1265-1270, 2001
  4. H. G. Tanner and K. J. Kyriakopoulos, 'Nonholonomic motion planning for mobile manipulators,' Proc. of IEEE International Conference on Robotics and Automation, vol. 2, pp. 1233-1238, 2000
  5. A. Mohri, S. Furuno, and M. Yamamoto, 'Trajectory planning of mobile manipulator with end-effector's specified path,' Proc. of IEEE International Conference on Intelligent Robots and Systems, vol. 4, pp. 2264-2269, 2001
  6. J. C. Latombe, Robot Motion Planning, Kluwer Academic Publishers, Boston, Massachusetts, 1991
  7. S. G. Hong, S. W. Kim, K. B. Park, and J. J. Lee, 'Local motion planner for nonholonomic mobile robots in the presence of the unknown obstacles,' Proc. of IEEE International Conference on Robotics and Automation, vol. 2, pp. 1212-1217, 1996
  8. J. S. Zelek and M. D. Levine, 'Local-global concurrent path planning and execution systems,' IEEE Trans. on Systems, Man and Cybernetics, vol. 30, no. 6, pp. 865-870, 2000
  9. J. Craig, Introduction to Robotics: Mechanics and Control, Third edition, Prentice Hall, 2003
  10. Y. Nakamura, Advanced Robotics: Redundancy and Optimization, Addison-Wesley Publishing Company, Inc., 1991
  11. M. C. Biggs, 'Constrained minimization using recursive quadrative programming,' Towards Global Optimization, vol. 1, pp. 341-349, 1975
  12. S. P. Han, 'A globally convergent method for nonlinear programming,' Optimization Theory and Applications, vol. 22, pp. 297-303, 1977 https://doi.org/10.1007/BF00932858
  13. M. J. D. Powell, 'Variable metric methods for constrained optimization,' Mathematical Programming: The State of the Art, Springer Verlag, pp. 288-311, 1983
  14. R. Fletcher, Practical Methods of Optimization, 2nd ed., John Wiley & Sons, Inc., New York, 1987
  15. K. Schittkowski, 'NLQPL: A fortran-subroutine solving constrained nonlinear programming problems,' Annals of Operations Research, vol. 5, pp. 485-500, 1985