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.