Optimized A*