Plan Collision-Free Paths