Opimise A* algo