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