lagrange-multipliers code snippets in matlab