Facebook
From Eratic Hamster, 9 Years ago, written in Plain Text.
Embed
Download Paste or View Raw
Hits: 1162
  1. function [Xb,Yb,Zb] = nastepnezad(X,Y,Z,fi,l,S,Al,z)
  2. load matlab.mat
  3. Xa=[X;Y;Z]
  4. dx=[S*sin(z)*cos(Al); S*sin(z)*sin(Al); S*cos(z)]
  5. sin(fi)*cos(l) -sin(l) cos(fi)*cos(l);-sin(fi)*sin(l) cos(l) cos(fi)*sin(l); cos(fi) 0 sin(fi)]
  6. R1=inv(R)
  7. Rt=R1'R=[-
  8. dX=Rt*dx
  9. Xk=Xa+dX
  10. Xb=Xk(1,1)
  11. Yb=Xk(2,1)
  12. Zb=Xk(3,1)
  13. end