Advertisement
Guest User

Untitled

a guest
Jan 23rd, 2018
68
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 0.82 KB | None | 0 0
  1. function out = gamli2(theta)
  2. gamma = pi / 2
  3. x1 = 5;
  4. x2 = 0;
  5. y2 = 6;
  6. l1 = 3;
  7. l2 = 3.*sqrt(2);
  8. l3 = 3;
  9. gamma = pi / 4;
  10. p1 = 5;
  11. p2 = 4;
  12. p3 = 3;
  13.  
  14. a2 = l3.*cos(theta) - x1
  15. b2 = l3.*sin(theta)
  16. a3 = l2.*cos(theta + gamma) - x2
  17. b3 = l2.*sin(theta + gamma) - y2
  18.  
  19. %p1.^2 = x.^2 + y.^2
  20. %p2.^2 = (x + a2).^2 + (y + b2).^2
  21. %p3.^2 = (x + a3).^2 + (y + b3).^2
  22.  
  23. %p2.^2 = x.^2 + y.^2 + a2.*x.*2 + b2.*y.*2 + a2.^2 + b2.^2
  24. %p3.^2 = x.^2 + y.^2 + a3.*x.*2 + b3.*y.*2 + a3.^2 + b3.^2
  25.  
  26. d = 2 * (a2.*b3 - b2.*a3)
  27. n1 = b3.*(p2.^2 - p1.^2 - a2.^2 - b2.^2) - b2.*(p3.^2 - p1.^2 - a3.^2 - b3.^2)
  28. n2 = -1*a3.*(p2.^2 - p1.^2 - a2.^2 - b2.^2) + a2.*(p3.^2 - p1.^2 - a3.^2 - b3.^2)
  29.  
  30. out = n1.^2 + n2.^2 - p1.^2 * d.^2
  31. end
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement