Minimum-time optimal control of robotic manipulators based on Hamel's integrators

In this paper, we develop a framework of time optimization path planning for robotic manipulators surrounded by static obstacles. Our approach is based on the recursive dynamics method and Hamel's integrators. We adopt the linear programming techniques to solve the problem of the collision avoidance expressed as state constraints. The resulting algorithm is simple to implement and the performance of this approach is demonstrated through two examples. Numerical results are shown to validate the efficiency of the proposed algorithm.