cost-function code snippets in matlab