Mostly fixed up but I have to figure out why cost on actions isn't changing the priority.

goap.hpp

@@ -58,6 +58,8 @@ namespace ai {
     ActionState(Action action, State state) :
       action(action), state(state) {}
 
+    ActionState() : action(FINAL_ACTION), state(0) {}
+
     bool operator==(const ActionState& other) const {
       return other.action == action && other.state == state;
     }