Advertisement
Guest User

Untitled

a guest
Feb 20th, 2019
83
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 0.54 KB | None | 0 0
  1. import numpy as np
  2. def a( d1, d2, x1, y1, x2, y2 ):
  3. numerator=d1**2-d2**2 - ((x1**2+y1**2)-(x2**2+y2**2))
  4. denominator=2*(y2-y1)
  5. return numerator/denominator
  6.  
  7. def b( x1, y1, x2, y2 ):
  8. return -(x2-x1)/(y2-y1)
  9.  
  10. def solve_xy( x1, y1, x2, y2, d1, d2 ):
  11. bb=b(x1,y1,x2,y2)
  12. aa=a(d1,d2,x1,y1,x2,y2)
  13. rad=4*(bb*(aa-y1)-x1)**2 - 4*(1+bb**2)*(x1**2-d1**2+(y1-aa)**2)
  14. pre=2*(x1-bb*(aa-y1))
  15. den=2*(1+bb**2)
  16. xp=(pre+np.sqrt(rad))/den
  17. xm=(pre-np.sqrt(rad))/den
  18. yp=aa+xp*bb
  19. ym=aa+xm*bb
  20. return xm,ym,xp,yp
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement