refactor casadi interface
first crack at custom Sqp using cplex
revive static NLP monad
NLPs are now parameterized
improve sqp iteration printing
clean up Sqp, control structure pretty reasonable now