N K
/
GaNtroller
a fork of priustroller
Fork of priustroller_current by
Diff: util/transforms.cpp
- Revision:
- 33:e7b132029bae
- Parent:
- 27:846c08fb3697
diff -r 4e1a223fad52 -r e7b132029bae util/transforms.cpp --- a/util/transforms.cpp Mon Mar 16 02:43:19 2015 +0000 +++ b/util/transforms.cpp Mon Mar 16 03:09:48 2015 +0000 @@ -12,22 +12,16 @@ *b = -0.5 * alpha + sqrt(3.0f) / 2.0f * beta; } -void Transforms::Parke(float beta, float alpha, float theta, float *d, float *q) { - //reversed alpha and beta order to make d and q ~=constant. - //I did this because alpha was found to be sinusoidal and beta was found to be cosinusoidal. the equation has to take the form sin^2 + cos^2, not sin*cos + sin*cos. +void Transforms::Parke(float beta, float alpha, float theta, float *d, float *q) { float cos = FastCos(theta); float sin = FastSin(theta); - *d = alpha * cos + beta * sin; *q = -alpha * sin + beta * cos; - } -void Transforms::InverseParke(float d, float q, float theta, float *alpha, float *beta) { +void Transforms::InverseParke(float d, float q, float theta, float *alpha, float *beta) { float cos = FastCos(theta); float sin = FastSin(theta); - *alpha = cos * d - sin * q; - *beta = sin * d + cos * q; - + *beta = sin * d + cos * q; } \ No newline at end of file