Added experimental nlopt support
Temporary modification to evaluate cost for using nlopt
find_best_traj - trying simulated annealing