wip
wip, A* algorithm working