An approach to time-optimal, smooth and collision-free path planning in a two robot arm environment

摘要

Summary An approach to time-optimal smooth and collision-free path planning for two industrial robot arms is presented, where path planning and joint trajectory generation are integrated. A suitable objective function, combining the requirements of time optimality and path smoothness, is proposed, which is subject to the continuity of joint trajectories, limits on their rates of change and collision-free constraints. Fast and effective collision detection for the arms is achieved using the Kuhn- Tucker conditions along with the convexity of the distance function and relying on geometrical relationships between cylinders. Nonlinear optimization is used to solve this path planning problem. The feasibility of this method is illustrated both by simulation and by experimental results.