a5bebe6404
Batch #11327 by cremane: 0 byte-identical, 3 confirmed by peer review. - fn_17661 WorldRayQuery::Intersects: logic confirmed by peer review - fn_17658 WorldRayQuery::Collect: logic confirmed by peer review - fn_17663 WorldRayQuery::CollectNode: logic confirmed by peer review Peer-reviewed-by: Yommy, dori, StrawberrysherbetIX Accepted without human review: peers confirmed the logic ("same" ahead by at least 3, with 70% of the votes).
94 lines
2.8 KiB
C++
94 lines
2.8 KiB
C++
#include "Contents/World/WorldRayQuery.h"
|
|
#include "Contents/World/WorldSpatialTree.h"
|
|
|
|
#include <cmath>
|
|
|
|
// OFFSET: 0x00AC6450
|
|
// FUNCTION: fn_17650
|
|
WorldRayQuery::WorldRayQuery() {
|
|
this->origin[0] = 0.0f;
|
|
this->origin[1] = 0.0f;
|
|
this->origin[2] = 0.0f;
|
|
this->direction[0] = 0.0f;
|
|
this->direction[1] = 0.0f;
|
|
this->direction[2] = 0.0f;
|
|
}
|
|
|
|
// OFFSET: 0x00AC7C50
|
|
// FUNCTION: fn_17661
|
|
int WorldRayQuery::Intersects(const float* bounds) const {
|
|
const float centers[3] = {(bounds[3] + bounds[0]) * 0.5f, (bounds[4] + bounds[1]) * 0.5f, (bounds[5] + bounds[2]) * 0.5f};
|
|
const float extents[3] = {bounds[3] - centers[0], bounds[4] - centers[1], bounds[5] - centers[2]};
|
|
const float offsets[3] = {centers[0] - this->origin[0], centers[1] - this->origin[1], centers[2] - this->origin[2]};
|
|
float entry = -999999.0f;
|
|
float exit = 999999.0f;
|
|
constexpr float epsilon = 0.00001f;
|
|
constexpr float parallelScale = 0.7f;
|
|
|
|
for (unsigned axis = 0; axis < 3; ++axis) {
|
|
const float direction = this->direction[axis];
|
|
const float magnitude = std::fabs(direction);
|
|
|
|
if (!(magnitude > epsilon)) {
|
|
const float extent = extents[axis] * parallelScale;
|
|
|
|
if (-offsets[axis] - extent > 0.0f || extent - offsets[axis] < 0.0f) {
|
|
return 0;
|
|
}
|
|
} else {
|
|
const float inverse = 1.0f / direction;
|
|
const float first = (offsets[axis] + extents[axis]) * inverse;
|
|
const float second = (offsets[axis] - extents[axis]) * inverse;
|
|
const bool orderedDescending = first > second;
|
|
const float near = orderedDescending ? second : first;
|
|
const float far = orderedDescending ? first : second;
|
|
|
|
entry = near > entry ? near : entry;
|
|
exit = far < exit ? far : exit;
|
|
|
|
if (entry > exit || exit < 0.0f) {
|
|
return 0;
|
|
}
|
|
}
|
|
}
|
|
|
|
return !((entry > 0.0f ? entry : exit) > this->limit);
|
|
}
|
|
|
|
// OFFSET: 0x00AC7750
|
|
// FUNCTION: fn_17658
|
|
void WorldRayQuery::Collect(const float* ray, WorldSpatialTree* root) {
|
|
this->direction[0] = ray[3];
|
|
this->direction[1] = ray[4];
|
|
this->direction[2] = ray[5];
|
|
this->origin[0] = ray[0];
|
|
this->origin[1] = ray[1];
|
|
this->origin[2] = ray[2];
|
|
this->limit = 999999.0f;
|
|
|
|
if (root) {
|
|
for (int index = 0; index < 4; ++index) {
|
|
if (root->children[index] && this->Intersects(root->children[index]->minimum)) {
|
|
this->CollectNode(root->children[index], 1);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
// OFFSET: 0x00AC7F70
|
|
// FUNCTION: fn_17663
|
|
void WorldRayQuery::CollectNode(WorldSpatialTree* node, int depth) {
|
|
if (!node) {
|
|
return;
|
|
}
|
|
|
|
if (depth == 5) {
|
|
this->nodes.push_back(node);
|
|
} else {
|
|
for (int index = 0; index < 4; ++index) {
|
|
if (node->children[index] && this->Intersects(node->children[index]->minimum)) {
|
|
this->CollectNode(node->children[index], depth + 1);
|
|
}
|
|
}
|
|
}
|
|
}
|