Facebook
From Aqua Owl, 9 Years ago, written in Matlab M-file.
Embed
Download Paste or View Raw
Hits: 790
  1. function [ b_fi, b_la, A_BA ] = kivioj(fi, la, A, s, a, e2)
  2.  
  3. n = round(s/1000);
  4. ds = s/n;
  5. for i = 1:n  
  6.     M = M_p(fi,a,e2);
  7.     N = N_p(fi,a,e2);
  8.     dfi_p = (ds*cos(A))/M;
  9.     dA_p = (ds*sin(A)*tan(fi))/N;
  10.     fi_m = fi + dfi_p/2;
  11.     A_m = A + dA_p/2;
  12.     M_m = M_p(fi_m,a,e2);
  13.     N_m = N_p(fi_m,a,e2);
  14.     dfi = (ds*cos(A_m))/M_m;
  15.     dla = (ds*sin(A_m))/(N_m*cos(fi_m));
  16.     dA = (ds*sin(A_m)*tan(fi_m))/N_m;
  17.    
  18.     fi = fi + dfi;
  19.     la = la + dla;
  20.     A = A + dA;
  21. end;
  22.  
  23. b_fi = fi;
  24. b_la = la;
  25.  
  26. if A < pi
  27.     A_BA = A + pi;
  28. else
  29.     A_BA = A - pi;
  30. end;
  31.  
  32. end