Implemented plan repairing, still untested for plans where the goal changes.
Can not formulate plans for MultiGoals