Advanced graph methods in 3D robots motion planning by Daniel Reclik