heuristic function optimization can now get to goal 32 still slow
as1 optimized