This has been implemented using a new add_cost_function! function

This is implemented in a new method of apply_simple_constraint!, which is now called throughout the code.