optimization update
updated gampc for nonlcon
helper functions for optimization
simplex method implemented
new metaheuristic for optimization (unfinished)