glm::vec3 *normal
) {
float t_min = 0.0f;
- float t_max = 1.0e5f;
+ float t_max = std::numeric_limits<float>::infinity();
const glm::vec3 aabb_pos(M[3].x, M[3].y, M[3].z);
const glm::vec3 delta = aabb_pos - ray.orig;
glm::vec3 t1(t_min, t_min, t_min), t2(t_max, t_max, t_max);
- bool x_swap = false, y_swap = false, z_swap = false;
{ // X
const glm::vec3 xaxis(M[0].x, M[0].y, M[0].z);
t1.x = (e + aabb.min.x) / f;
t2.x = (e + aabb.max.x) / f;
- if (t1.x > t2.x) {
- std::swap(t1.x, t2.x);
- x_swap = true;
- }
- if (t1.x > t_min) {
- t_min = t1.x;
- }
- if (t2.x < t_max) {
- t_max = t2.x;
- }
+ t_min = std::max(t_min, std::min(t1.x, t2.x));
+ t_max = std::min(t_max, std::max(t1.x, t2.x));
+
if (t_max < t_min) {
return false;
}
} else {
- if (aabb.min.x - e > 0.0f || aabb.max.x < 0.0f) {
+ if (aabb.min.x - e < 0.0f || -aabb.max.x - e > 0.0f) {
return false;
}
}
t1.y = (e + aabb.min.y) / f;
t2.y = (e + aabb.max.y) / f;
- if (t1.y > t2.y) {
- std::swap(t1.y, t2.y);
- y_swap = true;
- }
- if (t1.y > t_min) {
- t_min = t1.y;
- }
- if (t2.y < t_max) {
- t_max = t2.y;
- }
+ t_min = std::max(t_min, std::min(t1.y, t2.y));
+ t_max = std::min(t_max, std::max(t1.y, t2.y));
+
if (t_max < t_min) {
return false;
}
} else {
- if (aabb.min.y - e > 0.0f || aabb.max.y < 0.0f) {
+ if (aabb.min.y - e < 0.0f || -aabb.max.y - e > 0.0f) {
return false;
}
}
t1.z = (e + aabb.min.z) / f;
t2.z = (e + aabb.max.z) / f;
- if (t1.z > t2.z) {
- std::swap(t1.z, t2.z);
- z_swap = true;
- }
- if (t1.z > t_min) {
- t_min = t1.z;
- }
- if (t2.z < t_max) {
- t_max = t2.z;
- }
+ t_min = std::max(t_min, std::min(t1.z, t2.z));
+ t_max = std::min(t_max, std::max(t1.z, t2.z));
+
if (t_max < t_min) {
return false;
}
} else {
- if (aabb.min.z - e > 0.0f || aabb.max.z < 0.0f) {
+ if (aabb.min.z - e < 0.0f || -aabb.max.z - e > 0.0f) {
return false;
}
}
}
+ glm::vec3 min_all(min(t1, t2));
+
if (dist) {
*dist = t_min;
}
if (normal) {
- if (t1.x > t1.y) {
- if (t1.x > t1.z) {
- *normal = glm::vec3(x_swap ? 1 : -1, 0, 0);
+ glm::vec4 norm(0.0f);
+ if (min_all.x > min_all.y) {
+ if (min_all.x > min_all.z) {
+ norm.x = t2.x < t1.x ? 1 : -1;
} else {
- *normal = glm::vec3(0, 0, z_swap ? 1 : -1);
+ norm.z = t2.z < t1.z ? 1 : -1;
}
- } else if (t1.y > t1.z) {
- *normal = glm::vec3(0, y_swap ? 1 : -1, 0);
+ } else if (min_all.y > min_all.z) {
+ norm.y = t2.y < t1.y ? 1 : -1;
} else {
- *normal = glm::vec3(0, 0, z_swap ? 1 : -1);
+ norm.z = t2.z < t1.z ? 1 : -1;
}
+ norm = M * norm;
+ *normal = glm::vec3(norm);
}
return true;
}