Added several test functions...
Added check-grad.hpp . Makes sure all the tests pass for now by commenting numerical differentiation of the hardcore brown_badly_scaled