A* grid based path finding in Godot