Humanoid motion planning for dual-arm manipulation and re-grasping tasks