Position3d Cube::getNormal(Position3d point)
{
Matrix4 worldToLocalCoordinate = transform.getInverseRotationMatrix()
* transform.getInverseScalMatrix()
* transform.getInverseTranslationMatrix();
Position3d localPoint = worldToLocalCoordinate.applyMatrix(point);
Position3d localNormal;
if ((localPoint.get_x() > -1.0f - ZERO_THRESHOLD) && (localPoint.get_x() < -1.0f + ZERO_THRESHOLD))
{
localNormal = Position3d(-1.0f, 0.0f, 0.0f);
}
else if ((localPoint.get_x() > 1.0f - ZERO_THRESHOLD) && (localPoint.get_x() < 1.0f + ZERO_THRESHOLD))
{
localNormal = Position3d(1.0f, 0.0f, 0.0f);
}
else if ((localPoint.get_y() > -1.0f - ZERO_THRESHOLD) && (localPoint.get_y() < -1.0f + ZERO_THRESHOLD))
{
localNormal = Position3d(0.0f, -1.0f, 0.0f);
}
else if ((localPoint.get_y() > 1.0f - ZERO_THRESHOLD) && (localPoint.get_y() < 1.0f + ZERO_THRESHOLD))
{
localNormal = Position3d(0.0f, 1.0f, 0.0f);
}
else if ((localPoint.get_z() > -1.0f - ZERO_THRESHOLD) && (localPoint.get_z() < -1.0f + ZERO_THRESHOLD))
{
localNormal = Position3d(0.0f, 0.0f, -1.0f);
}
else if ((localPoint.get_z() > 1.0f - ZERO_THRESHOLD) && (localPoint.get_z() < 1.0f + ZERO_THRESHOLD))
{
localNormal = Position3d(0.0f, 0.0f, 1.0f);
}
// returns direction
Matrix4 localToWorldCoordinate = transform.getScalMatrix() * transform.getRotationMatrix();
Position3d worldNormal = localToWorldCoordinate.applyMatrix(localNormal);
worldNormal.normalize();
return worldNormal;
}
ColorRgba Cube::textureColor(QImage texture, Position3d* point)
{
Matrix4 worldToLocalCoordinate = transform.getInverseRotationMatrix()
* transform.getInverseScalMatrix()
* transform.getInverseTranslationMatrix();
Position3d localPoint = worldToLocalCoordinate.applyMatrix(*point);
if ( ((localPoint.get_x() > -1.0f - ZERO_THRESHOLD) && (localPoint.get_x() < -1.0f + ZERO_THRESHOLD))
|| ((localPoint.get_x() > 1.0f - ZERO_THRESHOLD) && (localPoint.get_x() < 1.0f + ZERO_THRESHOLD)) )
{
// normalize
float tex_y = (localPoint.get_y() + 1.0f) / 2.0f;
float tex_z = (localPoint.get_z() + 1.0f) / 2.0f;
int h = (int)(tex_y * (float)texture.height());
int w = (int)(tex_z * (float)texture.width());
if (h < 0) h = 0;
if (h >= texture.height()) h = texture.height() - 1;
if (w < 0) w = 0;
if (w >= texture.width()) w = texture.width() - 1;
QRgb rgb = texture.pixel(w, h);
QColor color(rgb);
return ColorRgba(color.redF(), color.greenF(), color.blueF());
}
else if ( ((localPoint.get_y() > -1.0f - ZERO_THRESHOLD) && (localPoint.get_y() < -1.0f + ZERO_THRESHOLD))
|| ((localPoint.get_y() > 1.0f - ZERO_THRESHOLD) && (localPoint.get_y() < 1.0f + ZERO_THRESHOLD)) )
{
// normalize
float tex_x = (localPoint.get_x() + 1.0f) / 2.0f;
float tex_z = (localPoint.get_z() + 1.0f) / 2.0f;
int h = (int)(tex_z * (float)texture.height());
int w = (int)(tex_x * (float)texture.width());
if (h < 0) h = 0;
if (h >= texture.height()) h = texture.height() - 1;
if (w < 0) w = 0;
if (w >= texture.width()) w = texture.width() - 1;
QRgb rgb = texture.pixel(w, h);
QColor color(rgb);
return ColorRgba(color.redF(), color.greenF(), color.blueF());
}
else if ( ((localPoint.get_z() > -1.0f - ZERO_THRESHOLD) && (localPoint.get_z() < -1.0f + ZERO_THRESHOLD))
|| ((localPoint.get_z() > 1.0f - ZERO_THRESHOLD) && (localPoint.get_z() < 1.0f + ZERO_THRESHOLD)) )
{
// normalize
float tex_x = (localPoint.get_x() + 1.0f) / 2.0f;
float tex_y = (localPoint.get_y() + 1.0f) / 2.0f;
int h = (int)(tex_y * (float)texture.height());
int w = (int)(tex_x * (float)texture.width());
if (h < 0) h = 0;
if (h >= texture.height()) h = texture.height() - 1;
if (w < 0) w = 0;
if (w >= texture.width()) w = texture.width() - 1;
QRgb rgb = texture.pixel(w, h);
QColor color(rgb);
return ColorRgba(color.redF(), color.greenF(), color.blueF());
}
}
Position3d* Cube::interceptedWithRay(Position3d rayOrigin, Position3d rayDirection)
{
Matrix4 worldToLocalCoordinate = transform.getInverseRotationMatrix() * transform.getInverseScalMatrix();
Position3d localRayDirection = worldToLocalCoordinate.applyMatrix(rayDirection);
worldToLocalCoordinate *= transform.getInverseTranslationMatrix();
Position3d localRayOrigin = worldToLocalCoordinate.applyMatrix(rayOrigin);
// vector ray direction
d_x = localRayDirection.get_x();
d_y = localRayDirection.get_y();
d_z = localRayDirection.get_z();
// ray initial point
o_x = localRayOrigin.get_x();
o_y = localRayOrigin.get_y();
o_z = localRayOrigin.get_z();
//LOG("x: " << d_x << "\ty: " << d_y << "\tz: " << d_z);
bool hittedX = false;
bool hittedY = false;
bool hittedZ = false;
if (d_x < 0.0f)
{
hittedX = checkRayPlusPlaneX();
}
else
{
hittedX = checkRayMinusPlaneX();
}
if (d_y < 0.0f)
{
hittedY = checkRayPlusPlaneY();
}
else
{
hittedY = checkRayMinusPlaneY();
}
if (d_z < 0.0f)
{
hittedZ = checkRayPlusPlaneZ();
}
else
{
hittedZ = checkRayMinusPlaneZ();
}
float t = MAX_VALUE;
if (hittedX)
{
if (hittedY)
{
if (hittedZ)
{
t = tx <= ty ? tx : ty;
t = tz <= t ? tz : t;
}
else
{
t = tx <= ty ? tx : ty;
}
}
else
{
if (hittedZ)
{
t = tx <= tz ? tx : tz;
}
else
{
t = tx;
}
}
}
else
{
if (hittedY)
{
if (hittedZ)
{
t = ty <= tz ? ty : tz;
}
else
{
t = ty;
}
}
else
{
if (hittedZ)
{
t = tz;
}
else
{
return NULL;
}
}
}
// return the interception point in world coordinates
Position3d localInterception(localRayOrigin + (localRayDirection * t));
Matrix4 localToWorldCoordinate = transform.getTranslationMatrix() * transform.getScalMatrix() * transform.getRotationMatrix();
Position3d worldInterception = localToWorldCoordinate.applyMatrix(localInterception);
return ( new Position3d(worldInterception) );
}