3joint robot\3joint.m ............\forkin.m ............\invkin.m ............\option.m ............\setplot.m ............\treejoint.m 3joint robot