static void frustumf(
GLfloat left, GLfloat right,
GLfloat bottom, GLfloat top,
GLfloat zNear, GLfloat zFar,
ogles_context_t* c)
{
if (cmpf(left,right) ||
cmpf(top, bottom) ||
cmpf(zNear, zFar) ||
isZeroOrNegativef(zNear) ||
isZeroOrNegativef(zFar))
{
ogles_error(c, GL_INVALID_VALUE);
return;
}
const GLfloat r_width = reciprocalf(right - left);
const GLfloat r_height = reciprocalf(top - bottom);
const GLfloat r_depth = reciprocalf(zNear - zFar);
const GLfloat x = mul2f(zNear * r_width);
const GLfloat y = mul2f(zNear * r_height);
const GLfloat A = mul2f((right + left) * r_width);
const GLfloat B = (top + bottom) * r_height;
const GLfloat C = (zFar + zNear) * r_depth;
const GLfloat D = mul2f(zFar * zNear * r_depth);
GLfloat f[16];
f[ 0] = x;
f[ 5] = y;
f[ 8] = A;
f[ 9] = B;
f[10] = C;
f[14] = D;
f[11] = -1.0f;
f[ 1] = f[ 2] = f[ 3] =
f[ 4] = f[ 6] = f[ 7] =
f[12] = f[13] = f[15] = 0.0f;
matrixf_t rhs;
rhs.set(f);
c->transforms.current->multiply(rhs);
c->transforms.invalidate();
}
static void orthof(
GLfloat left, GLfloat right,
GLfloat bottom, GLfloat top,
GLfloat zNear, GLfloat zFar,
ogles_context_t* c)
{
if (cmpf(left,right) ||
cmpf(top, bottom) ||
cmpf(zNear, zFar))
{
ogles_error(c, GL_INVALID_VALUE);
return;
}
const GLfloat r_width = reciprocalf(right - left);
const GLfloat r_height = reciprocalf(top - bottom);
const GLfloat r_depth = reciprocalf(zFar - zNear);
const GLfloat x = mul2f(r_width);
const GLfloat y = mul2f(r_height);
const GLfloat z = -mul2f(r_depth);
const GLfloat tx = -(right + left) * r_width;
const GLfloat ty = -(top + bottom) * r_height;
const GLfloat tz = -(zFar + zNear) * r_depth;
GLfloat f[16];
f[ 0] = x;
f[ 5] = y;
f[10] = z;
f[12] = tx;
f[13] = ty;
f[14] = tz;
f[15] = 1.0f;
f[ 1] = f[ 2] = f[ 3] =
f[ 4] = f[ 6] = f[ 7] =
f[ 8] = f[ 9] = f[11] = 0.0f;
matrixf_t rhs;
rhs.set(f);
c->transforms.current->multiply(rhs);
c->transforms.invalidate();
}
void matrixf_t::rotate(GLfloat a, GLfloat x, GLfloat y, GLfloat z)
{
matrixf_t rotation;
GLfloat* r = rotation.m;
GLfloat c, s;
r[3] = 0; r[7] = 0; r[11]= 0;
r[12]= 0; r[13]= 0; r[14]= 0; r[15]= 1;
a *= GLfloat(M_PI / 180.0f);
sincosf(a, &s, &c);
if (isOnef(x) && isZerof(y) && isZerof(z)) {
r[5] = c; r[10]= c;
r[6] = s; r[9] = -s;
r[1] = 0; r[2] = 0;
r[4] = 0; r[8] = 0;
r[0] = 1;
} else if (isZerof(x) && isOnef(y) && isZerof(z)) {
r[0] = c; r[10]= c;
r[8] = s; r[2] = -s;
r[1] = 0; r[4] = 0;
r[6] = 0; r[9] = 0;
r[5] = 1;
} else if (isZerof(x) && isZerof(y) && isOnef(z)) {
r[0] = c; r[5] = c;
r[1] = s; r[4] = -s;
r[2] = 0; r[6] = 0;
r[8] = 0; r[9] = 0;
r[10]= 1;
} else {
const GLfloat len = sqrtf(x*x + y*y + z*z);
if (!isOnef(len)) {
const GLfloat recipLen = reciprocalf(len);
x *= recipLen;
y *= recipLen;
z *= recipLen;
}
const GLfloat nc = 1.0f - c;
const GLfloat xy = x * y;
const GLfloat yz = y * z;
const GLfloat zx = z * x;
const GLfloat xs = x * s;
const GLfloat ys = y * s;
const GLfloat zs = z * s;
r[ 0] = x*x*nc + c; r[ 4] = xy*nc - zs; r[ 8] = zx*nc + ys;
r[ 1] = xy*nc + zs; r[ 5] = y*y*nc + c; r[ 9] = yz*nc - xs;
r[ 2] = zx*nc - ys; r[ 6] = yz*nc + xs; r[10] = z*z*nc + c;
}
multiply(rotation);
}
DLLEXPORT float rootnf(float x, int y)
{
int y_odd = (y&1);
int y_even = !y_odd;
int y_neg = (y<0);
int x_neg = (x<0);
if (y == 0) return NANF;
if (EXPF(x) == 0) /* Flush denormalized input to zero */
return (y > 0) ? 0.0f : (y_even ? INFF : copysign(INFF, x));
if (y == 1) return x;
if (ISNEGINFF(x) && y_even) return NANF;
if (ISINFF(x)) return y_neg ? copysign(0.0f, x) : x;
if (ISANYZEROF(x) && y_odd && y_neg) return copysign(INFF, x);
int negresult = 0;
if (x_neg && y_odd) { negresult = 1; x = FABSF(x); }
float result = powf(x, reciprocalf(y));
if (negresult) result = -result;
return result;
}
