Shortest path AI completed

Check out npc3 for a demo