A proof of concept code for finding path in a 3D terrain.