- Policy now stores cost functions as CostFunction* instead of shared_ptr<CostFunction>, which could cause unexpeced bottlenecks when running on multiple threads.
- CostFunction registration now uses modern C++ templates and lambda expressions, instead of C-style macros.
- Removed costFunctionRegistration.h/.cpp.