Add skeleton for euclidian distance based heuristic
Add points to internal graph nodes
Add loading of X,Y,Z for nodes (road,pt,poi)
Add A* heuristic