work in  progress - added bits n pieces
Merge https://github.com/rsOnline/Astar-Pathfinding-Algorithm