major changes to help for logging and debugging
bug in goal state checking
fixed astar