I. Introduction
Motion planning is one of the most fundamental problems in robotics. The objective of motion planning is to break down a high-level task into low-level actuator commands. An important aspect of motion planning is path planning, which addresses the geometric concerns of robot motion without regard to time [21]. In this paper, we address the problem of moving a set of actuated and constrained robot links from a start configuration to a goal configuration in a static obstacle environment.