echelon form code snippets in matlab