Parallel Algorithm for Collision Avoidance Motion Planning of Dual Arm Grasping of Humanoid Robot