/*
* Copyright 2006 The Android Open Source Project
*
* Use of this source code is governed by a BSD-style license that can be
* found in the LICENSE file.
*/
#include "SkCordic.h"
#include "SkMath.h"
#include "Sk64.h"
// 0x20000000 equals pi / 4
const int32_t kATanDegrees[] = { 0x20000000,
0x12E4051D, 0x9FB385B, 0x51111D4, 0x28B0D43, 0x145D7E1, 0xA2F61E, 0x517C55,
0x28BE53, 0x145F2E, 0xA2F98, 0x517CC, 0x28BE6, 0x145F3, 0xA2F9, 0x517C,
0x28BE, 0x145F, 0xA2F, 0x517, 0x28B, 0x145, 0xA2, 0x51, 0x28, 0x14,
0xA, 0x5, 0x2, 0x1 };
const int32_t kFixedInvGain1 = 0x18bde0bb; // 0.607252935
static void SkCircularRotation(int32_t* x0, int32_t* y0, int32_t* z0)
{
int32_t t = 0;
int32_t x = *x0;
int32_t y = *y0;
int32_t z = *z0;
const int32_t* tanPtr = kATanDegrees;
do {
int32_t x1 = y >> t;
int32_t y1 = x >> t;
int32_t tan = *tanPtr++;
if (z >= 0) {
x -= x1;
y += y1;
z -= tan;
} else {
x += x1;
y -= y1;
z += tan;
}
} while (++t < 16); // 30);
*x0 = x;
*y0 = y;
*z0 = z;
}
SkFixed SkCordicSinCos(SkFixed radians, SkFixed* cosp)
{
int32_t scaledRadians = radians * 0x28be; // scale radians to 65536 / PI()
int quadrant = scaledRadians >> 30;
quadrant += 1;
if (quadrant & 2)
scaledRadians = -scaledRadians + 0x80000000;
/* |a| <= 90 degrees as a 1.31 number */
SkFixed sin = 0;
SkFixed cos = kFixedInvGain1;
SkCircularRotation(&cos, &sin, &scaledRadians);
Sk64 scaled;
scaled.setMul(sin, 0x6488d);
sin = scaled.fHi;
scaled.setMul(cos, 0x6488d);
if (quadrant & 2)
scaled.fHi = - scaled.fHi;
*cosp = scaled.fHi;
return sin;
}
SkFixed SkCordicTan(SkFixed a)
{
int32_t cos;
int32_t sin = SkCordicSinCos(a, &cos);
return SkFixedDiv(sin, cos);
}
static int32_t SkCircularVector(int32_t* y0, int32_t* x0, int32_t vecMode)
{
int32_t x = *x0;
int32_t y = *y0;
int32_t z = 0;
int32_t t = 0;
const int32_t* tanPtr = kATanDegrees;
do {
int32_t x1 = y >> t;
int32_t y1 = x >> t;
int32_t tan = *tanPtr++;
if (y < vecMode) {
x -= x1;
y += y1;
z -= tan;
} else {
x += x1;
y -= y1;
z += tan;
}
} while (++t < 16); // 30
Sk64 scaled;
scaled.setMul(z, 0x6488d); // scale back into the SkScalar space (0x100000000/0x28be)
return scaled.fHi;
}
SkFixed SkCordicASin(SkFixed a) {
int32_t sign = SkExtractSign(a);
int32_t z = SkFixedAbs(a);
if (z >= SK_Fixed1)
return SkApplySign(SK_FixedPI>>1, sign);
int32_t x = kFixedInvGain1;
int32_t y = 0;
z *= 0x28be;
z = SkCircularVector(&y, &x, z);
z = SkApplySign(z, ~sign);
return z;
}
SkFixed SkCordicACos(SkFixed a) {
int32_t z = SkCordicASin(a);
z = (SK_FixedPI>>1) - z;
return z;
}
SkFixed SkCordicATan2(SkFixed y, SkFixed x) {
if ((x | y) == 0)
return 0;
int32_t xsign = SkExtractSign(x);
x = SkFixedAbs(x);
int32_t result = SkCircularVector(&y, &x, 0);
if (xsign) {
int32_t rsign = SkExtractSign(result);
if (y == 0)
rsign = 0;
SkFixed pi = SkApplySign(SK_FixedPI, rsign);
result = pi - result;
}
return result;
}
const int32_t kATanHDegrees[] = {
0x1661788D, 0xA680D61, 0x51EA6FC, 0x28CBFDD, 0x1460E34,
0xA2FCE8, 0x517D2E, 0x28BE6E, 0x145F32,
0xA2F98, 0x517CC, 0x28BE6, 0x145F3, 0xA2F9, 0x517C,
0x28BE, 0x145F, 0xA2F, 0x517, 0x28B, 0x145, 0xA2, 0x51, 0x28, 0x14,
0xA, 0x5, 0x2, 0x1 };
const int32_t kFixedInvGain2 = 0x31330AAA; // 1.207534495
static void SkHyperbolic(int32_t* x0, int32_t* y0, int32_t* z0, int mode)
{
int32_t t = 1;
int32_t x = *x0;
int32_t y = *y0;
int32_t z = *z0;
const int32_t* tanPtr = kATanHDegrees;
int k = -3;
do {
int32_t x1 = y >> t;
int32_t y1 = x >> t;
int32_t tan = *tanPtr++;
int count = 2 + (k >> 31);
if (++k == 1)
k = -2;
do {
if (((y >> 31) & mode) | ~((z >> 31) | mode)) {
x += x1;
y += y1;
z -= tan;
} else {
x -= x1;
y -= y1;
z += tan;
}
} while (--count);
} while (++t < 30);
*x0 = x;
*y0 = y;
*z0 = z;
}
SkFixed SkCordicLog(SkFixed a) {
a *= 0x28be;
int32_t x = a + 0x28BE60DB; // 1.0
int32_t y = a - 0x28BE60DB;
int32_t z = 0;
SkHyperbolic(&x, &y, &z, -1);
Sk64 scaled;
scaled.setMul(z, 0x6488d);
z = scaled.fHi;
return z << 1;
}
SkFixed SkCordicExp(SkFixed a) {
int32_t cosh = kFixedInvGain2;
int32_t sinh = 0;
SkHyperbolic(&cosh, &sinh, &a, 0);
return cosh + sinh;
}
#ifdef SK_DEBUG
#ifdef SK_CAN_USE_FLOAT
#include "SkFloatingPoint.h"
#endif
void SkCordic_UnitTest()
{
#if defined(SK_SUPPORT_UNITTEST) && defined(SK_CAN_USE_FLOAT)
float val;
for (float angle = -720; angle < 720; angle += 30) {
float radian = angle * 3.1415925358f / 180.0f;
SkFixed f_angle = (int) (radian * 65536.0f);
// sincos
float sine = sinf(radian);
float cosine = cosf(radian);
SkFixed f_cosine;
SkFixed f_sine = SkCordicSinCos(f_angle, &f_cosine);
float sine2 = (float) f_sine / 65536.0f;
float cosine2 = (float) f_cosine / 65536.0f;
float error = fabsf(sine - sine2);
if (error > 0.001)
SkDebugf("sin error : angle = %g ; sin = %g ; cordic = %g\n", angle, sine, sine2);
error = fabsf(cosine - cosine2);
if (error > 0.001)
SkDebugf("cos error : angle = %g ; cos = %g ; cordic = %g\n", angle, cosine, cosine2);
// tan
float _tan = tanf(radian);
SkFixed f_tan = SkCordicTan(f_angle);
float tan2 = (float) f_tan / 65536.0f;
error = fabsf(_tan - tan2);
if (error > 0.05 && fabsf(_tan) < 1e6)
SkDebugf("tan error : angle = %g ; tan = %g ; cordic = %g\n", angle, _tan, tan2);
}
for (val = -1; val <= 1; val += .1f) {
SkFixed f_val = (int) (val * 65536.0f);
// asin
float arcsine = asinf(val);
SkFixed f_arcsine = SkCordicASin(f_val);
float arcsine2 = (float) f_arcsine / 65536.0f;
float error = fabsf(arcsine - arcsine2);
if (error > 0.001)
SkDebugf("asin error : val = %g ; asin = %g ; cordic = %g\n", val, arcsine, arcsine2);
}
#if 1
for (val = -1; val <= 1; val += .1f) {
#else
val = .5; {
#endif
SkFixed f_val = (int) (val * 65536.0f);
// acos
float arccos = acosf(val);
SkFixed f_arccos = SkCordicACos(f_val);
float arccos2 = (float) f_arccos / 65536.0f;
float error = fabsf(arccos - arccos2);
if (error > 0.001)
SkDebugf("acos error : val = %g ; acos = %g ; cordic = %g\n", val, arccos, arccos2);
}
// atan2
#if 1
for (val = -1000; val <= 1000; val += 500.f) {
for (float val2 = -1000; val2 <= 1000; val2 += 500.f) {
#else
val = 0; {
float val2 = -1000; {
#endif
SkFixed f_val = (int) (val * 65536.0f);
SkFixed f_val2 = (int) (val2 * 65536.0f);
float arctan = atan2f(val, val2);
SkFixed f_arctan = SkCordicATan2(f_val, f_val2);
float arctan2 = (float) f_arctan / 65536.0f;
float error = fabsf(arctan - arctan2);
if (error > 0.001)
SkDebugf("atan2 error : val = %g ; val2 = %g ; atan2 = %g ; cordic = %g\n", val, val2, arctan, arctan2);
}
}
// log
#if 1
for (val = 0.125f; val <= 8.f; val *= 2.0f) {
#else
val = .5; {
#endif
SkFixed f_val = (int) (val * 65536.0f);
// acos
float log = logf(val);
SkFixed f_log = SkCordicLog(f_val);
float log2 = (float) f_log / 65536.0f;
float error = fabsf(log - log2);
if (error > 0.001)
SkDebugf("log error : val = %g ; log = %g ; cordic = %g\n", val, log, log2);
}
// exp
#endif
}
#endif