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

Conflicts:

	hmodel/evaluate_cost.m
	hmodel/find_best_traj.m