Watt 6 Bar Linkage MATLAB CODE