This does a 'fit_sort' whenever the state is changed. fit_sort effectively sorts the actions by distance+cost so that the cost is actually present unlike the original algorithm.

ai.hpp

@@ -23,7 +23,7 @@ namespace ai {
     EntityAI() {};
 
     bool wants_to(std::string name);
-    ai::Action& best_fit();
+    void fit_sort();
 
     bool active();