You cannot select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
96 lines
2.9 KiB
C++
96 lines
2.9 KiB
C++
/*
|
|
* Copyright (c) Contributors to the Open 3D Engine Project. For complete copyright and license terms please see the LICENSE at the root of this distribution.
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0 OR MIT
|
|
*
|
|
*/
|
|
|
|
#include <PhysX_precompiled.h>
|
|
|
|
#include <Source/HingeJointComponent.h>
|
|
#include <PhysX/MathConversion.h>
|
|
#include <PhysX/PhysXLocks.h>
|
|
#include <AzCore/Component/TransformBus.h>
|
|
#include <AzFramework/Physics/RigidBodyBus.h>
|
|
#include <AzFramework/Physics/SimulatedBodies/RigidBody.h>
|
|
|
|
#include <PxPhysicsAPI.h>
|
|
|
|
namespace PhysX
|
|
{
|
|
void HingeJointComponent::Reflect(AZ::ReflectContext* context)
|
|
{
|
|
AZ::SerializeContext* serializeContext = azrtti_cast<AZ::SerializeContext*>(context);
|
|
if (serializeContext)
|
|
{
|
|
serializeContext->Class<HingeJointComponent, JointComponent>()
|
|
->Version(2)
|
|
;
|
|
}
|
|
}
|
|
|
|
HingeJointComponent::HingeJointComponent(const GenericJointConfiguration& config
|
|
, const GenericJointLimitsConfiguration& angularLimitConfig)
|
|
: JointComponent(config, angularLimitConfig)
|
|
{
|
|
}
|
|
|
|
void HingeJointComponent::InitNativeJoint()
|
|
{
|
|
if (m_joint)
|
|
{
|
|
return;
|
|
}
|
|
|
|
JointComponent::LeadFollowerInfo leadFollowerInfo;
|
|
ObtainLeadFollowerInfo(leadFollowerInfo);
|
|
if (!leadFollowerInfo.m_followerActor)
|
|
{
|
|
return;
|
|
}
|
|
PHYSX_SCENE_READ_LOCK(leadFollowerInfo.m_followerActor->getScene());
|
|
m_joint = AZStd::make_shared<HingeJoint>(physx::PxRevoluteJointCreate(
|
|
PxGetPhysics(),
|
|
leadFollowerInfo.m_leadActor,
|
|
leadFollowerInfo.m_leadLocal,
|
|
leadFollowerInfo.m_followerActor,
|
|
leadFollowerInfo.m_followerLocal),
|
|
leadFollowerInfo.m_leadBody,
|
|
leadFollowerInfo.m_followerBody);
|
|
|
|
InitAngularLimits();
|
|
}
|
|
|
|
void HingeJointComponent::InitAngularLimits()
|
|
{
|
|
if (!m_joint)
|
|
{
|
|
return;
|
|
}
|
|
|
|
physx::PxRevoluteJoint* revoluteJointNative = static_cast<physx::PxRevoluteJoint*>(m_joint->GetNativePointer());
|
|
if (!revoluteJointNative)
|
|
{
|
|
return;
|
|
}
|
|
|
|
if (!m_limits.m_isLimited)
|
|
{
|
|
revoluteJointNative->setRevoluteJointFlag(physx::PxRevoluteJointFlag::eLIMIT_ENABLED, false);
|
|
return;
|
|
}
|
|
|
|
physx::PxJointAngularLimitPair limitPair(AZ::DegToRad(m_limits.m_limitSecond)
|
|
, AZ::DegToRad(m_limits.m_limitFirst)
|
|
, m_limits.m_tolerance);
|
|
if (m_limits.m_isSoftLimit)
|
|
{
|
|
limitPair.stiffness = m_limits.m_stiffness;
|
|
limitPair.damping = m_limits.m_damping;
|
|
}
|
|
|
|
revoluteJointNative->setLimit(limitPair);
|
|
revoluteJointNative->setRevoluteJointFlag(physx::PxRevoluteJointFlag::eLIMIT_ENABLED, true);
|
|
}
|
|
} // namespace PhysX
|