%Permute all possible lens combinations out of set of lenses
lens_set = [.075, .203, .05, .03];
lens_set = [.075,.203];
lens_permutations = pick(lens_set,3,'or');

%Pre-defined Constants
lambda= 1.064E-6 ;
Ltot= 1.010675025828971 ;
r0= 1.0E+100 ;
w0= 2.563E-5 ;
x0= 0 ;
wf= 3.709E-5 ;
rf= 1.0E+100 ;
xf= Ltot;
q0=wr2q(w0,r0,lambda);
qf=wr2q(wf,rf,lambda);
%End list

%Mode match
[ possible_lens_placement, possible_lens_set, possible_sample_energy] = mode_match( q0, qf, Ltot, lambda, lens_permutations );

%Remove similar solutions
n_truncate = 4;
[ possible_lens_placement_uniq, possible_lens_placement, possible_lens_set, index ] = remove_similar_soln( possible_sample_energy, possible_lens_placement, possible_lens_set, n_truncate );

%Visualize five best solutions
n_visualizations = 5;
pick_visualization( possible_lens_placement_uniq, possible_lens_placement, possible_lens_set, index, n_visualizations, q0, qf, Ltot, lambda );

possible_sample_energy(index(1:n_visualizations),:)


% %Visualize fitness function for fixed f2 and f3
% lens_set = [.075, .075, .203];
% f2= 0.40361319425309 ;
% f3= 0.80361319425309 ;
% 
% fitness_simplified=@(x) fitness(q0, qf, Ltot, [x, f2, f3], lens_set, lambda );
% figure(6)
% ezplot(fitness_simplified, [0,Ltot])