A fast 2D and 3D game engine — TypeScript SDK, C++/WebAssembly core, visual editor. Ship one project to web, desktop, WeChat MiniGames, playable ads, and native Android / iOS.
TypeScript 2d-game-engine3d3d-game-engineandroidcppecsgame-editorgame-enginegamedeviostypescriptwebassemblywebglwebgpuwechat-minigame
// Copyright (c) 2001-2004 NovodeX AG. All rights reserved.
// Copyright (c) 2004-2008 AGEIA Technologies, Inc. All rights reserved.
// SPDX-FileCopyrightText: Copyright (c) 2008-2026 NVIDIA CORPORATION & AFFILIATES. All rights reserved.
// SPDX-License-Identifier: Apache-2.0
#include "foundation/PxMathUtils.h"
#include "extensions/PxD6JointCreate.h"
#include "extensions/PxD6Joint.h"
#include "extensions/PxFixedJoint.h"
#include "extensions/PxRevoluteJoint.h"
#include "extensions/PxSphericalJoint.h"
#include "extensions/PxPrismaticJoint.h"
#include "extensions/PxDistanceJoint.h"
#include "PxPhysics.h"
using namespace physx;
static const PxVec3 gX(1.0f, 0.0f, 0.0f);
PxJoint* physx::PxD6JointCreate_Fixed(PxPhysics& physics, PxRigidActor* actor0, const PxVec3& localPos0, PxRigidActor* actor1, const PxVec3& localPos1, bool useD6)
{
const PxTransform jointFrame0(localPos0);
const PxTransform jointFrame1(localPos1);
if(useD6)
// PT: by default all D6 axes are locked, i.e. it is a fixed joint.
return PxD6JointCreate(physics, actor0, jointFrame0, actor1, jointFrame1);
else
return PxFixedJointCreate(physics, actor0, jointFrame0, actor1, jointFrame1);
}
PxJoint* physx::PxD6JointCreate_Distance(PxPhysics& physics, PxRigidActor* actor0, const PxVec3& localPos0, PxRigidActor* actor1, const PxVec3& localPos1, float maxDist, bool useD6)
{
const PxTransform localFrame0(localPos0);
const PxTransform localFrame1(localPos1);
if(useD6)
{
PxD6Joint* j = PxD6JointCreate(physics, actor0, localFrame0, actor1, localFrame1);
j->setMotion(PxD6Axis::eTWIST, PxD6Motion::eFREE);
j->setMotion(PxD6Axis::eSWING1, PxD6Motion::eFREE);
j->setMotion(PxD6Axis::eSWING2, PxD6Motion::eFREE);
j->setMotion(PxD6Axis::eX, PxD6Motion::eLIMITED);
j->setMotion(PxD6Axis::eY, PxD6Motion::eLIMITED);
j->setMotion(PxD6Axis::eZ, PxD6Motion::eLIMITED);
j->setDistanceLimit(PxJointLinearLimit(maxDist));
return j;
}
else
{
PxDistanceJoint* j = PxDistanceJointCreate(physics, actor0, localFrame0, actor1, localFrame1);
j->setDistanceJointFlag(PxDistanceJointFlag::eMAX_DISTANCE_ENABLED, true);
j->setMaxDistance(maxDist);
return j;
}
}
PxJoint* physx::PxD6JointCreate_Prismatic(PxPhysics& physics, PxRigidActor* actor0, const PxVec3& localPos0, PxRigidActor* actor1, const PxVec3& localPos1, const PxVec3& axis, float minLimit, float maxLimit, bool useD6)
{
const PxQuat q = PxShortestRotation(gX, axis);
const PxTransform localFrame0(localPos0, q);
const PxTransform localFrame1(localPos1, q);
const PxJointLinearLimitPair limit(PxTolerancesScale(), minLimit, maxLimit);
if(useD6)
{
PxD6Joint* j = PxD6JointCreate(physics, actor0, localFrame0, actor1, localFrame1);
j->setMotion(PxD6Axis::eX, PxD6Motion::eFREE);
if(minLimit==maxLimit)
j->setMotion(PxD6Axis::eX, PxD6Motion::eLOCKED);
else if(minLimit>maxLimit)
j->setMotion(PxD6Axis::eX, PxD6Motion::eFREE);
else// if(minLimit<maxLimit)
{
j->setMotion(PxD6Axis::eX, PxD6Motion::eLIMITED);
j->setLinearLimit(PxD6Axis::eX, limit);
}
return j;
}
else
{
PxPrismaticJoint* j = PxPrismaticJointCreate(physics, actor0, localFrame0, actor1, localFrame1);
if(minLimit<maxLimit)
{
j->setPrismaticJointFlag(PxPrismaticJointFlag::eLIMIT_ENABLED, true);
j->setLimit(limit);
}
return j;
}
}
PxJoint* physx::PxD6JointCreate_Revolute(PxPhysics& physics, PxRigidActor* actor0, const PxVec3& localPos0, PxRigidActor* actor1, const PxVec3& localPos1, const PxVec3& axis, float minLimit, float maxLimit, bool useD6)
{
const PxQuat q = PxShortestRotation(gX, axis);
const PxTransform localFrame0(localPos0, q);
const PxTransform localFrame1(localPos1, q);
const PxJointAngularLimitPair limit(minLimit, maxLimit);
if(useD6)
{
PxD6Joint* j = PxD6JointCreate(physics, actor0, localFrame0, actor1, localFrame1);
if(minLimit==maxLimit)
j->setMotion(PxD6Axis::eTWIST, PxD6Motion::eLOCKED);
else if(minLimit>maxLimit)
j->setMotion(PxD6Axis::eTWIST, PxD6Motion::eFREE);
else// if(minLimit<maxLimit)
{
j->setMotion(PxD6Axis::eTWIST, PxD6Motion::eLIMITED);
j->setTwistLimit(limit);
}
return j;
}
else
{
PxRevoluteJoint* j = PxRevoluteJointCreate(physics, actor0, localFrame0, actor1, localFrame1);
if(minLimit<maxLimit)
{
j->setRevoluteJointFlag(PxRevoluteJointFlag::eLIMIT_ENABLED, true);
j->setLimit(limit);
}
return j;
}
}
PxJoint* physx::PxD6JointCreate_Spherical(PxPhysics& physics, PxRigidActor* actor0, const PxVec3& localPos0, PxRigidActor* actor1, const PxVec3& localPos1, const PxVec3& axis, float limit1, float limit2, bool useD6)
{
const PxQuat q = PxShortestRotation(gX, axis);
const PxTransform localFrame0(localPos0, q);
const PxTransform localFrame1(localPos1, q);
const PxJointLimitCone limit(limit1, limit2);
if(useD6)
{
PxD6Joint* j = PxD6JointCreate(physics, actor0, localFrame0, actor1, localFrame1);
j->setMotion(PxD6Axis::eTWIST, PxD6Motion::eFREE);
if(limit1>0.0f && limit2>0.0f)
{
j->setMotion(PxD6Axis::eSWING1, PxD6Motion::eLIMITED);
j->setMotion(PxD6Axis::eSWING2, PxD6Motion::eLIMITED);
j->setSwingLimit(limit);
}
else
{
j->setMotion(PxD6Axis::eSWING1, PxD6Motion::eFREE);
j->setMotion(PxD6Axis::eSWING2, PxD6Motion::eFREE);
}
return j;
}
else
{
PxSphericalJoint* j = PxSphericalJointCreate(physics, actor0, localFrame0, actor1, localFrame1);
if(limit1>0.0f && limit2>0.0f)
{
j->setSphericalJointFlag(PxSphericalJointFlag::eLIMIT_ENABLED, true);
j->setLimitCone(limit);
}
return j;
}
}
PxJoint* physx::PxD6JointCreate_GenericCone(float& apiroty, float& apirotz, PxPhysics& physics, PxRigidActor* actor0, const PxVec3& localPos0, PxRigidActor* actor1, const PxVec3& localPos1, float minLimit1, float maxLimit1, float minLimit2, float maxLimit2, bool useD6)
{
const float DesiredMinSwingY = minLimit1;
const float DesiredMaxSwingY = maxLimit1;
const float DesiredMinSwingZ = minLimit2;
const float DesiredMaxSwingZ = maxLimit2;
const float APIMaxY = (DesiredMaxSwingY - DesiredMinSwingY)*0.5f;
const float APIMaxZ = (DesiredMaxSwingZ - DesiredMinSwingZ)*0.5f;
const float APIRotY = (DesiredMaxSwingY + DesiredMinSwingY)*0.5f;
const float APIRotZ = (DesiredMaxSwingZ + DesiredMinSwingZ)*0.5f;
apiroty = APIRotY;
apirotz = APIRotZ;
const PxQuat RotY = PxGetRotYQuat(APIRotY);
const PxQuat RotZ = PxGetRotZQuat(APIRotZ);
const PxQuat Rot = RotY * RotZ;
const PxTransform localFrame0(localPos0, Rot);
const PxTransform localFrame1(localPos1);
const PxJointLimitCone limit(APIMaxY, APIMaxZ);
if(useD6)
{
PxD6Joint* j = PxD6JointCreate(physics, actor0, localFrame0, actor1, localFrame1);
j->setMotion(PxD6Axis::eTWIST, PxD6Motion::eFREE);
j->setMotion(PxD6Axis::eSWING1, PxD6Motion::eLIMITED);
j->setMotion(PxD6Axis::eSWING2, PxD6Motion::eLIMITED);
j->setSwingLimit(limit);
return j;
}
else
{
PxSphericalJoint* j = PxSphericalJointCreate(physics, actor0, localFrame0, actor1, localFrame1);
j->setSphericalJointFlag(PxSphericalJointFlag::eLIMIT_ENABLED, true);
j->setLimitCone(limit);
return j;
}
}
PxJoint* physx::PxD6JointCreate_Pyramid(PxPhysics& physics, PxRigidActor* actor0, const PxVec3& localPos0, PxRigidActor* actor1, const PxVec3& localPos1, const PxVec3& axis,
float minLimit1, float maxLimit1, float minLimit2, float maxLimit2)
{
const PxQuat q = PxShortestRotation(gX, axis);
const PxTransform localFrame0(localPos0, q);
const PxTransform localFrame1(localPos1, q);
const PxJointLimitPyramid limit(minLimit1, maxLimit1, minLimit2, maxLimit2);
PxD6Joint* j = PxD6JointCreate(physics, actor0, localFrame0, actor1, localFrame1);
j->setMotion(PxD6Axis::eTWIST, PxD6Motion::eFREE);
if(limit.isValid())
{
j->setMotion(PxD6Axis::eSWING1, PxD6Motion::eLIMITED);
j->setMotion(PxD6Axis::eSWING2, PxD6Motion::eLIMITED);
j->setPyramidSwingLimit(limit);
}
else
{
j->setMotion(PxD6Axis::eSWING1, PxD6Motion::eFREE);
j->setMotion(PxD6Axis::eSWING2, PxD6Motion::eFREE);
}
return j;
}