Advertisement
Guest User

Untitled

a guest
Jun 29th, 2016
76
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 0.42 KB | None | 0 0
  1. void Pulse::CalcTheAngle(float *src, float *dst, float *angles)
  2. {
  3.  
  4. double delta[3] = { (src[0] - dst[0]), (src[1] - dst[1]), (src[2] - dst[2]) };
  5. double hyp = sqrt(delta[0] * delta[0] + delta[1] * delta[1]);
  6. angles[0] = (float)(asinf(delta[2] / hyp) * 57.295779513082f);
  7. angles[1] = (float)(atanf(delta[1] / delta[0]) * 57.295779513082f);
  8. angles[2] = 0.0f;
  9.  
  10. if (delta[0] >= 0.0)
  11. {
  12. angles[1] += 180.0f;
  13. }
  14. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement