Fixed h-hat bugs. Now we just need A*