Extracted NavGraphSystem from PathfinderSystem.
Renamed some classes
Simple hierarchical kmean cluster algorithm.