Abstract
This paper discusses the motion optimization problem of multibody systems and an optimal control algorithm for open-link mechanisms is proposed. The algorithm is based on the efficient dynamics computatio algorithm and the optimal control algorithm called hierarchial gradient method developed by authors. An optimal control problem of a 7-DOF manipulator is solved to demonstrate the effectiveness of the proposed algorithm.