calcshortestPath using ID + createmap and addneighbors methods

Signed-off-by: Joey Bronner <joeybronner@gmail.com>