Added an algorithm to get a path btwen two given points