程序如下:
syms J1 J2 J3 J4
la=375;
lb=785;
R=275;
r=102;
x=100;
y=100;
z=-600;
J=0;
[J1,J2,J3,J4]=solve((1.414*r*sin(0.785-J)*cos(J)+x-R-la*sin(J1))^2+(1.414*r*sin(0.785-J)*sin(J)+y)^2+(z+la*cos(J1))^2-lb^2,...
(-1.414*r*cos(0.785-J)*sin(J)+x)^2+(1.414*r*cos(0.785-J)*cos(J)+y-R-la*sin(J2))^2+(z+la*cos(J2))^2-lb^2,...
(1.414*r*sin(0.785-J)*cos(J)-x-R-la*sin(J3))^2+(1.414*r*sin(0.785-J)*sin(J)-y)^2+(z+la*cos(J3))^2-lb^2,...
(1.414*r*cos(0.785-J)*sin(J)+x)^2+(-1.414*r*cos(0.785-J)*cos(J)+y-R+la*sin(J4))^2+(z+la*cos(J4))^2-lb^2)
J1=vpa(J1)
J2=vpa(J2)
J3=vpa(J3)
J4=vpa(J4)
这时得到的解是:
J1 =
1.6726496034324791422369776889755
1.672649603