
<5.1-1>
如左圖
<5.1-2>
function bodybody(L1,L2,L3,theta1,theta2,theta3,dd)L1xt=L1*cosd(-theta1);L1yt=L1*sind(-theta1);L2xt=L1xt+L2*cosd(-theta1-180 + theta2);L2yt=L1yt+L2*sind(-theta1-180 + theta2);L3xt=L2xt+L3*cosd(-theta1-360 + theta2+theta3);L3yt=L2yt+L3*sind(-theta1-360 + theta2+theta3);X=[0 L1xt L2xt L3xt];Y=[0 L1yt L2yt L3yt];clf;for i=1:length(X)-1 A=[X(i) Y(i)];B=[X(i+1),Y(i+1)];if nargin==2,dd=1;end;d=abs(dd);AB=(B(1)+j*B(2))-(A(1)+j*A(2));D=abs(AB);th=angle(AB);t=linspace(pi/2,2.5*pi,20);Cout=max(d/2,0.2)*exp(j*t');Cin=Cout/2;if dd>0, P=[0;Cin;Cout(1:10);D+Cout(11:20);D+Cin;D+Cout(20);Cout(1)];endxx=real(P);yy=imag(P);x=xx*cos(th)-yy*sin(th)+A(1);y=xx*sin(th)+yy*cos(th)+A(2);line(x,y)axis equalend;
<5.1-3>
L1=25;L2=25;L3=10;theta1=-90;theta2=-45;theta3=-30;bodybody(L1, L2, L3,theta1, theta2 ,theta3,10);
<5.1-4>
<5.2-1>

如圖示
將手掌跟手指分別假設為平面
則手指能夠移動的範圍
就只有在與手掌平面 平行與垂直之間 的區域
如圖棕灰色方塊之間
<5.2-2>