78 lines
2.9 KiB
C++
78 lines
2.9 KiB
C++
|
// Copyright 2020-2024 CesiumGS, Inc. and Contributors
|
||
|
|
|
||
|
|
#include "CalcBounds.h"
|
||
|
|
#include "VecMath.h"
|
||
|
|
#include <glm/gtc/matrix_inverse.hpp>
|
||
|
|
#include <glm/vec3.hpp>
|
||
|
|
|
||
|
|
glm::dmat4 CalcBoundsOperation::getModelToUnrealWorldMatrix() const {
|
||
|
|
const FMatrix matrix = localToWorld.ToMatrixWithScale();
|
||
|
|
return VecMath::createMatrix4D(matrix);
|
||
|
|
}
|
||
|
|
|
||
|
|
glm::dmat4 CalcBoundsOperation::getTilesetToUnrealWorldMatrix() const {
|
||
|
|
const glm::dmat4 modelToUnreal = getModelToUnrealWorldMatrix();
|
||
|
|
const glm::dmat4 tilesetToModel = glm::affineInverse(highPrecisionTransform);
|
||
|
|
return modelToUnreal * tilesetToModel;
|
||
|
|
}
|
||
|
|
|
||
|
|
FBoxSphereBounds CalcBoundsOperation::operator()(
|
||
|
|
const CesiumGeometry::BoundingSphere& sphere) const {
|
||
|
|
glm::dmat4 matrix = getTilesetToUnrealWorldMatrix();
|
||
|
|
glm::dvec3 center = glm::dvec3(matrix * glm::dvec4(sphere.getCenter(), 1.0));
|
||
|
|
glm::dmat3 halfAxes = glm::dmat3(matrix) * glm::dmat3(sphere.getRadius());
|
||
|
|
|
||
|
|
// The sphere only needs to reach the sides of the box, not the corners.
|
||
|
|
double sphereRadius =
|
||
|
|
glm::max(glm::length(halfAxes[0]), glm::length(halfAxes[1]));
|
||
|
|
sphereRadius = glm::max(sphereRadius, glm::length(halfAxes[2]));
|
||
|
|
|
||
|
|
FBoxSphereBounds result;
|
||
|
|
result.Origin = VecMath::createVector(center);
|
||
|
|
result.SphereRadius = sphereRadius;
|
||
|
|
result.BoxExtent = FVector(sphereRadius, sphereRadius, sphereRadius);
|
||
|
|
return result;
|
||
|
|
}
|
||
|
|
|
||
|
|
FBoxSphereBounds CalcBoundsOperation::operator()(
|
||
|
|
const CesiumGeometry::OrientedBoundingBox& box) const {
|
||
|
|
glm::dmat4 matrix = getTilesetToUnrealWorldMatrix();
|
||
|
|
glm::dvec3 center = glm::dvec3(matrix * glm::dvec4(box.getCenter(), 1.0));
|
||
|
|
glm::dmat3 halfAxes = glm::dmat3(matrix) * box.getHalfAxes();
|
||
|
|
|
||
|
|
glm::dvec3 corner1 = halfAxes[0] + halfAxes[1];
|
||
|
|
glm::dvec3 corner2 = halfAxes[0] + halfAxes[2];
|
||
|
|
glm::dvec3 corner3 = halfAxes[1] + halfAxes[2];
|
||
|
|
|
||
|
|
double sphereRadius = glm::max(glm::length(corner1), glm::length(corner2));
|
||
|
|
sphereRadius = glm::max(sphereRadius, glm::length(corner3));
|
||
|
|
|
||
|
|
double maxX = glm::abs(halfAxes[0].x) + glm::abs(halfAxes[1].x) +
|
||
|
|
glm::abs(halfAxes[2].x);
|
||
|
|
double maxY = glm::abs(halfAxes[0].y) + glm::abs(halfAxes[1].y) +
|
||
|
|
glm::abs(halfAxes[2].y);
|
||
|
|
double maxZ = glm::abs(halfAxes[0].z) + glm::abs(halfAxes[1].z) +
|
||
|
|
glm::abs(halfAxes[2].z);
|
||
|
|
|
||
|
|
FBoxSphereBounds result;
|
||
|
|
result.Origin = VecMath::createVector(center);
|
||
|
|
result.SphereRadius = sphereRadius;
|
||
|
|
result.BoxExtent = FVector(maxX, maxY, maxZ);
|
||
|
|
return result;
|
||
|
|
}
|
||
|
|
|
||
|
|
FBoxSphereBounds CalcBoundsOperation::operator()(
|
||
|
|
const CesiumGeospatial::BoundingRegion& region) const {
|
||
|
|
return (*this)(region.getBoundingBox());
|
||
|
|
}
|
||
|
|
|
||
|
|
FBoxSphereBounds CalcBoundsOperation::operator()(
|
||
|
|
const CesiumGeospatial::BoundingRegionWithLooseFittingHeights& region)
|
||
|
|
const {
|
||
|
|
return (*this)(region.getBoundingRegion());
|
||
|
|
}
|
||
|
|
|
||
|
|
FBoxSphereBounds CalcBoundsOperation::operator()(
|
||
|
|
const CesiumGeospatial::S2CellBoundingVolume& s2) const {
|
||
|
|
return (*this)(s2.computeBoundingRegion());
|
||
|
|
}
|