fourbar mechanism code snippets in matlab