In this task, an orientation constraint has been imposed to the planner such that the orientation of end effector is fixed during the task. The planner checks the self-collision and collision between robot and the environment.

Corresponding paper in IROS 2015.