summaryrefslogtreecommitdiff
path: root/thirdparty/bullet/Bullet3Collision/BroadPhaseCollision/shared/b3Aabb.h
diff options
context:
space:
mode:
Diffstat (limited to 'thirdparty/bullet/Bullet3Collision/BroadPhaseCollision/shared/b3Aabb.h')
-rw-r--r--thirdparty/bullet/Bullet3Collision/BroadPhaseCollision/shared/b3Aabb.h51
1 files changed, 24 insertions, 27 deletions
diff --git a/thirdparty/bullet/Bullet3Collision/BroadPhaseCollision/shared/b3Aabb.h b/thirdparty/bullet/Bullet3Collision/BroadPhaseCollision/shared/b3Aabb.h
index 7f9bf990bf..343a2c0e21 100644
--- a/thirdparty/bullet/Bullet3Collision/BroadPhaseCollision/shared/b3Aabb.h
+++ b/thirdparty/bullet/Bullet3Collision/BroadPhaseCollision/shared/b3Aabb.h
@@ -2,7 +2,6 @@
#ifndef B3_AABB_H
#define B3_AABB_H
-
#include "Bullet3Common/shared/b3Float4.h"
#include "Bullet3Common/shared/b3Mat3x3.h"
@@ -10,44 +9,42 @@ typedef struct b3Aabb b3Aabb_t;
struct b3Aabb
{
- union
- {
+ union {
float m_min[4];
b3Float4 m_minVec;
int m_minIndices[4];
};
- union
- {
- float m_max[4];
+ union {
+ float m_max[4];
b3Float4 m_maxVec;
int m_signedMaxIndices[4];
};
};
-inline void b3TransformAabb2(b3Float4ConstArg localAabbMin,b3Float4ConstArg localAabbMax, float margin,
- b3Float4ConstArg pos,
- b3QuatConstArg orn,
- b3Float4* aabbMinOut,b3Float4* aabbMaxOut)
+inline void b3TransformAabb2(b3Float4ConstArg localAabbMin, b3Float4ConstArg localAabbMax, float margin,
+ b3Float4ConstArg pos,
+ b3QuatConstArg orn,
+ b3Float4* aabbMinOut, b3Float4* aabbMaxOut)
{
- b3Float4 localHalfExtents = 0.5f*(localAabbMax-localAabbMin);
- localHalfExtents+=b3MakeFloat4(margin,margin,margin,0.f);
- b3Float4 localCenter = 0.5f*(localAabbMax+localAabbMin);
- b3Mat3x3 m;
- m = b3QuatGetRotationMatrix(orn);
- b3Mat3x3 abs_b = b3AbsoluteMat3x3(m);
- b3Float4 center = b3TransformPoint(localCenter,pos,orn);
-
- b3Float4 extent = b3MakeFloat4(b3Dot3F4(localHalfExtents,b3GetRow(abs_b,0)),
- b3Dot3F4(localHalfExtents,b3GetRow(abs_b,1)),
- b3Dot3F4(localHalfExtents,b3GetRow(abs_b,2)),
- 0.f);
- *aabbMinOut = center-extent;
- *aabbMaxOut = center+extent;
+ b3Float4 localHalfExtents = 0.5f * (localAabbMax - localAabbMin);
+ localHalfExtents += b3MakeFloat4(margin, margin, margin, 0.f);
+ b3Float4 localCenter = 0.5f * (localAabbMax + localAabbMin);
+ b3Mat3x3 m;
+ m = b3QuatGetRotationMatrix(orn);
+ b3Mat3x3 abs_b = b3AbsoluteMat3x3(m);
+ b3Float4 center = b3TransformPoint(localCenter, pos, orn);
+
+ b3Float4 extent = b3MakeFloat4(b3Dot3F4(localHalfExtents, b3GetRow(abs_b, 0)),
+ b3Dot3F4(localHalfExtents, b3GetRow(abs_b, 1)),
+ b3Dot3F4(localHalfExtents, b3GetRow(abs_b, 2)),
+ 0.f);
+ *aabbMinOut = center - extent;
+ *aabbMaxOut = center + extent;
}
/// conservative test for overlap between two aabbs
-inline bool b3TestAabbAgainstAabb(b3Float4ConstArg aabbMin1,b3Float4ConstArg aabbMax1,
- b3Float4ConstArg aabbMin2, b3Float4ConstArg aabbMax2)
+inline bool b3TestAabbAgainstAabb(b3Float4ConstArg aabbMin1, b3Float4ConstArg aabbMax1,
+ b3Float4ConstArg aabbMin2, b3Float4ConstArg aabbMax2)
{
bool overlap = true;
overlap = (aabbMin1.x > aabbMax2.x || aabbMax1.x < aabbMin2.x) ? false : overlap;
@@ -56,4 +53,4 @@ inline bool b3TestAabbAgainstAabb(b3Float4ConstArg aabbMin1,b3Float4ConstArg aab
return overlap;
}
-#endif //B3_AABB_H
+#endif //B3_AABB_H