Homotopic particle motion planning for humanoid robotics