Advertisement
Guest User

Untitled

a guest
Apr 19th, 2018
66
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 0.75 KB | None | 0 0
  1. function [d, t, s] = razdalja(F, G, t0, s0)
  2. %kliÄŤemo razdalja(@parabola, @premica, 2, -2)
  3.  
  4. [rF, drF, ddrF] = F(t0);
  5. [rG, drG, ddrG] = G(s0);
  6.  
  7. f1=drF'*(rF-rG);
  8. f2=drG'*(rF-rG);
  9.  
  10. JF=zeros(2,2);
  11. x=[t0; s0];
  12. while (abs(f1) > 10^(-10)) || (abs(f2) > 10^(-10))
  13.  
  14. [rF, drF, ddrF] = F(t0);
  15. [rG, drG, ddrG] = G(s0);
  16.  
  17. f1=drF'*(rF-rG);
  18. f2=drG'*(rF-rG);
  19.  
  20.  
  21. f=[f1; f2];
  22.  
  23. JF(1, 1) = ddrF'*(rF-rG)+drF'*drF;
  24. JF(1, 2) = -drG'*drF;
  25. JF(2, 1) = drF'*drG;
  26. JF(2, 2) = ddrG'*(rF-rG)-drG'*drG;
  27. x1 = x-inv(JF)*f;
  28. x = x1;
  29. t0=x(1,:);
  30. s0=x(2,:);
  31. endwhile
  32. t=t0;
  33. s=s0;
  34. [rF, drF, ddrF] = F(t0);
  35. [rG, drG, ddrG] = G(s0);
  36.  
  37. d=sqrt((rF(1,1)-rG(1,1))^2+(rF(2,1)-rG(2,1))^2);
  38.  
  39. %(x1, y1)
  40. endfunction
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement