SA with energy minimization in utest.cpp
Added smoothed restriction to sa_emin

This is stiil needs to be optimized