本帖最后由 FlashLL 于 2018-11-2 21:52 编辑
syms gama theta R1 Dr Rr t1 t2 belta alpha r
a1 = cos(gama/2 - theta) * cos(pi/4);
a2 = -sin(gama/2 - theta);
a3 = -R1 * sin(gama/2 - theta) * cos(gama/2);
a4 = cos(gama/2 - theta) * sin(pi/4);
b1 = sin(gama/2 - theta) * cos(pi/4);
b2 = cos(gama/2 - theta);
b3 = R1 * cos(gama/2 - theta) * cos(gama/2);
b4 = sin(gama/2 - theta) * sin(pi/4);
x1 = a1 * t1 + a2 * r *cos(alpha) + a3 + a4 * r * sin(alpha);
y1 = b1 * t1 + b2 * r *cos(alpha) + b3 + b4 * r * sin(alpha);
z1 = -sin(pi/4) * t1 + r * cos(pi/4) * sin(alpha);
x2 = t2;
y2 = Rr * cos(belta) + Dr;
z2 = Rr * sin(belta);
[t1,t2,alpha,belta,r] = solve(x1,x2,x1 - x2,y1 - y2,z1 - z2,'t1','t2','alpha','belta',&#