araplanner:
     Moved reinitialization of goal state to inside ReInitializeSearchStateSpace
Merge pull request #14 from bmacallister85/origin/ara-timeout-fix-improvement

araplanner: