SMS versenden: Informed sampling for asymptotically optimal path planning