A* pathfinding finished

Need to fix blocked path crash and optimize out getCompenents