下面是MATLAB中建模的代码:
L(1)=Link([0 0.68 0 0],'modified');
L(2)=Link([-pi/2 0 0.3 -pi/2],'modified');
L(3)=Link([0 0 0.89 0],'modified');
L(4)=Link([0 1.02 0.15 -pi/2],'modified');
L(5)=Link([0 0 0 pi/2],'modified');
L(6)=Link([0 0 0 -pi/2],'modified');
Six_Link=SerialLink([L(1),L(2),L(3),L(4),L(5),L(6)]);
Six_Link.plot([0,-pi/2,0,0,0,0])