x(1)=0;
y(1)=0;
z(1)=-800;
p(1)=0;
a(1)=0.4007;
b(1)=0.4511;
c(1)=0.4512;
d(1)=0.4008;
for      i=2:101
         f=i;
         g=i;
         h=i;
         k=i;
         w=i;
a(f-1)=0.4007+(f-2)*(-0.002455);
b(g-1)=0.4511+(g-2)*0.001754;
c(h-1)=0.4512+(h-2)*0.003463;
d(k-1)=0.4008+(k-2)*(-0.000412);

A1=x(i-1)+122.9075-48*sin(p(w-1)+0.87)+62*sin(p(w-1))-(2^(-1/2))*(265+375*sin(a(f-1)));
B1=y(i-1)+48.55-48*cos(p(w-1)+0.87)+62*cos(p(w-1))-(2^(-1/2))*(285+375*sin(a(f-1)));
C1=z(i-1)-375*cos(a(f-1));

A2=x(i-1)-7.9075-48*sin(p(w-1)+0.87)+62*sin(p(w-1))+(2^(-1/2))*(265+375*sin(b(g-1)));
B2=y(i-1)+48.55-48*cos(p(w-1)+0.87)+62*cos(p(w-1))-(2^(-1/2))*(285+375*sin(b(g-1)));
C2=z(i-1)-375*cos(b(g-1));

A3=x(i-1)-7.9075-48*sin(p(w-1)+0.87)+(2^(-1/2))*(265+375*sin(c(h-1)));
B3=y(i-1)+48.55-48*cos(p(w-1)+0.87)+(2^(-1/2))*(285+375*sin(c(h-1)));
C3=z(i-1)-375*cos(c(h-1));

A4=x(i-1)+122.9075-48*sin(p(w-1)+0.87)-(2^(-1/2))*(265+375*sin(d(k-1)));
B4=y(i-1)-48.55-48*cos(p(w-1)+0.87)+(2^(-1/2))*(285+375*sin(d(k-1)));
C4=z(i-1)-375*cos(d(k-1));

D1=375*(2^(1/2)*A1*cos(a(f-1))+2^(1/2)*B1*cos(a(f-1))-2*C1*sin(a(f-1)));
D2=375*(-2^(1/2)*A2*cos(b(g-1))+2^(1/2)*B2*cos(b(g-1))+2*C2*sin(b(g-1)));
D3=-375*(2^(1/2)*A3*cos(c(h-1))+2^(1/2)*B3*cos(c(h-1))+2*C3*sin(c(h-1)));
D4=375*(2^(1/2)*A4*cos(d(k-1))-2^(1/2)*B4*cos(d(k-1))-2*C4*sin(d(k-1)));

E1=-(A1*(48*cos(p(i-1)+0.87)-62*cos(p(i-1)))+B1*(48*sin(p(i-1)+0.87))-62*sin(p(i-1)));
E2=-(A2*(48*cos(p(i-1)+0.87)-62*cos(p(i-1)))+B2*(48*sin(p(i-1)+0.87))-62*sin(p(i-1)));
E3=-(A3*(48*cos(p(i-1)+0.87))+B3*(48*sin(p(i-1)+0.87)));
E4=-(A4*(48*cos(p(i-1)+0.87))+B4*(48*sin(p(i-1)+0.87)));

J=2*[A1/D1,B1/D1,C1/D1,E1/D1;A2/D2,B2/D2,C2/D2,E2/D2;A3/D3,B3/D3,C3/D3,E3/D3;A4/D4,B4/D4,C4/D4,E4/D4];
q=[x(i-1),y(i-1),z(i-1),p(w-1)]';
s=J*[-0.1407,0.1005,0.1985,-0.0236]';
r=q(i-1)+s(i-1);
end

2楼: Originally posted by csl_2012 at 2012-11-14 20:49:40
我看了下你的程序，好像没有实现迭代，因为所谓迭代，就是要在前一次的基础上进行计算，但你的好像没有。
另外，程序中，x,y,z,p只给了初值，却没有函数关系，在之后的引用(如x(i-1))中会出现问题，因为程序不知道 ...