Added aStar and shortestPath algorithms