Optimized A*, 10% faster.