Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- void Pulse::CalcTheAngle(float *src, float *dst, float *angles)
- {
- double delta[3] = { (src[0] - dst[0]), (src[1] - dst[1]), (src[2] - dst[2]) };
- double hyp = sqrt(delta[0] * delta[0] + delta[1] * delta[1]);
- angles[0] = (float)(asinf(delta[2] / hyp) * 57.295779513082f);
- angles[1] = (float)(atanf(delta[1] / delta[0]) * 57.295779513082f);
- angles[2] = 0.0f;
- if (delta[0] >= 0.0)
- {
- angles[1] += 180.0f;
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement