IA basis

Dijkstra algorithm to determine path between waypoints
Heuristical code (skeleton) to select objectives
Basis for Objectives selection