Lagrangian based A* algorithm for automated reasoning