A basic implementation of A-Star pathfinding algorithm