mirror of
https://github.com/cocos/cocos4.git
synced 2026-11-21 16:12:40 +08:00
271cc5cf23
* remove some rules * format all codes with new format rule
106 lines
3.4 KiB
C++
106 lines
3.4 KiB
C++
#include "cocos/core/geometry/Obb.h"
|
|
#include "base/memory/Memory.h"
|
|
|
|
namespace {
|
|
void transformExtentM3(cc::Vec3 *out, const cc::Vec3 &extent, const cc::Mat3 &m3) {
|
|
cc::Mat3 m3Tmp;
|
|
m3Tmp.m[0] = std::abs(m3.m[0]);
|
|
m3Tmp.m[1] = std::abs(m3.m[1]);
|
|
m3Tmp.m[2] = std::abs(m3.m[2]);
|
|
m3Tmp.m[3] = std::abs(m3.m[3]);
|
|
m3Tmp.m[4] = std::abs(m3.m[4]);
|
|
m3Tmp.m[5] = std::abs(m3.m[5]);
|
|
m3Tmp.m[6] = std::abs(m3.m[6]);
|
|
m3Tmp.m[7] = std::abs(m3.m[7]);
|
|
m3Tmp.m[8] = std::abs(m3.m[8]);
|
|
out->transformMat3(extent, m3Tmp);
|
|
};
|
|
} // namespace
|
|
|
|
namespace cc {
|
|
namespace geometry {
|
|
|
|
OBB *OBB::create(
|
|
float cx, float cy, float cz,
|
|
float hw, float hh, float hl,
|
|
float ox1, float ox2, float ox3,
|
|
float oy1, float oy2, float oy3,
|
|
float oz1, float oz2, float oz3) {
|
|
return ccnew OBB(cx, cy, cz, hw, hh, hl,
|
|
ox1, ox2, ox3,
|
|
oy1, oy2, oy3,
|
|
oz1, oz2, oz3);
|
|
}
|
|
|
|
OBB *OBB::clone(const OBB &a) {
|
|
return ccnew OBB(a.center.x, a.center.y, a.center.z,
|
|
a.halfExtents.x, a.halfExtents.y, a.halfExtents.z,
|
|
a.orientation.m[0], a.orientation.m[1], a.orientation.m[2],
|
|
a.orientation.m[3], a.orientation.m[4], a.orientation.m[5],
|
|
a.orientation.m[6], a.orientation.m[7], a.orientation.m[8]);
|
|
}
|
|
|
|
OBB *OBB::copy(OBB *out, const OBB &a) {
|
|
out->center = a.center;
|
|
out->halfExtents = a.halfExtents;
|
|
out->orientation = a.orientation;
|
|
return out;
|
|
}
|
|
|
|
OBB *OBB::fromPoints(OBB *out, const Vec3 &minPos, const Vec3 &maxPos) {
|
|
out->center = 0.5F * (minPos + maxPos);
|
|
out->halfExtents = 0.5F * (maxPos - minPos);
|
|
Mat3::identity(out->orientation);
|
|
return out;
|
|
}
|
|
|
|
OBB *OBB::set(OBB *out,
|
|
float cx, float cy, float cz,
|
|
float hw, float hh, float hl,
|
|
float ox1, float ox2, float ox3,
|
|
float oy1, float oy2, float oy3,
|
|
float oz1, float oz2, float oz3) {
|
|
out->center = {cx, cy, cz};
|
|
out->halfExtents = {hw, hh, hl};
|
|
out->orientation = {ox1, ox2, ox3, oy1, oy2, oy3, oz1, oz2, oz3};
|
|
return out;
|
|
}
|
|
|
|
OBB::OBB(float cx, float cy, float cz,
|
|
float hw, float hh, float hl,
|
|
float ox1, float ox2, float ox3,
|
|
float oy1, float oy2, float oy3,
|
|
float oz1, float oz2, float oz3) {
|
|
setType(ShapeEnum::SHAPE_OBB);
|
|
center = {cx, cy, cz};
|
|
halfExtents = {hw, hh, hl};
|
|
orientation = {ox1, ox2, ox3, oy1, oy2, oy3, oz1, oz2, oz3};
|
|
}
|
|
|
|
void OBB::getBoundary(Vec3 *minPos, Vec3 *maxPos) const {
|
|
Vec3 v3Tmp;
|
|
transformExtentM3(&v3Tmp, halfExtents, orientation);
|
|
*minPos = center - v3Tmp;
|
|
*maxPos = center + v3Tmp;
|
|
}
|
|
|
|
void OBB::transform(const Mat4 &m, const Vec3 & /*pos*/, const Quaternion &rot, const Vec3 &scale, OBB *out) const {
|
|
Vec3::transformMat4(center, m, &out->center);
|
|
// parent shape doesn't contain rotations for now
|
|
Mat3::fromQuat(rot, &out->orientation);
|
|
Vec3::multiply(halfExtents, scale, &out->halfExtents);
|
|
}
|
|
|
|
void OBB::translateAndRotate(const Mat4 &m, const Quaternion &rot, OBB *out) const {
|
|
Vec3::transformMat4(center, m, &out->center);
|
|
// parent shape doesn't contain rotations for now
|
|
Mat3::fromQuat(rot, &out->orientation);
|
|
}
|
|
|
|
void OBB::setScale(const Vec3 &scale, OBB *out) const {
|
|
Vec3::multiply(halfExtents, scale, &out->halfExtents);
|
|
}
|
|
|
|
} // namespace geometry
|
|
} // namespace cc
|