Altered DijkstraFinder

Changed the get closest object method to return only one object and
started the fix of the multi-lane, boundary handling path finder.
Currently supports boundaries. Climbables to come soon!