solve nonlinear optimization problem in matlab