waypoint corridor generator

Long time ago I implemented waypoint corridor generator inspired by work of Julien Pettré:
Julien Pettré, Jean-Paul Laumond and Daniel Thalmann
“A navigation graph for real-time crowd animation on multi-layered and uneven terrain” 2005