Fixed problem with A*

- Was adding nodes to open list when it shouldn't have been and so was
increasing the running time and in cases was generating open lists of
size 10,000+.... oops