solving constrained optimization problem in matlab