hessian-normal-form code snippets in matlab