// calculate the real and imaginary results
// scaling appropriately
- real = (q2 - q1 * cosine) / scalingFactor;
+ real = (q1 * cosine - q2) / scalingFactor;
imag = (q1 * sine) / scalingFactor;
magnitude = sqrtf(real*real + imag*imag);
+ //phase = atan(imag/real)
return magnitude;
}