I changed the way the solver checked to see if a state was in the open set, resulting in an order of magnitude increase in performance.