aboutsummaryrefslogtreecommitdiff
path: root/PhysX_3.4/Source/GeomUtils/src/gjk/GuVecShrunkBox.h
diff options
context:
space:
mode:
authorgit perforce import user <a@b>2016-10-25 12:29:14 -0600
committerSheikh Dawood Abdul Ajees <Sheikh Dawood Abdul Ajees>2016-10-25 18:56:37 -0500
commit3dfe2108cfab31ba3ee5527e217d0d8e99a51162 (patch)
treefa6485c169e50d7415a651bf838f5bcd0fd3bfbd /PhysX_3.4/Source/GeomUtils/src/gjk/GuVecShrunkBox.h
downloadphysx-3.4-3dfe2108cfab31ba3ee5527e217d0d8e99a51162.tar.xz
physx-3.4-3dfe2108cfab31ba3ee5527e217d0d8e99a51162.zip
Initial commit:
PhysX 3.4.0 Update @ 21294896 APEX 1.4.0 Update @ 21275617 [CL 21300167]
Diffstat (limited to 'PhysX_3.4/Source/GeomUtils/src/gjk/GuVecShrunkBox.h')
-rw-r--r--PhysX_3.4/Source/GeomUtils/src/gjk/GuVecShrunkBox.h191
1 files changed, 191 insertions, 0 deletions
diff --git a/PhysX_3.4/Source/GeomUtils/src/gjk/GuVecShrunkBox.h b/PhysX_3.4/Source/GeomUtils/src/gjk/GuVecShrunkBox.h
new file mode 100644
index 00000000..8fbaa111
--- /dev/null
+++ b/PhysX_3.4/Source/GeomUtils/src/gjk/GuVecShrunkBox.h
@@ -0,0 +1,191 @@
+// This code contains NVIDIA Confidential Information and is disclosed to you
+// under a form of NVIDIA software license agreement provided separately to you.
+//
+// Notice
+// NVIDIA Corporation and its licensors retain all intellectual property and
+// proprietary rights in and to this software and related documentation and
+// any modifications thereto. Any use, reproduction, disclosure, or
+// distribution of this software and related documentation without an express
+// license agreement from NVIDIA Corporation is strictly prohibited.
+//
+// ALL NVIDIA DESIGN SPECIFICATIONS, CODE ARE PROVIDED "AS IS.". NVIDIA MAKES
+// NO WARRANTIES, EXPRESSED, IMPLIED, STATUTORY, OR OTHERWISE WITH RESPECT TO
+// THE MATERIALS, AND EXPRESSLY DISCLAIMS ALL IMPLIED WARRANTIES OF NONINFRINGEMENT,
+// MERCHANTABILITY, AND FITNESS FOR A PARTICULAR PURPOSE.
+//
+// Information and code furnished is believed to be accurate and reliable.
+// However, NVIDIA Corporation assumes no responsibility for the consequences of use of such
+// information or for any infringement of patents or other rights of third parties that may
+// result from its use. No license is granted by implication or otherwise under any patent
+// or patent rights of NVIDIA Corporation. Details are subject to change without notice.
+// This code supersedes and replaces all information previously supplied.
+// NVIDIA Corporation products are not authorized for use as critical
+// components in life support devices or systems without express written approval of
+// NVIDIA Corporation.
+//
+// Copyright (c) 2008-2016 NVIDIA Corporation. All rights reserved.
+// Copyright (c) 2004-2008 AGEIA Technologies, Inc. All rights reserved.
+// Copyright (c) 2001-2004 NovodeX AG. All rights reserved.
+
+#ifndef GU_VEC_SHRUNK_BOX_H
+#define GU_VEC_SHRUNK_BOX_H
+
+/** \addtogroup geomutils
+@{
+*/
+#include "PxPhysXCommonConfig.h"
+#include "GuVecConvex.h"
+#include "PsVecTransform.h"
+#include "GuConvexSupportTable.h"
+#include "GuVecBox.h"
+
+
+
+namespace physx
+{
+
+namespace Gu
+{
+
+ /**
+ \brief Represents an oriented bounding box.
+
+ As a center point, extents(radii) and a rotation. i.e. the center of the box is at the center point,
+ the box is rotated around this point with the rotation and it is 2*extents in width, height and depth.
+ */
+
+ /**
+ Box geometry
+
+ The rot member describes the world space orientation of the box.
+ The center member gives the world space position of the box.
+ The extents give the local space coordinates of the box corner in the positive octant.
+ Dimensions of the box are: 2*extent.
+ Transformation to world space is: worldPoint = rot * localPoint + center
+ Transformation to local space is: localPoint = T(rot) * (worldPoint - center)
+ Where T(M) denotes the transpose of M.
+ */
+
+ class ShrunkBoxV : public BoxV
+ {
+ public:
+
+ /**
+ \brief Constructor
+ */
+ PX_INLINE ShrunkBoxV() : BoxV()
+ {
+ }
+
+ PX_INLINE ShrunkBoxV(const PxGeometry& geom) : BoxV(geom)
+ {
+ initialiseMarginDif();
+ }
+
+ /**
+ \brief Constructor
+
+ \param origin Center of the OBB
+ \param extent Extents/radii of the obb.
+ */
+
+ PX_FORCE_INLINE ShrunkBoxV(const Ps::aos::Vec3VArg origin, const Ps::aos::Vec3VArg extent) :
+ BoxV(origin, extent)
+ {
+ initialiseMarginDif();
+ }
+
+ /**
+ \brief Destructor
+ */
+ PX_INLINE ~ShrunkBoxV()
+ {
+ }
+
+ //! Assignment operator
+ PX_INLINE const ShrunkBoxV& operator=(const ShrunkBoxV& other)
+ {
+ center = other.center;
+ extents = other.extents;
+ margin = other.margin;
+ minMargin = other.minMargin;
+ return *this;
+ }
+
+ PX_FORCE_INLINE Ps::aos::Vec3V supportPoint(const PxI32 index, Ps::aos::FloatV* marginDif_)const
+ {
+ using namespace Ps::aos;
+ const Vec3V extents_ = V3Sub(extents, V3Splat(getMargin()));
+ const BoolV con = boxVertexTable[index];
+ (*marginDif_) = marginDif;
+ return V3Sel(con, extents_, V3Neg(extents_));
+ }
+
+ //local space point
+ PX_FORCE_INLINE Ps::aos::Vec3V supportLocal(const Ps::aos::Vec3VArg dir)const
+ {
+ using namespace Ps::aos;
+
+ const Vec3V zero = V3Zero();
+ const Vec3V extents_ = V3Sub(extents, V3Splat(getMargin()));
+ const BoolV comp = V3IsGrtr(dir, zero);
+ return V3Sel(comp, extents_, V3Neg(extents_));
+ }
+
+ //local space point
+ PX_FORCE_INLINE Ps::aos::Vec3V supportLocal(const Ps::aos::Vec3VArg dir, PxI32& index, Ps::aos::FloatV* marginDif_)const
+ {
+ using namespace Ps::aos;
+
+ const Vec3V zero = V3Zero();
+ const Vec3V extents_ = V3Sub(extents, V3Splat(getMargin()));
+ const BoolV comp = V3IsGrtr(dir, zero);
+ getIndex(comp, index);
+ (*marginDif_) = marginDif;
+ return V3Sel(comp, extents_, V3Neg(extents_));
+ }
+
+ PX_FORCE_INLINE Ps::aos::Vec3V supportRelative(const Ps::aos::Vec3VArg dir, const Ps::aos::PsMatTransformV& aTob, const Ps::aos::PsMatTransformV& aTobT) const
+ {
+ using namespace Ps::aos;
+
+ //transfer dir into the local space of the box
+// const Vec3V dir_ =aTob.rotateInv(dir);//relTra.rotateInv(dir);
+ const Vec3V dir_ = aTobT.rotate(dir);//relTra.rotateInv(dir);
+ const Vec3V p = supportLocal(dir_);
+ return aTob.transform(p);//relTra.transform(p);//V3Add(center, M33MulV3(rot, p));
+ }
+
+ PX_FORCE_INLINE Ps::aos::Vec3V supportRelative( const Ps::aos::Vec3VArg dir, const Ps::aos::PsMatTransformV& aTob,
+ const Ps::aos::PsMatTransformV& aTobT, PxI32& index, Ps::aos::FloatV* marginDif_)const
+ {
+ using namespace Ps::aos;
+
+ //transfer dir into the local space of the box
+// const Vec3V dir_ =aTob.rotateInv(dir);//relTra.rotateInv(dir);
+ const Vec3V dir_ = aTobT.rotate(dir);//relTra.rotateInv(dir);
+ const Vec3V p = supportLocal(dir_, index, marginDif_);
+ return aTob.transform(p);//relTra.transform(p);//V3Add(center, M33MulV3(rot, p));
+ }
+
+ private:
+
+ PX_FORCE_INLINE void initialiseMarginDif()
+ {
+ using namespace Ps::aos;
+ //calculate the marginDif
+ const PxReal sqMargin = margin * margin;
+ const PxReal tempMarginDif = sqrtf(sqMargin * 3.f);
+ const PxReal marginDif_ = tempMarginDif - margin;
+ marginDif = FLoad(marginDif_);
+ /* const FloatV sqMargin = FMul(margin, margin);
+ const FloatV tempMarginDif = FSqrt(FAdd(sqMargin, FAdd(sqMargin, sqMargin)));
+ marginDif = FSub(tempMarginDif, margin);*/
+ }
+ };
+}
+
+}
+
+/** @} */
+#endif