The current motion planning approaches for redundant manipulators mainly includes two categories： improved gradient-projection method and some other efficiency numerical methods. The former is excessively sensitive to parameters, which makes adjustment difficult; and the latter treats the motion planning as general task by ignoring the particularity, which has good universal property but reduces the solving speed for on-line real-time planning. In this paper, a novel stepwise solution based on self-motion manifold is proposed for motion planning of redundant manipulators, namely, the chief tasks and secondary tasks are implemented step by step. Firstly, the posture tracking of end-effector is achieved accurately by employing the non-redundant joint. Secondly, the end-effector is set to keep stationary. Finally, self-motion of manipulator is realized via additional work on the gradient of redundant joint displacement. To verify this solution, experiments of round obstacle avoiding are carried out via the planar 3 degree-of-~eedom manipulator. And the experimental results indicate that this motion planning algorithm can effectively achieve obstacle avoiding and posture tracking of the end-effector. Compared with traditional gradient projection method, this approach can accelerate the problem-solving process, and is more applicable to obstacle avoiding and other additional work in displacement level.
