SummaryThis paper presents a collision-free motion planning method of two articulated robot arms in a three dimensional common work space. Each link of a robot arm is modeled by a cylinder ended by two hemispheres, and the remaining wrist and hand is modeled by a sphere. To describe the danger of collision between two modeled objects, minimum distance functions, which are defined by the Euclidean norm, are used. These minimum distance functions are used to describe the constraints that guarantee no collision between two robot arms. The collision-free motion planning problem is formulated as a pointwise constrained nonlinear minimization problem, and solved by a conjugate gradient method with barrier functions. To improve the minimization process, a simple grid technique is incorporated. Finally, a simulation study is presented to show the significance of the proposed method.
