1843 lines
61 KiB
C++
1843 lines
61 KiB
C++
//========= Copyright Valve Corporation, All rights reserved. ============//
|
|
//
|
|
// Purpose:
|
|
//
|
|
// $NoKeywords: $
|
|
//
|
|
//=============================================================================//
|
|
#include "cbase.h"
|
|
#include "vcollide_parse.h"
|
|
|
|
#include "ivp_listener_object.hxx"
|
|
#include "vphysics/constraints.h"
|
|
#include "isaverestore.h"
|
|
|
|
// HACKHACK: Mathlib defines this too!
|
|
#undef clamp
|
|
#undef max
|
|
#undef min
|
|
|
|
// There's some constructor problems in the hk stuff...
|
|
// The classes inherit from other classes with private constructor
|
|
#pragma warning (disable : 4510 )
|
|
#pragma warning (disable : 4610 )
|
|
|
|
// new havana constraint class
|
|
#include "hk_physics/physics.h"
|
|
#include "hk_physics/constraint/constraint.h"
|
|
|
|
#include "hk_physics/constraint/breakable_constraint/breakable_constraint_bp.h"
|
|
#include "hk_physics/constraint/breakable_constraint/breakable_constraint.h"
|
|
#include "hk_physics/constraint/limited_ball_socket/limited_ball_socket_bp.h"
|
|
#include "hk_physics/constraint/limited_ball_socket/limited_ball_socket_constraint.h"
|
|
#include "hk_physics/constraint/fixed/fixed_bp.h"
|
|
#include "hk_physics/constraint/fixed/fixed_constraint.h"
|
|
#include "hk_physics/constraint/stiff_spring/stiff_spring_bp.h"
|
|
#include "hk_physics/constraint/stiff_spring/stiff_spring_constraint.h"
|
|
|
|
#include "hk_physics/constraint/ball_socket/ball_socket_bp.h"
|
|
#include "hk_physics/constraint/ball_socket/ball_socket_constraint.h"
|
|
|
|
#include "hk_physics/constraint/prismatic/prismatic_bp.h"
|
|
#include "hk_physics/constraint/prismatic/prismatic_constraint.h"
|
|
|
|
#include "hk_physics/constraint/ragdoll/ragdoll_constraint.h"
|
|
#include "hk_physics/constraint/ragdoll/ragdoll_constraint_bp.h"
|
|
#include "hk_physics/constraint/ragdoll/ragdoll_constraint_bp_builder.h"
|
|
|
|
#include "hk_physics/constraint/hinge/hinge_constraint.h"
|
|
#include "hk_physics/constraint/hinge/hinge_bp.h"
|
|
#include "hk_physics/constraint/hinge/hinge_bp_builder.h"
|
|
|
|
#include "hk_physics/constraint/pulley/pulley_constraint.h"
|
|
#include "hk_physics/constraint/pulley/pulley_bp.h"
|
|
|
|
#include "hk_physics/constraint/local_constraint_system/local_constraint_system.h"
|
|
#include "hk_physics/constraint/local_constraint_system/local_constraint_system_bp.h"
|
|
|
|
#include "ivp_cache_object.hxx"
|
|
#include "ivp_template_constraint.hxx"
|
|
extern void qh_srand( int seed);
|
|
#include "qhull_user.hxx"
|
|
|
|
// memdbgon must be the last include file in a .cpp file!!!
|
|
#include "tier0/memdbgon.h"
|
|
|
|
|
|
const float UNBREAKABLE_BREAK_LIMIT = 1e12f;
|
|
|
|
hk_Vector3 TransformHLWorldToHavanaLocal( const Vector &hlWorld, IVP_Real_Object *pObject )
|
|
{
|
|
IVP_U_Float_Point tmp;
|
|
IVP_U_Point pointOut;
|
|
ConvertPositionToIVP( hlWorld, tmp );
|
|
|
|
TransformIVPToLocal( tmp, pointOut, pObject, true );
|
|
return hk_Vector3( pointOut.k[0], pointOut.k[1], pointOut.k[2] );
|
|
}
|
|
|
|
Vector TransformHavanaLocalToHLWorld( const hk_Vector3 &input, IVP_Real_Object *pObject, bool translate )
|
|
{
|
|
IVP_U_Float_Point ivpLocal( input.x, input.y, input.z );
|
|
IVP_U_Float_Point ivpWorld;
|
|
|
|
TransformLocalToIVP( ivpLocal, ivpWorld, pObject, translate );
|
|
|
|
Vector hlOut;
|
|
if ( translate )
|
|
{
|
|
ConvertPositionToHL( ivpWorld, hlOut );
|
|
}
|
|
else
|
|
{
|
|
ConvertDirectionToHL( ivpWorld, hlOut );
|
|
}
|
|
return hlOut;
|
|
}
|
|
|
|
inline hk_Vector3 vec( const IVP_U_Point &point )
|
|
{
|
|
hk_Vector3 tmp(point.k[0], point.k[1], point.k[2] );
|
|
return tmp;
|
|
}
|
|
|
|
// UNDONE: if vector were aligned we could simply cast these.
|
|
inline hk_Vector3 vec( const Vector &point )
|
|
{
|
|
hk_Vector3 tmp(point.x, point.y, point.z );
|
|
return tmp;
|
|
}
|
|
|
|
void ConvertHLLocalMatrixToHavanaLocal( const matrix3x4_t& hlMatrix, hk_Transform &out )
|
|
{
|
|
IVP_U_Matrix ivpMatrix;
|
|
ConvertMatrixToIVP( hlMatrix, ivpMatrix );
|
|
ivpMatrix.get_4x4_column_major( (hk_real *)&out );
|
|
}
|
|
|
|
void set_4x4_column_major( IVP_U_Matrix &ivpMatrix, const float *in4x4 )
|
|
{
|
|
ivpMatrix.set_elem( 0, 0, in4x4[0] );
|
|
ivpMatrix.set_elem( 1, 0, in4x4[1] );
|
|
ivpMatrix.set_elem( 2, 0, in4x4[2] );
|
|
|
|
ivpMatrix.set_elem( 0, 1, in4x4[4] );
|
|
ivpMatrix.set_elem( 1, 1, in4x4[5] );
|
|
ivpMatrix.set_elem( 2, 1, in4x4[6] );
|
|
|
|
ivpMatrix.set_elem( 0, 2, in4x4[8] );
|
|
ivpMatrix.set_elem( 1, 2, in4x4[9] );
|
|
ivpMatrix.set_elem( 2, 2, in4x4[10] );
|
|
|
|
ivpMatrix.vv.k[0] = in4x4[12];
|
|
ivpMatrix.vv.k[1] = in4x4[13];
|
|
ivpMatrix.vv.k[2] = in4x4[14];
|
|
}
|
|
|
|
inline void ConvertPositionToIVP( const Vector &point, hk_Vector3 &out )
|
|
{
|
|
IVP_U_Float_Point ivp;
|
|
ConvertPositionToIVP( point, ivp );
|
|
out = vec( ivp );
|
|
}
|
|
|
|
inline void ConvertPositionToHL( const hk_Vector3 &point, Vector& out )
|
|
{
|
|
float tmpY = IVP2HL(point.z);
|
|
out.z = -IVP2HL(point.y);
|
|
out.y = tmpY;
|
|
out.x = IVP2HL(point.x);
|
|
}
|
|
|
|
inline void ConvertDirectionToHL( const hk_Vector3 &point, Vector& out )
|
|
{
|
|
float tmpY = point.z;
|
|
out.z = -point.y;
|
|
out.y = tmpY;
|
|
out.x = point.x;
|
|
}
|
|
|
|
void ConvertHavanaLocalMatrixToHL( const hk_Transform &in, matrix3x4_t& hlMatrix, IVP_Real_Object *pObject )
|
|
{
|
|
IVP_U_Matrix ivpMatrix;
|
|
set_4x4_column_major( ivpMatrix, (const hk_real *)&in );
|
|
ConvertMatrixToHL( ivpMatrix, hlMatrix );
|
|
}
|
|
|
|
static bool IsBreakableConstraint( const constraint_breakableparams_t &constraint )
|
|
{
|
|
return ( (constraint.forceLimit != 0 && constraint.forceLimit < UNBREAKABLE_BREAK_LIMIT) ||
|
|
(constraint.torqueLimit != 0 && constraint.torqueLimit < UNBREAKABLE_BREAK_LIMIT) ||
|
|
(constraint.bodyMassScale[0] != 1.0f && constraint.bodyMassScale[0] != 0.0f) ||
|
|
(constraint.bodyMassScale[1] != 1.0f && constraint.bodyMassScale[1] != 0.0f) ) ? true : false;
|
|
}
|
|
|
|
struct vphysics_save_cphysicsconstraintgroup_t : public constraint_groupparams_t
|
|
{
|
|
bool isActive;
|
|
DECLARE_SIMPLE_DATADESC();
|
|
};
|
|
|
|
BEGIN_SIMPLE_DATADESC( vphysics_save_cphysicsconstraintgroup_t )
|
|
DEFINE_FIELD( isActive, FIELD_BOOLEAN ),
|
|
DEFINE_FIELD( additionalIterations, FIELD_INTEGER ),
|
|
DEFINE_FIELD( minErrorTicks, FIELD_INTEGER ),
|
|
DEFINE_FIELD( errorTolerance, FIELD_FLOAT ),
|
|
END_DATADESC()
|
|
|
|
// a little list that holds active groups so they can activate after
|
|
// the constraints are restored and added to the groups
|
|
static CUtlVector<CPhysicsConstraintGroup *> g_ConstraintGroupActivateList;
|
|
|
|
class CPhysicsConstraintGroup: public IPhysicsConstraintGroup
|
|
{
|
|
public:
|
|
hk_Local_Constraint_System *GetLCS() { return m_pLCS; }
|
|
|
|
void WriteToTemplate( vphysics_save_cphysicsconstraintgroup_t &groupParams )
|
|
{
|
|
hk_Local_Constraint_System_BP bp;
|
|
m_pLCS->write_to_blueprint( &bp );
|
|
groupParams.additionalIterations = bp.m_n_iterations;
|
|
groupParams.isActive = bp.m_active;
|
|
groupParams.minErrorTicks = bp.m_minErrorTicks;
|
|
groupParams.errorTolerance = ConvertDistanceToHL(bp.m_errorTolerance);
|
|
}
|
|
|
|
public:
|
|
CPhysicsConstraintGroup( IVP_Environment *pEnvironment, const constraint_groupparams_t &group );
|
|
~CPhysicsConstraintGroup();
|
|
virtual void Activate();
|
|
virtual bool IsInErrorState();
|
|
virtual void ClearErrorState();
|
|
void GetErrorParams( constraint_groupparams_t *pParams );
|
|
void SetErrorParams( const constraint_groupparams_t ¶ms );
|
|
void SolvePenetration( IPhysicsObject *pObj0, IPhysicsObject *pObj1 );
|
|
|
|
private:
|
|
hk_Local_Constraint_System *m_pLCS;
|
|
};
|
|
|
|
void CPhysicsConstraintGroup::Activate()
|
|
{
|
|
if (m_pLCS)
|
|
{
|
|
m_pLCS->activate();
|
|
}
|
|
}
|
|
|
|
bool CPhysicsConstraintGroup::IsInErrorState()
|
|
{
|
|
if (m_pLCS)
|
|
{
|
|
return m_pLCS->has_error();
|
|
}
|
|
return false;
|
|
}
|
|
|
|
void CPhysicsConstraintGroup::ClearErrorState()
|
|
{
|
|
if (m_pLCS)
|
|
{
|
|
m_pLCS->clear_error();
|
|
}
|
|
}
|
|
|
|
void CPhysicsConstraintGroup::GetErrorParams( constraint_groupparams_t *pParams )
|
|
{
|
|
if ( !m_pLCS )
|
|
return;
|
|
|
|
vphysics_save_cphysicsconstraintgroup_t tmp;
|
|
WriteToTemplate( tmp );
|
|
*pParams = tmp;
|
|
}
|
|
|
|
|
|
void CPhysicsConstraintGroup::SetErrorParams( const constraint_groupparams_t ¶ms )
|
|
{
|
|
if ( !m_pLCS )
|
|
return;
|
|
|
|
m_pLCS->set_error_ticks( params.minErrorTicks );
|
|
m_pLCS->set_error_tolerance( ConvertDistanceToIVP(params.errorTolerance) );
|
|
}
|
|
|
|
void CPhysicsConstraintGroup::SolvePenetration( IPhysicsObject *pObj0, IPhysicsObject *pObj1 )
|
|
{
|
|
if ( m_pLCS && pObj0 && pObj1 )
|
|
{
|
|
CPhysicsObject *pPhys0 = static_cast<CPhysicsObject *>(pObj0);
|
|
CPhysicsObject *pPhys1 = static_cast<CPhysicsObject *>(pObj1);
|
|
m_pLCS->solve_penetration(pPhys0->GetObject(), pPhys1->GetObject());
|
|
}
|
|
}
|
|
|
|
|
|
CPhysicsConstraintGroup::~CPhysicsConstraintGroup()
|
|
{
|
|
delete m_pLCS;
|
|
}
|
|
|
|
|
|
CPhysicsConstraintGroup::CPhysicsConstraintGroup( IVP_Environment *pEnvironment, const constraint_groupparams_t &group )
|
|
{
|
|
hk_Local_Constraint_System_BP cs_bp;
|
|
cs_bp.m_n_iterations = group.additionalIterations;
|
|
cs_bp.m_minErrorTicks = group.minErrorTicks;
|
|
cs_bp.m_errorTolerance = ConvertDistanceToIVP(group.errorTolerance);
|
|
m_pLCS = new hk_Local_Constraint_System( static_cast<hk_Environment *>(pEnvironment), &cs_bp );
|
|
m_pLCS->set_client_data( (void *)this );
|
|
}
|
|
|
|
enum vphysics_save_constrainttypes_t
|
|
{
|
|
CONSTRAINT_UNKNOWN = 0,
|
|
CONSTRAINT_RAGDOLL,
|
|
CONSTRAINT_HINGE,
|
|
CONSTRAINT_FIXED,
|
|
CONSTRAINT_BALLSOCKET,
|
|
CONSTRAINT_SLIDING,
|
|
CONSTRAINT_PULLEY,
|
|
CONSTRAINT_LENGTH,
|
|
};
|
|
|
|
struct vphysics_save_cphysicsconstraint_t
|
|
{
|
|
int constraintType;
|
|
CPhysicsConstraintGroup *pGroup;
|
|
CPhysicsObject *pObjReference;
|
|
CPhysicsObject *pObjAttached;
|
|
DECLARE_SIMPLE_DATADESC();
|
|
};
|
|
|
|
BEGIN_SIMPLE_DATADESC( vphysics_save_cphysicsconstraint_t )
|
|
DEFINE_FIELD( constraintType, FIELD_INTEGER ),
|
|
DEFINE_VPHYSPTR( pGroup ),
|
|
DEFINE_VPHYSPTR( pObjReference ),
|
|
DEFINE_VPHYSPTR( pObjAttached ),
|
|
END_DATADESC()
|
|
|
|
struct vphysics_save_constraintbreakable_t : public constraint_breakableparams_t
|
|
{
|
|
DECLARE_SIMPLE_DATADESC();
|
|
};
|
|
|
|
BEGIN_SIMPLE_DATADESC( vphysics_save_constraintbreakable_t )
|
|
DEFINE_FIELD( strength, FIELD_FLOAT ),
|
|
DEFINE_FIELD( forceLimit, FIELD_FLOAT ),
|
|
DEFINE_FIELD( torqueLimit, FIELD_FLOAT ),
|
|
DEFINE_AUTO_ARRAY( bodyMassScale, FIELD_FLOAT ),
|
|
DEFINE_FIELD( isActive, FIELD_BOOLEAN ),
|
|
END_DATADESC()
|
|
|
|
struct vphysics_save_constraintaxislimit_t : public constraint_axislimit_t
|
|
{
|
|
DECLARE_SIMPLE_DATADESC();
|
|
};
|
|
|
|
BEGIN_SIMPLE_DATADESC( vphysics_save_constraintaxislimit_t )
|
|
DEFINE_FIELD( minRotation, FIELD_FLOAT ),
|
|
DEFINE_FIELD( maxRotation, FIELD_FLOAT ),
|
|
DEFINE_FIELD( angularVelocity, FIELD_FLOAT ),
|
|
DEFINE_FIELD( torque, FIELD_FLOAT ),
|
|
END_DATADESC()
|
|
|
|
struct vphysics_save_constraintfixed_t : public constraint_fixedparams_t
|
|
{
|
|
DECLARE_SIMPLE_DATADESC();
|
|
};
|
|
|
|
BEGIN_SIMPLE_DATADESC( vphysics_save_constraintfixed_t )
|
|
DEFINE_AUTO_ARRAY2D( attachedRefXform, FIELD_FLOAT ),
|
|
DEFINE_EMBEDDED_OVERRIDE( constraint, vphysics_save_constraintbreakable_t ),
|
|
END_DATADESC()
|
|
|
|
struct vphysics_save_constrainthinge_t : public constraint_hingeparams_t
|
|
{
|
|
DECLARE_SIMPLE_DATADESC();
|
|
};
|
|
|
|
BEGIN_SIMPLE_DATADESC( vphysics_save_constrainthinge_t )
|
|
DEFINE_FIELD( worldPosition, FIELD_POSITION_VECTOR ),
|
|
DEFINE_FIELD( worldAxisDirection, FIELD_VECTOR ),
|
|
DEFINE_EMBEDDED_OVERRIDE( constraint, vphysics_save_constraintbreakable_t ),
|
|
DEFINE_EMBEDDED_OVERRIDE( hingeAxis, vphysics_save_constraintaxislimit_t ),
|
|
END_DATADESC()
|
|
|
|
struct vphysics_save_constraintsliding_t : public constraint_slidingparams_t
|
|
{
|
|
DECLARE_SIMPLE_DATADESC();
|
|
};
|
|
|
|
BEGIN_SIMPLE_DATADESC( vphysics_save_constraintsliding_t )
|
|
DEFINE_AUTO_ARRAY2D( attachedRefXform, FIELD_FLOAT ),
|
|
DEFINE_FIELD( slideAxisRef, FIELD_VECTOR ),
|
|
DEFINE_FIELD( limitMin, FIELD_FLOAT ),
|
|
DEFINE_FIELD( limitMax, FIELD_FLOAT ),
|
|
DEFINE_FIELD( friction, FIELD_FLOAT ),
|
|
DEFINE_FIELD( velocity, FIELD_FLOAT ),
|
|
DEFINE_EMBEDDED_OVERRIDE( constraint, vphysics_save_constraintbreakable_t ),
|
|
END_DATADESC()
|
|
|
|
struct vphysics_save_constraintpulley_t : public constraint_pulleyparams_t
|
|
{
|
|
DECLARE_SIMPLE_DATADESC();
|
|
};
|
|
|
|
BEGIN_SIMPLE_DATADESC( vphysics_save_constraintpulley_t )
|
|
DEFINE_AUTO_ARRAY( pulleyPosition, FIELD_POSITION_VECTOR ),
|
|
DEFINE_AUTO_ARRAY( objectPosition, FIELD_VECTOR ),
|
|
DEFINE_FIELD( totalLength, FIELD_FLOAT ),
|
|
DEFINE_FIELD( gearRatio, FIELD_FLOAT ),
|
|
DEFINE_FIELD( isRigid, FIELD_BOOLEAN ),
|
|
DEFINE_EMBEDDED_OVERRIDE( constraint, vphysics_save_constraintbreakable_t ),
|
|
END_DATADESC()
|
|
|
|
struct vphysics_save_constraintlength_t : public constraint_lengthparams_t
|
|
{
|
|
DECLARE_SIMPLE_DATADESC();
|
|
};
|
|
|
|
BEGIN_SIMPLE_DATADESC( vphysics_save_constraintlength_t )
|
|
DEFINE_AUTO_ARRAY( objectPosition, FIELD_VECTOR ),
|
|
DEFINE_FIELD( totalLength, FIELD_FLOAT ),
|
|
DEFINE_FIELD( minLength, FIELD_FLOAT ),
|
|
DEFINE_EMBEDDED_OVERRIDE( constraint, vphysics_save_constraintbreakable_t ),
|
|
END_DATADESC()
|
|
|
|
struct vphysics_save_constraintballsocket_t : public constraint_ballsocketparams_t
|
|
{
|
|
DECLARE_SIMPLE_DATADESC();
|
|
};
|
|
|
|
BEGIN_SIMPLE_DATADESC( vphysics_save_constraintballsocket_t )
|
|
DEFINE_AUTO_ARRAY( constraintPosition, FIELD_VECTOR ),
|
|
DEFINE_EMBEDDED_OVERRIDE( constraint, vphysics_save_constraintbreakable_t ),
|
|
END_DATADESC()
|
|
|
|
struct vphysics_save_constraintragdoll_t : public constraint_ragdollparams_t
|
|
{
|
|
DECLARE_SIMPLE_DATADESC();
|
|
};
|
|
|
|
BEGIN_SIMPLE_DATADESC( vphysics_save_constraintragdoll_t )
|
|
DEFINE_EMBEDDED_OVERRIDE( constraint, vphysics_save_constraintbreakable_t ),
|
|
DEFINE_AUTO_ARRAY2D( constraintToReference, FIELD_FLOAT ),
|
|
DEFINE_AUTO_ARRAY2D( constraintToAttached, FIELD_FLOAT ),
|
|
DEFINE_EMBEDDED_OVERRIDE( axes[0], vphysics_save_constraintaxislimit_t ),
|
|
DEFINE_EMBEDDED_OVERRIDE( axes[1], vphysics_save_constraintaxislimit_t ),
|
|
DEFINE_EMBEDDED_OVERRIDE( axes[2], vphysics_save_constraintaxislimit_t ),
|
|
DEFINE_FIELD( onlyAngularLimits, FIELD_BOOLEAN ),
|
|
DEFINE_FIELD( isActive, FIELD_BOOLEAN ),
|
|
DEFINE_FIELD( useClockwiseRotations, FIELD_BOOLEAN ),
|
|
END_DATADESC()
|
|
|
|
struct vphysics_save_constraint_t
|
|
{
|
|
vphysics_save_constraintfixed_t fixed;
|
|
vphysics_save_constrainthinge_t hinge;
|
|
vphysics_save_constraintsliding_t sliding;
|
|
vphysics_save_constraintpulley_t pulley;
|
|
vphysics_save_constraintlength_t length;
|
|
vphysics_save_constraintballsocket_t ballsocket;
|
|
vphysics_save_constraintragdoll_t ragdoll;
|
|
};
|
|
|
|
// UNDONE: May need to change interface to specify limits before construction
|
|
// UNDONE: Refactor constraints to contain a separate object for the various constraint types?
|
|
class CPhysicsConstraint: public IPhysicsConstraint, public IVP_Listener_Object
|
|
{
|
|
public:
|
|
CPhysicsConstraint( CPhysicsObject *pReferenceObject, CPhysicsObject *pAttachedObject );
|
|
~CPhysicsConstraint( void );
|
|
|
|
// init as ragdoll constraint
|
|
void InitRagdoll( IVP_Environment *pEnvironment, CPhysicsConstraintGroup *constraint_group, const constraint_ragdollparams_t &ragdoll );
|
|
// init as hinge
|
|
void InitHinge( IVP_Environment *pEnvironment, CPhysicsConstraintGroup *constraint_group, const constraint_limitedhingeparams_t &hinge );
|
|
// init as fixed (BUGBUG: This is broken)
|
|
void InitFixed( IVP_Environment *pEnvironment, CPhysicsConstraintGroup *constraint_group, const constraint_fixedparams_t &fixed );
|
|
// init as ballsocket
|
|
void InitBallsocket( IVP_Environment *pEnvironment, CPhysicsConstraintGroup *constraint_group, const constraint_ballsocketparams_t &ballsocket );
|
|
// init as sliding constraint
|
|
void InitSliding( IVP_Environment *pEnvironment, CPhysicsConstraintGroup *constraint_group, const constraint_slidingparams_t &sliding );
|
|
// init as pulley
|
|
void InitPulley( IVP_Environment *pEnvironment, CPhysicsConstraintGroup *constraint_group, const constraint_pulleyparams_t &pulley );
|
|
// init as stiff spring / length constraint
|
|
void InitLength( IVP_Environment *pEnvironment, CPhysicsConstraintGroup *constraint_group, const constraint_lengthparams_t &length );
|
|
|
|
void WriteToTemplate( vphysics_save_cphysicsconstraint_t &header, vphysics_save_constraint_t &constraintTemplate ) const;
|
|
|
|
void WriteRagdoll( constraint_ragdollparams_t &ragdoll ) const;
|
|
void WriteHinge( constraint_hingeparams_t &hinge ) const;
|
|
void WriteFixed( constraint_fixedparams_t &fixed ) const;
|
|
void WriteSliding( constraint_slidingparams_t &sliding ) const;
|
|
void WriteBallsocket( constraint_ballsocketparams_t &ballsocket ) const;
|
|
void WritePulley( constraint_pulleyparams_t &pulley ) const;
|
|
void WriteLength( constraint_lengthparams_t &length ) const;
|
|
CPhysicsConstraintGroup *GetConstraintGroup() const;
|
|
|
|
hk_Constraint *CreateBreakableConstraint( hk_Constraint *pRealConstraint, hk_Local_Constraint_System *pLcs, const constraint_breakableparams_t &constraint )
|
|
{
|
|
m_isBreakable = true;
|
|
hk_Breakable_Constraint_BP bp;
|
|
bp.m_real_constraint = pRealConstraint;
|
|
float forceLimit = ConvertDistanceToIVP( constraint.forceLimit );
|
|
bp.m_linear_strength = forceLimit > 0 ? forceLimit : UNBREAKABLE_BREAK_LIMIT;
|
|
bp.m_angular_strength = constraint.torqueLimit > 0 ? DEG2RAD(constraint.torqueLimit) : UNBREAKABLE_BREAK_LIMIT;
|
|
bp.m_bodyMassScale[0] = constraint.bodyMassScale[0] > 0 ? constraint.bodyMassScale[0] : 1.0f;
|
|
bp.m_bodyMassScale[1] = constraint.bodyMassScale[1] > 0 ? constraint.bodyMassScale[1] : 1.0f;;
|
|
return new hk_Breakable_Constraint( pLcs, &bp );
|
|
}
|
|
void ReadBreakableConstraint( constraint_breakableparams_t ¶ms ) const;
|
|
|
|
hk_Constraint *GetRealConstraint() const
|
|
{
|
|
if ( m_isBreakable )
|
|
{
|
|
hk_Breakable_Constraint_BP bp;
|
|
((hk_Breakable_Constraint *)m_HkConstraint)->write_to_blueprint( &bp );
|
|
return bp.m_real_constraint;
|
|
}
|
|
return m_HkConstraint;
|
|
}
|
|
|
|
void Activate( void );
|
|
void Deactivate( void );
|
|
void SetupRagdollAxis( int axis, const constraint_axislimit_t &axisData, hk_Limited_Ball_Socket_BP *ballsocketBP );
|
|
// UNDONE: Implement includeStatic for havana
|
|
|
|
void SetGameData( void *gameData ) { m_pGameData = gameData; }
|
|
void *GetGameData( void ) const { return m_pGameData; }
|
|
IPhysicsObject *GetReferenceObject( void ) const;
|
|
IPhysicsObject *GetAttachedObject( void ) const;
|
|
|
|
void SetLinearMotor( float speed, float maxForce );
|
|
void SetAngularMotor( float rotSpeed, float maxAngularImpulse );
|
|
void UpdateRagdollTransforms( const matrix3x4_t &constraintToReference, const matrix3x4_t &constraintToAttached );
|
|
bool GetConstraintTransform( matrix3x4_t *pConstraintToReference, matrix3x4_t *pConstraintToAttached ) const;
|
|
bool GetConstraintParams( constraint_breakableparams_t *pParams ) const;
|
|
void OutputDebugInfo()
|
|
{
|
|
hk_Local_Constraint_System *pLCS = m_HkLCS;
|
|
if ( m_HkConstraint )
|
|
{
|
|
pLCS = m_HkConstraint->get_constraint_system();
|
|
}
|
|
if ( pLCS )
|
|
{
|
|
int count = 0;
|
|
hk_Array<hk_Constraint *> list;
|
|
pLCS->get_constraints_in_system( list );
|
|
Msg("System of %d constraints\n", list.length());
|
|
for ( hk_Array<hk_Constraint*>::iterator i = list.start(); list.is_valid(i); i = list.next(i) )
|
|
{
|
|
hk_Constraint *pConstraint = list.get_element(i);
|
|
Msg("\tConstraint %d) %s\n", count, pConstraint->get_constraint_type() );
|
|
count++;
|
|
}
|
|
}
|
|
}
|
|
|
|
void DetachListener();
|
|
// Object listener
|
|
virtual void event_object_deleted( IVP_Event_Object *);
|
|
virtual void event_object_created( IVP_Event_Object *) {}
|
|
virtual void event_object_revived( IVP_Event_Object *) {}
|
|
virtual void event_object_frozen ( IVP_Event_Object *) {}
|
|
|
|
private:
|
|
CPhysicsObject *m_pObjReference;
|
|
CPhysicsObject *m_pObjAttached;
|
|
|
|
// havana constraints
|
|
hk_Constraint *m_HkConstraint;
|
|
hk_Local_Constraint_System *m_HkLCS;
|
|
void *m_pGameData;
|
|
// these are used to crack the abstract pointers on save/load
|
|
short m_constraintType;
|
|
short m_isBreakable;
|
|
};
|
|
|
|
CPhysicsConstraint::CPhysicsConstraint( CPhysicsObject *pReferenceObject, CPhysicsObject *pAttachedObject )
|
|
{
|
|
m_pGameData = NULL;
|
|
m_HkConstraint = NULL;
|
|
m_HkLCS = NULL;
|
|
m_constraintType = CONSTRAINT_UNKNOWN;
|
|
m_isBreakable = false;
|
|
|
|
if ( pReferenceObject && pAttachedObject )
|
|
{
|
|
m_pObjReference = (CPhysicsObject *)pReferenceObject;
|
|
m_pObjAttached = (CPhysicsObject *)pAttachedObject;
|
|
if ( !(m_pObjReference->CallbackFlags() & CALLBACK_NEVER_DELETED) )
|
|
{
|
|
m_pObjReference->GetObject()->add_listener_object( this );
|
|
}
|
|
if ( !(m_pObjAttached->CallbackFlags() & CALLBACK_NEVER_DELETED) )
|
|
{
|
|
m_pObjAttached->GetObject()->add_listener_object( this );
|
|
}
|
|
}
|
|
else
|
|
{
|
|
m_pObjReference = NULL;
|
|
m_pObjAttached = NULL;
|
|
}
|
|
}
|
|
|
|
// Check to see if this is a single degree of freedom joint, if so, convert to a hinge
|
|
static bool ConvertRagdollToHinge( constraint_limitedhingeparams_t *pHingeOut, const constraint_ragdollparams_t &ragdoll, IPhysicsObject *pReferenceObject, IPhysicsObject *pAttachedObject )
|
|
{
|
|
int nDOF = 0;
|
|
int dofIndex = 0;
|
|
for ( int i = 0; i < 3; i++ )
|
|
{
|
|
if ( ragdoll.axes[i].minRotation != ragdoll.axes[i].maxRotation )
|
|
{
|
|
dofIndex = i;
|
|
nDOF++;
|
|
}
|
|
}
|
|
|
|
// found multiple degrees of freedom
|
|
if ( nDOF != 1 )
|
|
return false;
|
|
|
|
// convert params to hinge
|
|
pHingeOut->Defaults();
|
|
pHingeOut->constraint = ragdoll.constraint;
|
|
|
|
// get the hinge axis in world space
|
|
matrix3x4_t refToWorld, constraintToWorld;
|
|
pReferenceObject->GetPositionMatrix( &refToWorld );
|
|
ConcatTransforms( refToWorld, ragdoll.constraintToReference, constraintToWorld );
|
|
// many ragdoll constraints don't set this and the ragdoll solver ignores it
|
|
// force it to the default
|
|
pHingeOut->constraint.strength = 1.0f;
|
|
MatrixGetColumn( constraintToWorld, 3, &pHingeOut->worldPosition );
|
|
MatrixGetColumn( constraintToWorld, dofIndex, &pHingeOut->worldAxisDirection );
|
|
pHingeOut->referencePerpAxisDirection.Init();
|
|
pHingeOut->referencePerpAxisDirection[(dofIndex+1)%3] = 1;
|
|
|
|
Vector perpCS;
|
|
VectorIRotate( pHingeOut->referencePerpAxisDirection, ragdoll.constraintToReference, perpCS );
|
|
VectorRotate( perpCS, ragdoll.constraintToAttached, pHingeOut->attachedPerpAxisDirection );
|
|
|
|
pHingeOut->hingeAxis = ragdoll.axes[dofIndex];
|
|
|
|
// Funky math to insure that the friction is preserved after the math that the hinge code uses.
|
|
pHingeOut->hingeAxis.torque = RAD2DEG( pHingeOut->hingeAxis.torque * pReferenceObject->GetMass() );
|
|
|
|
// need to flip the limits, just flip the axis instead
|
|
if ( !ragdoll.useClockwiseRotations )
|
|
{
|
|
float tmp = pHingeOut->hingeAxis.minRotation;
|
|
pHingeOut->hingeAxis.minRotation = -pHingeOut->hingeAxis.maxRotation;
|
|
pHingeOut->hingeAxis.maxRotation = -tmp;
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
// ragdoll constraint
|
|
void CPhysicsConstraint::InitRagdoll( IVP_Environment *pEnvironment, CPhysicsConstraintGroup *constraint_group, const constraint_ragdollparams_t &ragdoll )
|
|
{
|
|
// UNDONE: If this is a hinge parameterized using the ragdoll params, use a hinge instead!
|
|
constraint_limitedhingeparams_t hinge;
|
|
if ( ConvertRagdollToHinge( &hinge, ragdoll, m_pObjReference, m_pObjAttached ) )
|
|
{
|
|
InitHinge( pEnvironment, constraint_group, hinge );
|
|
return;
|
|
}
|
|
|
|
m_constraintType = CONSTRAINT_RAGDOLL;
|
|
|
|
hk_Rigid_Body *ref = (hk_Rigid_Body*)m_pObjReference->GetObject();
|
|
hk_Rigid_Body *att = (hk_Rigid_Body*)m_pObjAttached->GetObject();
|
|
|
|
hk_Limited_Ball_Socket_BP ballsocketBP;
|
|
ConvertHLLocalMatrixToHavanaLocal( ragdoll.constraintToReference, ballsocketBP.m_transform_os_ks[0] );
|
|
ConvertHLLocalMatrixToHavanaLocal( ragdoll.constraintToAttached, ballsocketBP.m_transform_os_ks[1] );
|
|
|
|
bool breakable = IsBreakableConstraint( ragdoll.constraint );
|
|
|
|
int i;
|
|
|
|
// BUGBUG: Handle incorrect clockwise rotations here
|
|
for ( i = 0; i < 3; i++ )
|
|
{
|
|
SetupRagdollAxis( i, ragdoll.axes[i], &ballsocketBP );
|
|
}
|
|
ballsocketBP.m_constrainTranslation = ragdoll.onlyAngularLimits ? false : true;
|
|
|
|
// swap the input limits if they are clockwise (angles are counter-clockwise)
|
|
if ( ragdoll.useClockwiseRotations )
|
|
{
|
|
for ( i = 0; i < 3; i++ )
|
|
{
|
|
float tmp = ballsocketBP.m_angular_limits[i].m_min;
|
|
ballsocketBP.m_angular_limits[i].m_min = -ballsocketBP.m_angular_limits[i].m_max;
|
|
ballsocketBP.m_angular_limits[i].m_max = -tmp;
|
|
}
|
|
}
|
|
|
|
hk_Ragdoll_Constraint_BP_Builder r_builder;
|
|
r_builder.initialize_from_limited_ball_socket_bp( &ballsocketBP, ref, att );
|
|
hk_Ragdoll_Constraint_BP *bp = (hk_Ragdoll_Constraint_BP *)r_builder.get_blueprint(); // get non const bp
|
|
|
|
int revAxisMapHK[3];
|
|
revAxisMapHK[bp->m_axisMap[0]] = 0;
|
|
revAxisMapHK[bp->m_axisMap[1]] = 1;
|
|
revAxisMapHK[bp->m_axisMap[2]] = 2;
|
|
for ( i = 0; i < 3; i++ )
|
|
{
|
|
// remap HL axis to IVP axis
|
|
int ivpAxis = ConvertCoordinateAxisToIVP( i );
|
|
|
|
// initialize_from_limited_ball_socket_bp remapped the axes too! So remap again.
|
|
int hkAxis = revAxisMapHK[ivpAxis];
|
|
|
|
const constraint_axislimit_t &axisData = ragdoll.axes[i];
|
|
bp->m_limits[hkAxis].set_motor( DEG2RAD(axisData.angularVelocity), axisData.torque * m_pObjReference->GetMass() );
|
|
bp->m_tau = 1.0f;
|
|
}
|
|
|
|
|
|
hk_Local_Constraint_System *lcs = constraint_group ? constraint_group->GetLCS() : NULL;
|
|
hk_Environment *hkEnvironment = static_cast<hk_Environment *>(pEnvironment);
|
|
if ( !lcs )
|
|
{
|
|
hk_Local_Constraint_System_BP bp;
|
|
lcs = new hk_Local_Constraint_System( hkEnvironment, &bp );
|
|
m_HkLCS = lcs;
|
|
}
|
|
|
|
if ( breakable )
|
|
{
|
|
hk_Ragdoll_Constraint *pConstraint = new hk_Ragdoll_Constraint( hkEnvironment, bp, ref, att);
|
|
m_HkConstraint = CreateBreakableConstraint( pConstraint, lcs, ragdoll.constraint );
|
|
}
|
|
else
|
|
{
|
|
m_HkConstraint = new hk_Ragdoll_Constraint( lcs, bp, ref, att);
|
|
}
|
|
|
|
if ( m_HkLCS && ragdoll.isActive )
|
|
{
|
|
m_HkLCS->activate();
|
|
}
|
|
m_HkConstraint->set_client_data( (void *)this );
|
|
}
|
|
|
|
// hinge constraint
|
|
void CPhysicsConstraint::InitHinge( IVP_Environment *pEnvironment, CPhysicsConstraintGroup *constraint_group, const constraint_limitedhingeparams_t &hinge )
|
|
{
|
|
m_constraintType = CONSTRAINT_HINGE;
|
|
hk_Environment *hkEnvironment = static_cast<hk_Environment *>(pEnvironment);
|
|
|
|
bool breakable = IsBreakableConstraint( hinge.constraint );
|
|
|
|
hk_Hinge_BP_Builder builder;
|
|
|
|
IVP_U_Point axisIVP_ws, axisPerpIVP_os, axisStartIVP_ws, axisStartIVP_os;
|
|
|
|
ConvertDirectionToIVP( hinge.worldAxisDirection, axisIVP_ws );
|
|
builder.set_axis_ws( (hk_Rigid_Body*)m_pObjReference->GetObject(), (hk_Rigid_Body*)m_pObjAttached->GetObject(), vec(axisIVP_ws) );
|
|
builder.set_position_os( 0, TransformHLWorldToHavanaLocal( hinge.worldPosition, m_pObjReference->GetObject() ) );
|
|
builder.set_position_os( 1, TransformHLWorldToHavanaLocal( hinge.worldPosition, m_pObjAttached->GetObject() ) );
|
|
|
|
ConvertDirectionToIVP( hinge.referencePerpAxisDirection, axisPerpIVP_os );
|
|
builder.set_axis_perp_os( 0, vec(axisPerpIVP_os) );
|
|
ConvertDirectionToIVP( hinge.attachedPerpAxisDirection, axisPerpIVP_os );
|
|
builder.set_axis_perp_os( 1, vec(axisPerpIVP_os) );
|
|
|
|
builder.set_tau( hinge.constraint.strength );
|
|
// torque is an impulse radians/sec * inertia
|
|
if ( hinge.hingeAxis.torque != 0 )
|
|
{
|
|
builder.set_angular_motor( DEG2RAD(hinge.hingeAxis.angularVelocity), DEG2RAD(hinge.hingeAxis.torque) );
|
|
}
|
|
if ( hinge.hingeAxis.minRotation != hinge.hingeAxis.maxRotation )
|
|
{
|
|
builder.set_angular_limits( DEG2RAD(hinge.hingeAxis.minRotation), DEG2RAD(hinge.hingeAxis.maxRotation) );
|
|
}
|
|
hk_Local_Constraint_System *lcs = constraint_group ? constraint_group->GetLCS() : NULL;
|
|
if ( !lcs )
|
|
{
|
|
hk_Local_Constraint_System_BP bp;
|
|
lcs = new hk_Local_Constraint_System( hkEnvironment, &bp );
|
|
m_HkLCS = lcs;
|
|
}
|
|
|
|
if ( breakable )
|
|
{
|
|
hk_Hinge_Constraint *pHinge = new hk_Hinge_Constraint( hkEnvironment, builder.get_blueprint(), (hk_Rigid_Body*)m_pObjReference->GetObject(), (hk_Rigid_Body*)m_pObjAttached->GetObject() );
|
|
m_HkConstraint = CreateBreakableConstraint( pHinge, lcs, hinge.constraint );
|
|
}
|
|
else
|
|
{
|
|
m_HkConstraint = new hk_Hinge_Constraint( lcs, builder.get_blueprint(), (hk_Rigid_Body*)m_pObjReference->GetObject(), (hk_Rigid_Body*)m_pObjAttached->GetObject() );
|
|
}
|
|
if ( m_HkLCS && hinge.constraint.isActive )
|
|
{
|
|
m_HkLCS->activate();
|
|
}
|
|
m_HkConstraint->set_client_data( (void *)this );
|
|
}
|
|
|
|
|
|
// fixed constraint
|
|
void CPhysicsConstraint::InitFixed( IVP_Environment *pEnvironment, CPhysicsConstraintGroup *constraint_group, const constraint_fixedparams_t &fixed )
|
|
{
|
|
m_constraintType = CONSTRAINT_FIXED;
|
|
hk_Environment *hkEnvironment = static_cast<hk_Environment *>(pEnvironment);
|
|
|
|
bool breakable = IsBreakableConstraint( fixed.constraint );
|
|
|
|
hk_Fixed_BP fixed_bp;
|
|
ConvertHLLocalMatrixToHavanaLocal( fixed.attachedRefXform, fixed_bp.m_transform_os_ks );
|
|
|
|
fixed_bp.m_tau = fixed.constraint.strength;
|
|
|
|
hk_Local_Constraint_System *lcs = constraint_group ? constraint_group->GetLCS() : NULL;
|
|
if ( !lcs )
|
|
{
|
|
hk_Local_Constraint_System_BP bp;
|
|
lcs = new hk_Local_Constraint_System( hkEnvironment, &bp );
|
|
m_HkLCS = lcs;
|
|
}
|
|
|
|
if ( breakable )
|
|
{
|
|
hk_Constraint *pFixed = new hk_Fixed_Constraint( hkEnvironment, &fixed_bp, (hk_Rigid_Body*)m_pObjReference->GetObject(), (hk_Rigid_Body*)m_pObjAttached->GetObject() );
|
|
|
|
m_HkConstraint = CreateBreakableConstraint( pFixed, lcs, fixed.constraint );
|
|
}
|
|
else
|
|
{
|
|
m_HkConstraint = new hk_Fixed_Constraint( lcs, &fixed_bp, (hk_Rigid_Body*)m_pObjReference->GetObject(), (hk_Rigid_Body*)m_pObjAttached->GetObject() );
|
|
}
|
|
|
|
if ( m_HkLCS && fixed.constraint.isActive )
|
|
{
|
|
m_HkLCS->activate();
|
|
}
|
|
m_HkConstraint->set_client_data( (void *)this );
|
|
}
|
|
|
|
void CPhysicsConstraint::InitBallsocket( IVP_Environment *pEnvironment, CPhysicsConstraintGroup *constraint_group, const constraint_ballsocketparams_t &ballsocket )
|
|
{
|
|
m_constraintType = CONSTRAINT_BALLSOCKET;
|
|
|
|
hk_Environment *hkEnvironment = static_cast<hk_Environment *>(pEnvironment);
|
|
|
|
bool breakable = IsBreakableConstraint( ballsocket.constraint );
|
|
|
|
hk_Ball_Socket_BP builder;
|
|
|
|
for ( int i = 0; i < 2; i++ )
|
|
{
|
|
hk_Vector3 hkConstraintLocal;
|
|
ConvertPositionToIVP( ballsocket.constraintPosition[i], hkConstraintLocal );
|
|
builder.set_position_os( i, hkConstraintLocal );
|
|
}
|
|
|
|
builder.m_strength = ballsocket.constraint.strength;
|
|
hk_Local_Constraint_System *lcs = constraint_group ? constraint_group->GetLCS() : NULL;
|
|
if ( !lcs )
|
|
{
|
|
hk_Local_Constraint_System_BP bp;
|
|
lcs = new hk_Local_Constraint_System( hkEnvironment, &bp );
|
|
m_HkLCS = lcs;
|
|
}
|
|
|
|
if ( breakable )
|
|
{
|
|
hk_Ball_Socket_Constraint *pConstraint = new hk_Ball_Socket_Constraint( hkEnvironment, &builder, (hk_Rigid_Body*)m_pObjReference->GetObject(), (hk_Rigid_Body*)m_pObjAttached->GetObject() );
|
|
m_HkConstraint = CreateBreakableConstraint( pConstraint, lcs, ballsocket.constraint );
|
|
}
|
|
else
|
|
{
|
|
m_HkConstraint = new hk_Ball_Socket_Constraint( lcs, &builder, (hk_Rigid_Body*)m_pObjReference->GetObject(), (hk_Rigid_Body*)m_pObjAttached->GetObject() );
|
|
}
|
|
|
|
if ( m_HkLCS && ballsocket.constraint.isActive )
|
|
{
|
|
m_HkLCS->activate();
|
|
}
|
|
m_HkConstraint->set_client_data( (void *)this );
|
|
}
|
|
|
|
void CPhysicsConstraint::InitSliding( IVP_Environment *pEnvironment, CPhysicsConstraintGroup *constraint_group, const constraint_slidingparams_t &sliding )
|
|
{
|
|
m_constraintType = CONSTRAINT_SLIDING;
|
|
hk_Environment *hkEnvironment = static_cast<hk_Environment *>(pEnvironment);
|
|
|
|
bool breakable = IsBreakableConstraint( sliding.constraint );
|
|
|
|
hk_Prismatic_BP prismatic_bp;
|
|
hk_Transform t;
|
|
ConvertHLLocalMatrixToHavanaLocal( sliding.attachedRefXform, t );
|
|
prismatic_bp.m_transform_Ros_Aos.m_translation = t.get_translation();
|
|
prismatic_bp.m_transform_Ros_Aos.m_rotation.set( t );
|
|
|
|
IVP_U_Float_Point refAxisDir;
|
|
ConvertDirectionToIVP( sliding.slideAxisRef, refAxisDir );
|
|
prismatic_bp.m_axis_Ros = vec(refAxisDir);
|
|
prismatic_bp.m_tau = sliding.constraint.strength;
|
|
|
|
hk_Constraint_Limit_BP bp;
|
|
|
|
if ( sliding.limitMin != sliding.limitMax )
|
|
{
|
|
bp.set_limits( ConvertDistanceToIVP(sliding.limitMin), ConvertDistanceToIVP(sliding.limitMax) );
|
|
}
|
|
if ( sliding.friction )
|
|
{
|
|
if ( sliding.velocity )
|
|
{
|
|
bp.set_motor( ConvertDistanceToIVP(sliding.velocity), ConvertDistanceToIVP(sliding.friction) );
|
|
}
|
|
else
|
|
{
|
|
bp.set_friction( ConvertDistanceToIVP(sliding.friction) );
|
|
}
|
|
}
|
|
prismatic_bp.m_limit.init_limit( bp, 1.0 );
|
|
|
|
hk_Local_Constraint_System *lcs = constraint_group ? constraint_group->GetLCS() : NULL;
|
|
if ( !lcs )
|
|
{
|
|
hk_Local_Constraint_System_BP bp;
|
|
lcs = new hk_Local_Constraint_System( hkEnvironment, &bp );
|
|
m_HkLCS = lcs;
|
|
}
|
|
|
|
if ( breakable )
|
|
{
|
|
hk_Constraint *pFixed = new hk_Prismatic_Constraint( hkEnvironment, &prismatic_bp, (hk_Rigid_Body*)m_pObjReference->GetObject(), (hk_Rigid_Body*)m_pObjAttached->GetObject() );
|
|
|
|
m_HkConstraint = CreateBreakableConstraint( pFixed, lcs, sliding.constraint );
|
|
}
|
|
else
|
|
{
|
|
m_HkConstraint = new hk_Prismatic_Constraint( lcs, &prismatic_bp, (hk_Rigid_Body*)m_pObjReference->GetObject(), (hk_Rigid_Body*)m_pObjAttached->GetObject() );
|
|
}
|
|
|
|
if ( m_HkLCS && sliding.constraint.isActive )
|
|
{
|
|
m_HkLCS->activate();
|
|
}
|
|
m_HkConstraint->set_client_data( (void *)this );
|
|
}
|
|
|
|
void CPhysicsConstraint::InitPulley( IVP_Environment *pEnvironment, CPhysicsConstraintGroup *constraint_group, const constraint_pulleyparams_t &pulley )
|
|
{
|
|
m_constraintType = CONSTRAINT_PULLEY;
|
|
|
|
hk_Environment *hkEnvironment = static_cast<hk_Environment *>(pEnvironment);
|
|
|
|
bool breakable = IsBreakableConstraint( pulley.constraint );
|
|
|
|
hk_Pulley_BP pulley_bp;
|
|
pulley_bp.m_tau = pulley.constraint.strength;
|
|
//pulley_bp.m_strength = pulley.constraint.strength;
|
|
pulley_bp.m_gearing = pulley.gearRatio;
|
|
pulley_bp.m_is_rigid = pulley.isRigid;
|
|
|
|
// Get the current length of rope
|
|
pulley_bp.m_length = ConvertDistanceToIVP( pulley.totalLength );
|
|
|
|
// set the anchor positions in object space
|
|
ConvertPositionToIVP( pulley.objectPosition[0], pulley_bp.m_translation_os_ks[0] );
|
|
ConvertPositionToIVP( pulley.objectPosition[1], pulley_bp.m_translation_os_ks[1] );
|
|
|
|
// set the pully positions in world space
|
|
ConvertPositionToIVP( pulley.pulleyPosition[0], pulley_bp.m_worldspace_point[0] );
|
|
ConvertPositionToIVP( pulley.pulleyPosition[1], pulley_bp.m_worldspace_point[1] );
|
|
|
|
hk_Local_Constraint_System *lcs = constraint_group ? constraint_group->GetLCS() : NULL;
|
|
if ( !lcs )
|
|
{
|
|
hk_Local_Constraint_System_BP bp;
|
|
lcs = new hk_Local_Constraint_System( hkEnvironment, &bp );
|
|
m_HkLCS = lcs;
|
|
}
|
|
|
|
if ( breakable )
|
|
{
|
|
hk_Constraint *pPulley = new hk_Pulley_Constraint( hkEnvironment, &pulley_bp, (hk_Rigid_Body*)m_pObjReference->GetObject(), (hk_Rigid_Body*)m_pObjAttached->GetObject() );
|
|
|
|
m_HkConstraint = CreateBreakableConstraint( pPulley, lcs, pulley.constraint );
|
|
}
|
|
else
|
|
{
|
|
m_HkConstraint = new hk_Pulley_Constraint( lcs, &pulley_bp, (hk_Rigid_Body*)m_pObjReference->GetObject(), (hk_Rigid_Body*)m_pObjAttached->GetObject() );
|
|
}
|
|
|
|
if ( m_HkLCS && pulley.constraint.isActive )
|
|
{
|
|
m_HkLCS->activate();
|
|
}
|
|
m_HkConstraint->set_client_data( (void *)this );
|
|
}
|
|
|
|
|
|
void CPhysicsConstraint::InitLength( IVP_Environment *pEnvironment, CPhysicsConstraintGroup *constraint_group, const constraint_lengthparams_t &length )
|
|
{
|
|
m_constraintType = CONSTRAINT_LENGTH;
|
|
|
|
hk_Environment *hkEnvironment = static_cast<hk_Environment *>(pEnvironment);
|
|
|
|
bool breakable = IsBreakableConstraint( length.constraint );
|
|
|
|
hk_Stiff_Spring_BP stiff_bp;
|
|
stiff_bp.m_tau = length.constraint.strength;
|
|
//stiff_bp.m_strength = length.constraint.strength;
|
|
|
|
// Get the current length of rope
|
|
stiff_bp.m_length = ConvertDistanceToIVP( length.totalLength );
|
|
stiff_bp.m_min_length = ConvertDistanceToIVP( length.minLength );
|
|
|
|
// set the anchor positions in object space
|
|
ConvertPositionToIVP( length.objectPosition[0], stiff_bp.m_translation_os_ks[0] );
|
|
ConvertPositionToIVP( length.objectPosition[1], stiff_bp.m_translation_os_ks[1] );
|
|
|
|
hk_Local_Constraint_System *lcs = constraint_group ? constraint_group->GetLCS() : NULL;
|
|
if ( !lcs )
|
|
{
|
|
hk_Local_Constraint_System_BP bp;
|
|
lcs = new hk_Local_Constraint_System( hkEnvironment, &bp );
|
|
m_HkLCS = lcs;
|
|
}
|
|
|
|
if ( breakable )
|
|
{
|
|
hk_Constraint *pLength = new hk_Stiff_Spring_Constraint( hkEnvironment, &stiff_bp, (hk_Rigid_Body*)m_pObjReference->GetObject(), (hk_Rigid_Body*)m_pObjAttached->GetObject() );
|
|
|
|
m_HkConstraint = CreateBreakableConstraint( pLength, lcs, length.constraint );
|
|
}
|
|
else
|
|
{
|
|
m_HkConstraint = new hk_Stiff_Spring_Constraint( lcs, &stiff_bp, (hk_Rigid_Body*)m_pObjReference->GetObject(), (hk_Rigid_Body*)m_pObjAttached->GetObject() );
|
|
}
|
|
|
|
if ( m_HkLCS && length.constraint.isActive )
|
|
{
|
|
m_HkLCS->activate();
|
|
}
|
|
m_HkConstraint->set_client_data( (void *)this );
|
|
}
|
|
|
|
// Serialization: Write out a description for this constraint
|
|
void CPhysicsConstraint::WriteToTemplate( vphysics_save_cphysicsconstraint_t &header, vphysics_save_constraint_t &constraintTemplate ) const
|
|
{
|
|
header.constraintType = m_constraintType;
|
|
|
|
// this constraint is inert due to one of it's objects getting deleted
|
|
if ( !m_HkConstraint )
|
|
return;
|
|
|
|
header.pGroup = GetConstraintGroup();
|
|
|
|
header.pObjReference = m_pObjReference;
|
|
header.pObjAttached = m_pObjAttached;
|
|
|
|
switch( header.constraintType )
|
|
{
|
|
case CONSTRAINT_UNKNOWN:
|
|
Assert(0);
|
|
break;
|
|
case CONSTRAINT_HINGE:
|
|
WriteHinge( constraintTemplate.hinge );
|
|
break;
|
|
case CONSTRAINT_FIXED:
|
|
WriteFixed( constraintTemplate.fixed );
|
|
break;
|
|
case CONSTRAINT_SLIDING:
|
|
WriteSliding( constraintTemplate.sliding );
|
|
break;
|
|
case CONSTRAINT_PULLEY:
|
|
WritePulley( constraintTemplate.pulley );
|
|
break;
|
|
case CONSTRAINT_LENGTH:
|
|
WriteLength( constraintTemplate.length );
|
|
break;
|
|
case CONSTRAINT_BALLSOCKET:
|
|
WriteBallsocket( constraintTemplate.ballsocket );
|
|
break;
|
|
case CONSTRAINT_RAGDOLL:
|
|
WriteRagdoll( constraintTemplate.ragdoll );
|
|
break;
|
|
}
|
|
}
|
|
|
|
void CPhysicsConstraint::SetLinearMotor( float speed, float maxLinearImpulse )
|
|
{
|
|
if ( m_constraintType != CONSTRAINT_SLIDING )
|
|
return;
|
|
|
|
hk_Prismatic_Constraint *pConstraint = (hk_Prismatic_Constraint *)GetRealConstraint();
|
|
pConstraint->set_motor( ConvertDistanceToIVP( speed ), ConvertDistanceToIVP( maxLinearImpulse ) );
|
|
}
|
|
|
|
void CPhysicsConstraint::SetAngularMotor( float rotSpeed, float maxAngularImpulse )
|
|
{
|
|
if ( m_constraintType == CONSTRAINT_RAGDOLL && rotSpeed == 0 )
|
|
{
|
|
hk_Ragdoll_Constraint *pConstraint = (hk_Ragdoll_Constraint *)GetRealConstraint();
|
|
pConstraint->update_friction( ConvertAngleToIVP( maxAngularImpulse ) );
|
|
}
|
|
else if ( m_constraintType == CONSTRAINT_HINGE )
|
|
{
|
|
hk_Hinge_Constraint *pConstraint = (hk_Hinge_Constraint *)GetRealConstraint();
|
|
pConstraint->set_motor( ConvertAngleToIVP( rotSpeed ), ConvertAngleToIVP( fabs(maxAngularImpulse) ) );
|
|
}
|
|
}
|
|
|
|
void CPhysicsConstraint::UpdateRagdollTransforms( const matrix3x4_t &constraintToReference, const matrix3x4_t &constraintToAttached )
|
|
{
|
|
if ( m_constraintType != CONSTRAINT_RAGDOLL )
|
|
return;
|
|
|
|
hk_Transform os_ks_0, os_ks_1;
|
|
|
|
ConvertHLLocalMatrixToHavanaLocal( constraintToReference, os_ks_0 );
|
|
ConvertHLLocalMatrixToHavanaLocal( constraintToAttached, os_ks_1 );
|
|
|
|
hk_Ragdoll_Constraint *pConstraint = (hk_Ragdoll_Constraint *)GetRealConstraint();
|
|
pConstraint->update_transforms( os_ks_0, os_ks_1 );
|
|
}
|
|
|
|
bool CPhysicsConstraint::GetConstraintTransform( matrix3x4_t *pConstraintToReference, matrix3x4_t *pConstraintToAttached ) const
|
|
{
|
|
if ( m_constraintType == CONSTRAINT_RAGDOLL )
|
|
{
|
|
hk_Ragdoll_Constraint *pConstraint = (hk_Ragdoll_Constraint *)GetRealConstraint();
|
|
if ( pConstraintToReference )
|
|
{
|
|
ConvertHavanaLocalMatrixToHL( pConstraint->get_transform(0), *pConstraintToReference, NULL );
|
|
}
|
|
if ( pConstraintToAttached )
|
|
{
|
|
ConvertHavanaLocalMatrixToHL( pConstraint->get_transform(1), *pConstraintToAttached, NULL );
|
|
}
|
|
return true;
|
|
}
|
|
else if ( m_constraintType == CONSTRAINT_BALLSOCKET )
|
|
{
|
|
hk_Ball_Socket_Constraint *pConstraint = (hk_Ball_Socket_Constraint *)GetRealConstraint();
|
|
Vector pos;
|
|
if ( pConstraintToReference )
|
|
{
|
|
ConvertPositionToHL( pConstraint->get_transform(0), pos );
|
|
AngleMatrix( vec3_angle, pos, *pConstraintToReference );
|
|
}
|
|
if ( pConstraintToAttached )
|
|
{
|
|
ConvertPositionToHL( pConstraint->get_transform(1), pos );
|
|
AngleMatrix( vec3_angle, pos, *pConstraintToAttached );
|
|
}
|
|
return true;
|
|
}
|
|
else if ( m_constraintType == CONSTRAINT_FIXED )
|
|
{
|
|
hk_Fixed_Constraint *pConstraint = (hk_Fixed_Constraint *)GetRealConstraint();
|
|
if ( pConstraintToReference )
|
|
{
|
|
ConvertHavanaLocalMatrixToHL( pConstraint->get_transform(0), *pConstraintToReference, NULL );
|
|
}
|
|
if ( pConstraintToAttached )
|
|
{
|
|
ConvertHavanaLocalMatrixToHL( pConstraint->get_transform(1), *pConstraintToAttached, NULL );
|
|
}
|
|
return true;
|
|
}
|
|
return false;
|
|
}
|
|
|
|
// header.pGroup is optionally NULL, all other fields must be valid!
|
|
static bool IsValidConstraint( const vphysics_save_cphysicsconstraint_t &header )
|
|
{
|
|
if ( header.constraintType != CONSTRAINT_UNKNOWN && header.pObjAttached && header.pObjReference )
|
|
return true;
|
|
|
|
return false;
|
|
}
|
|
|
|
|
|
bool CPhysicsConstraint::GetConstraintParams( constraint_breakableparams_t *pParams ) const
|
|
{
|
|
if ( !pParams )
|
|
return false;
|
|
vphysics_save_cphysicsconstraint_t header;
|
|
vphysics_save_constraint_t constraintTemplate;
|
|
memset( &header, 0, sizeof(header) );
|
|
memset( &constraintTemplate, 0, sizeof(constraintTemplate) );
|
|
WriteToTemplate( header, constraintTemplate );
|
|
|
|
if ( IsValidConstraint( header ) )
|
|
{
|
|
switch ( header.constraintType )
|
|
{
|
|
case CONSTRAINT_UNKNOWN:
|
|
break;
|
|
case CONSTRAINT_HINGE:
|
|
*pParams = constraintTemplate.hinge.constraint;
|
|
return true;
|
|
case CONSTRAINT_FIXED:
|
|
*pParams = constraintTemplate.fixed.constraint;
|
|
return true;
|
|
case CONSTRAINT_SLIDING:
|
|
*pParams = constraintTemplate.sliding.constraint;
|
|
return true;
|
|
case CONSTRAINT_PULLEY:
|
|
*pParams = constraintTemplate.pulley.constraint;
|
|
return true;
|
|
case CONSTRAINT_LENGTH:
|
|
*pParams = constraintTemplate.length.constraint;
|
|
return true;
|
|
case CONSTRAINT_BALLSOCKET:
|
|
*pParams = constraintTemplate.ballsocket.constraint;
|
|
return true;
|
|
case CONSTRAINT_RAGDOLL:
|
|
*pParams = constraintTemplate.ragdoll.constraint;
|
|
return true;
|
|
}
|
|
}
|
|
return false;
|
|
}
|
|
|
|
CPhysicsConstraintGroup *CPhysicsConstraint::GetConstraintGroup() const
|
|
{
|
|
if ( !m_HkConstraint )
|
|
return NULL;
|
|
|
|
hk_Local_Constraint_System *plcs = m_HkConstraint->get_constraint_system();
|
|
Assert(plcs);
|
|
return (CPhysicsConstraintGroup *)plcs->get_client_data();
|
|
}
|
|
|
|
void CPhysicsConstraint::ReadBreakableConstraint( constraint_breakableparams_t ¶ms ) const
|
|
{
|
|
if ( m_isBreakable )
|
|
{
|
|
hk_Breakable_Constraint_BP bp;
|
|
((hk_Breakable_Constraint *)m_HkConstraint)->write_to_blueprint( &bp );
|
|
|
|
params.forceLimit = ConvertDistanceToHL( bp.m_linear_strength );
|
|
params.torqueLimit = RAD2DEG( bp.m_angular_strength );
|
|
params.strength = 1.0;
|
|
params.bodyMassScale[0] = bp.m_bodyMassScale[0];
|
|
params.bodyMassScale[1] = bp.m_bodyMassScale[1];
|
|
//Assert( m_HkLCS != NULL ); // this is allowed now although breaking inside an LCS won't work yet
|
|
}
|
|
else
|
|
{
|
|
params.Defaults();
|
|
}
|
|
|
|
if ( m_HkLCS )
|
|
{
|
|
params.isActive = m_HkLCS->is_active();
|
|
}
|
|
}
|
|
|
|
|
|
void CPhysicsConstraint::WriteFixed( constraint_fixedparams_t &fixed ) const
|
|
{
|
|
hk_Fixed_Constraint *pConstraint = (hk_Fixed_Constraint *)GetRealConstraint();
|
|
ReadBreakableConstraint( fixed.constraint );
|
|
|
|
hk_Fixed_BP fixed_bp;
|
|
pConstraint->write_to_blueprint( &fixed_bp );
|
|
// save fixed bp into params
|
|
ConvertHavanaLocalMatrixToHL( fixed_bp.m_transform_os_ks, fixed.attachedRefXform, m_pObjReference->GetObject() );
|
|
}
|
|
|
|
void CPhysicsConstraint::WriteRagdoll( constraint_ragdollparams_t &ragdoll ) const
|
|
{
|
|
hk_Ragdoll_Constraint *pConstraint = (hk_Ragdoll_Constraint *)GetRealConstraint();
|
|
ReadBreakableConstraint( ragdoll.constraint );
|
|
hk_Ragdoll_Constraint_BP ragdoll_bp;
|
|
// BUGBUG: Write this and figure out how to recreate
|
|
// or change init func to setup this bp directly
|
|
pConstraint->write_to_blueprint( &ragdoll_bp );
|
|
|
|
ConvertHavanaLocalMatrixToHL( ragdoll_bp.m_transform_os_ks[0], ragdoll.constraintToReference, m_pObjReference->GetObject() );
|
|
ConvertHavanaLocalMatrixToHL( ragdoll_bp.m_transform_os_ks[1], ragdoll.constraintToAttached, m_pObjAttached->GetObject() );
|
|
int revAxisMapHK[3];
|
|
revAxisMapHK[ragdoll_bp.m_axisMap[0]] = 0;
|
|
revAxisMapHK[ragdoll_bp.m_axisMap[1]] = 1;
|
|
revAxisMapHK[ragdoll_bp.m_axisMap[2]] = 2;
|
|
for ( int i = 0; i < 3; i ++ )
|
|
{
|
|
constraint_axislimit_t &ragdollAxis = ragdoll.axes[i];
|
|
int ivpAxis = ConvertCoordinateAxisToIVP( i );
|
|
int hkAxis = revAxisMapHK[ ivpAxis ];
|
|
hk_Constraint_Limit_BP &bpAxis = ragdoll_bp.m_limits[ hkAxis ];
|
|
|
|
ragdollAxis.angularVelocity = RAD2DEG(bpAxis.m_desired_velocity);
|
|
ragdollAxis.torque = bpAxis.m_joint_friction * m_pObjReference->GetInvMass();
|
|
// X&Y
|
|
if ( i != 2 )
|
|
{
|
|
ragdollAxis.minRotation = RAD2DEG(bpAxis.m_limit_min);
|
|
ragdollAxis.maxRotation = RAD2DEG(bpAxis.m_limit_max);
|
|
}
|
|
// Z
|
|
else
|
|
{
|
|
ragdollAxis.minRotation = -RAD2DEG(bpAxis.m_limit_max);
|
|
ragdollAxis.maxRotation = -RAD2DEG(bpAxis.m_limit_min);
|
|
}
|
|
}
|
|
ragdoll.childIndex = -1;
|
|
ragdoll.parentIndex = -1;
|
|
ragdoll.isActive = true;
|
|
ragdoll.onlyAngularLimits = ragdoll_bp.m_constrainTranslation ? false : true;
|
|
ragdoll.useClockwiseRotations = false;
|
|
}
|
|
|
|
void CPhysicsConstraint::WriteHinge( constraint_hingeparams_t &hinge ) const
|
|
{
|
|
hk_Hinge_Constraint *pConstraint = (hk_Hinge_Constraint *)GetRealConstraint();
|
|
ReadBreakableConstraint( hinge.constraint );
|
|
|
|
hk_Hinge_BP hinge_bp;
|
|
pConstraint->write_to_blueprint( &hinge_bp );
|
|
// save hinge bp into params
|
|
hinge.worldPosition = TransformHavanaLocalToHLWorld( hinge_bp.m_axis_os[0].get_origin(), m_pObjReference->GetObject(), true );
|
|
hinge.worldAxisDirection = TransformHavanaLocalToHLWorld( hinge_bp.m_axis_os[0].get_direction(), m_pObjReference->GetObject(), false );
|
|
hinge.hingeAxis.SetAxisFriction( 0,0,0 );
|
|
|
|
if ( hinge_bp.m_limit.m_limit_is_enabled )
|
|
{
|
|
hinge.hingeAxis.minRotation = RAD2DEG(hinge_bp.m_limit.m_limit_min);
|
|
hinge.hingeAxis.maxRotation = RAD2DEG(hinge_bp.m_limit.m_limit_max);
|
|
}
|
|
if ( hinge_bp.m_limit.m_friction_is_enabled )
|
|
{
|
|
hinge.hingeAxis.angularVelocity = RAD2DEG(hinge_bp.m_limit.m_desired_velocity);
|
|
hinge.hingeAxis.torque = RAD2DEG(hinge_bp.m_limit.m_joint_friction);
|
|
}
|
|
}
|
|
|
|
void CPhysicsConstraint::WriteSliding( constraint_slidingparams_t &sliding ) const
|
|
{
|
|
sliding.Defaults();
|
|
hk_Prismatic_Constraint *pConstraint = (hk_Prismatic_Constraint *)GetRealConstraint();
|
|
ReadBreakableConstraint( sliding.constraint );
|
|
|
|
hk_Prismatic_BP prismatic_bp;
|
|
pConstraint->write_to_blueprint( &prismatic_bp );
|
|
// save bp into params
|
|
|
|
hk_Transform t;
|
|
t.set_translation( prismatic_bp.m_transform_Ros_Aos.m_translation );
|
|
t.set_rotation( prismatic_bp.m_transform_Ros_Aos.m_rotation );
|
|
ConvertHavanaLocalMatrixToHL( t, sliding.attachedRefXform, m_pObjReference->GetObject() );
|
|
if ( prismatic_bp.m_limit.m_friction_is_enabled )
|
|
{
|
|
sliding.friction = ConvertDistanceToHL( prismatic_bp.m_limit.m_joint_friction );
|
|
sliding.velocity = ConvertDistanceToHL( prismatic_bp.m_limit.m_desired_velocity );
|
|
}
|
|
if ( prismatic_bp.m_limit.m_limit_is_enabled )
|
|
{
|
|
sliding.limitMin = ConvertDistanceToHL( prismatic_bp.m_limit.m_limit_min );
|
|
sliding.limitMax = ConvertDistanceToHL( prismatic_bp.m_limit.m_limit_max );
|
|
}
|
|
ConvertDirectionToHL( prismatic_bp.m_axis_Ros, sliding.slideAxisRef );
|
|
}
|
|
|
|
|
|
void CPhysicsConstraint::WritePulley( constraint_pulleyparams_t &pulley ) const
|
|
{
|
|
pulley.Defaults();
|
|
hk_Pulley_Constraint *pConstraint = (hk_Pulley_Constraint *)GetRealConstraint();
|
|
ReadBreakableConstraint( pulley.constraint );
|
|
|
|
hk_Pulley_BP pulley_bp;
|
|
pConstraint->write_to_blueprint( &pulley_bp );
|
|
|
|
// save bp into params
|
|
for ( int i = 0; i < 2; i++ )
|
|
{
|
|
ConvertPositionToHL( pulley_bp.m_worldspace_point[i], pulley.pulleyPosition[i] );
|
|
ConvertPositionToHL( pulley_bp.m_translation_os_ks[i], pulley.objectPosition[i] );
|
|
}
|
|
pulley.gearRatio = pulley_bp.m_gearing;
|
|
|
|
pulley.totalLength = ConvertDistanceToHL(pulley_bp.m_length);
|
|
pulley.isRigid = pulley_bp.m_is_rigid;
|
|
}
|
|
|
|
|
|
void CPhysicsConstraint::WriteLength( constraint_lengthparams_t &length ) const
|
|
{
|
|
length.Defaults();
|
|
hk_Stiff_Spring_Constraint *pConstraint = (hk_Stiff_Spring_Constraint *)GetRealConstraint();
|
|
ReadBreakableConstraint( length.constraint );
|
|
|
|
hk_Stiff_Spring_BP stiff_bp;
|
|
pConstraint->write_to_blueprint( &stiff_bp );
|
|
|
|
// save bp into params
|
|
for ( int i = 0; i < 2; i++ )
|
|
{
|
|
ConvertPositionToHL( stiff_bp.m_translation_os_ks[i], length.objectPosition[i] );
|
|
}
|
|
|
|
length.totalLength = ConvertDistanceToHL(stiff_bp.m_length);
|
|
length.minLength = ConvertDistanceToHL(stiff_bp.m_min_length);
|
|
}
|
|
|
|
|
|
void CPhysicsConstraint::WriteBallsocket( constraint_ballsocketparams_t &ballsocket ) const
|
|
{
|
|
ballsocket.Defaults();
|
|
hk_Ball_Socket_Constraint *pConstraint = (hk_Ball_Socket_Constraint *)GetRealConstraint();
|
|
ReadBreakableConstraint( ballsocket.constraint );
|
|
|
|
hk_Ball_Socket_BP ballsocket_bp;
|
|
pConstraint->write_to_blueprint( &ballsocket_bp );
|
|
|
|
// save bp into params
|
|
for ( int i = 0; i < 2; i++ )
|
|
{
|
|
ConvertPositionToHL( ballsocket_bp.m_translation_os_ks[i], ballsocket.constraintPosition[i] );
|
|
}
|
|
}
|
|
|
|
|
|
void CPhysicsConstraint::DetachListener()
|
|
{
|
|
if ( !(m_pObjReference->CallbackFlags() & CALLBACK_NEVER_DELETED) )
|
|
{
|
|
m_pObjReference->GetObject()->remove_listener_object( this );
|
|
}
|
|
|
|
if ( !(m_pObjAttached->CallbackFlags() & CALLBACK_NEVER_DELETED) )
|
|
{
|
|
m_pObjAttached->GetObject()->remove_listener_object( this );
|
|
}
|
|
|
|
m_pObjReference = NULL;
|
|
m_pObjAttached = NULL;
|
|
}
|
|
|
|
void CPhysicsConstraint::event_object_deleted( IVP_Event_Object *pEvent )
|
|
{
|
|
if ( m_HkLCS && pEvent->real_object->get_core()->physical_unmoveable )
|
|
{
|
|
// HACKHACK: This makes the behavior consistent
|
|
m_HkLCS->core_is_going_to_be_deleted_event( pEvent->real_object->get_core() );
|
|
}
|
|
DetachListener();
|
|
// the underlying constraint is no longer valid, delete it.
|
|
delete m_HkConstraint;
|
|
m_HkConstraint = NULL;
|
|
delete m_HkLCS;
|
|
m_HkLCS = NULL;
|
|
if ( pEvent->environment )
|
|
{
|
|
CPhysicsEnvironment *pEnvironment = (CPhysicsEnvironment *)pEvent->environment->client_data;
|
|
pEnvironment->NotifyConstraintDisabled( this );
|
|
}
|
|
}
|
|
|
|
|
|
CPhysicsConstraint::~CPhysicsConstraint( void )
|
|
{
|
|
// arg. There should be a better way to do this
|
|
if ( m_HkConstraint || m_HkLCS )
|
|
{
|
|
DetachListener();
|
|
delete m_HkLCS;
|
|
delete m_HkConstraint;
|
|
}
|
|
}
|
|
|
|
void CPhysicsConstraint::Activate( void )
|
|
{
|
|
if ( m_HkLCS )
|
|
{
|
|
m_HkLCS->activate();
|
|
}
|
|
}
|
|
|
|
|
|
void CPhysicsConstraint::Deactivate( void )
|
|
{
|
|
if ( m_HkLCS )
|
|
{
|
|
m_HkLCS->deactivate();
|
|
}
|
|
}
|
|
|
|
|
|
void CPhysicsConstraint::SetupRagdollAxis( int axis, const constraint_axislimit_t &axisData, hk_Limited_Ball_Socket_BP *ballsocketBP )
|
|
{
|
|
// X & Y
|
|
if ( axis != 2 )
|
|
{
|
|
ballsocketBP->m_angular_limits[ ConvertCoordinateAxisToIVP(axis) ].set( DEG2RAD(axisData.minRotation), DEG2RAD(axisData.maxRotation) );
|
|
}
|
|
// Z
|
|
else
|
|
{
|
|
ballsocketBP->m_angular_limits[ ConvertCoordinateAxisToIVP(axis) ].set( DEG2RAD(-axisData.maxRotation), DEG2RAD(-axisData.minRotation) );
|
|
}
|
|
}
|
|
|
|
|
|
// UNDONE: Keep this around to clip "includeStatic" code
|
|
#if 0
|
|
void CPhysicsConstraint::SetBreakLimit( float breakLimitForce, float breakLimitTorque, bool includeStatic )
|
|
{
|
|
float factor = ConvertDistanceToIVP( 1.0f );
|
|
|
|
// convert to ivp
|
|
IVP_Environment *pEnvironment = m_pConstraint->get_associated_controlled_cores()->element_at(0)->environment;
|
|
float gravity = pEnvironment->get_gravity()->real_length();
|
|
breakLimitTorque = breakLimitTorque * gravity * factor; // proportional to distance
|
|
breakLimitForce = breakLimitForce * gravity;
|
|
|
|
if ( breakLimitForce != 0 )
|
|
{
|
|
if ( includeStatic )
|
|
{
|
|
breakLimitForce += m_pObjAttached->GetMass() * gravity * pEnvironment->get_delta_PSI_time();
|
|
}
|
|
|
|
m_pConstraint->change_max_translation_impulse( IVP_CFE_BREAK, breakLimitForce );
|
|
}
|
|
else
|
|
{
|
|
m_pConstraint->change_max_translation_impulse( IVP_CFE_NONE, 0 );
|
|
}
|
|
|
|
if ( breakLimitTorque != 0 )
|
|
{
|
|
if ( includeStatic )
|
|
{
|
|
const IVP_U_Point *massCenter = m_pObjAttached->GetObject()->get_core()->get_position_PSI();
|
|
|
|
IVP_U_Point tmp;
|
|
tmp.set( massCenter );
|
|
tmp.subtract( &m_constraintOrigin );
|
|
float dist = tmp.real_length();
|
|
breakLimitTorque += (m_pObjAttached->GetMass() * gravity * dist * pEnvironment->get_delta_PSI_time());
|
|
}
|
|
m_pConstraint->change_max_rotation_impulse( IVP_CFE_BREAK, breakLimitTorque );
|
|
}
|
|
else
|
|
{
|
|
m_pConstraint->change_max_rotation_impulse( IVP_CFE_NONE, 0 );
|
|
}
|
|
}
|
|
#endif
|
|
|
|
|
|
IPhysicsObject *CPhysicsConstraint::GetReferenceObject( void ) const
|
|
{
|
|
return m_pObjReference;
|
|
}
|
|
|
|
|
|
IPhysicsObject *CPhysicsConstraint::GetAttachedObject( void ) const
|
|
{
|
|
return m_pObjAttached;
|
|
}
|
|
|
|
void SeedRandomGenerators()
|
|
{
|
|
ivp_srand(1);
|
|
hk_Math::srand01('h'+'a'+'v'+'o'+'k');
|
|
qh_RANDOMseed_(1);
|
|
}
|
|
|
|
extern int ivp_srand_read(void);
|
|
void ReadRandom( int buffer[4] )
|
|
{
|
|
buffer[0] = (int)hk_Math::hk_random_seed;
|
|
buffer[1] = ivp_srand_read();
|
|
}
|
|
|
|
void WriteRandom( int buffer[4] )
|
|
{
|
|
hk_Math::srand01((unsigned int)buffer[0]);
|
|
ivp_srand(buffer[1]);
|
|
}
|
|
|
|
|
|
IPhysicsConstraint *GetClientDataForHkConstraint( class hk_Breakable_Constraint *pHkConstraint )
|
|
{
|
|
return static_cast<CPhysicsConstraint *>( pHkConstraint->get_client_data() );
|
|
}
|
|
|
|
// Create a container for a group of constraints
|
|
IPhysicsConstraintGroup *CreatePhysicsConstraintGroup( IVP_Environment *pEnvironment, const constraint_groupparams_t &group )
|
|
{
|
|
MEM_ALLOC_CREDIT();
|
|
return new CPhysicsConstraintGroup( pEnvironment, group );
|
|
}
|
|
|
|
IPhysicsConstraint *CreateRagdollConstraint( IVP_Environment *pEnvironment, CPhysicsObject *pReferenceObject, CPhysicsObject *pAttachedObject, IPhysicsConstraintGroup *pGroup, const constraint_ragdollparams_t &ragdoll )
|
|
{
|
|
MEM_ALLOC_CREDIT();
|
|
CPhysicsConstraint *pConstraint = new CPhysicsConstraint( pReferenceObject, pAttachedObject );
|
|
pConstraint->InitRagdoll( pEnvironment, (CPhysicsConstraintGroup *)pGroup, ragdoll );
|
|
return pConstraint;
|
|
}
|
|
IPhysicsConstraint *CreateHingeConstraint( IVP_Environment *pEnvironment, CPhysicsObject *pReferenceObject, CPhysicsObject *pAttachedObject, IPhysicsConstraintGroup *pGroup, const constraint_limitedhingeparams_t &hinge )
|
|
{
|
|
MEM_ALLOC_CREDIT();
|
|
CPhysicsConstraint *pConstraint = new CPhysicsConstraint( pReferenceObject, pAttachedObject );
|
|
pConstraint->InitHinge( pEnvironment, (CPhysicsConstraintGroup *)pGroup, hinge );
|
|
return pConstraint;
|
|
}
|
|
|
|
IPhysicsConstraint *CreateFixedConstraint( IVP_Environment *pEnvironment, CPhysicsObject *pReferenceObject, CPhysicsObject *pAttachedObject, IPhysicsConstraintGroup *pGroup, const constraint_fixedparams_t &fixed )
|
|
{
|
|
MEM_ALLOC_CREDIT();
|
|
CPhysicsConstraint *pConstraint = new CPhysicsConstraint( pReferenceObject, pAttachedObject );
|
|
pConstraint->InitFixed( pEnvironment, (CPhysicsConstraintGroup *)pGroup, fixed );
|
|
return pConstraint;
|
|
}
|
|
|
|
IPhysicsConstraint *CreateSlidingConstraint( IVP_Environment *pEnvironment, CPhysicsObject *pReferenceObject, CPhysicsObject *pAttachedObject, IPhysicsConstraintGroup *pGroup, const constraint_slidingparams_t &sliding )
|
|
{
|
|
MEM_ALLOC_CREDIT();
|
|
CPhysicsConstraint *pConstraint = new CPhysicsConstraint( pReferenceObject, pAttachedObject );
|
|
pConstraint->InitSliding( pEnvironment, (CPhysicsConstraintGroup *)pGroup, sliding );
|
|
return pConstraint;
|
|
}
|
|
|
|
IPhysicsConstraint *CreateBallsocketConstraint( IVP_Environment *pEnvironment, CPhysicsObject *pReferenceObject, CPhysicsObject *pAttachedObject, IPhysicsConstraintGroup *pGroup, const constraint_ballsocketparams_t &ballsocket )
|
|
{
|
|
MEM_ALLOC_CREDIT();
|
|
CPhysicsConstraint *pConstraint = new CPhysicsConstraint( pReferenceObject, pAttachedObject );
|
|
pConstraint->InitBallsocket( pEnvironment, (CPhysicsConstraintGroup *)pGroup, ballsocket );
|
|
return pConstraint;
|
|
}
|
|
|
|
IPhysicsConstraint *CreatePulleyConstraint( IVP_Environment *pEnvironment, CPhysicsObject *pReferenceObject, CPhysicsObject *pAttachedObject, IPhysicsConstraintGroup *pGroup, const constraint_pulleyparams_t &pulley )
|
|
{
|
|
MEM_ALLOC_CREDIT();
|
|
CPhysicsConstraint *pConstraint = new CPhysicsConstraint( pReferenceObject, pAttachedObject );
|
|
pConstraint->InitPulley( pEnvironment, (CPhysicsConstraintGroup *)pGroup, pulley );
|
|
return pConstraint;
|
|
}
|
|
|
|
IPhysicsConstraint *CreateLengthConstraint( IVP_Environment *pEnvironment, CPhysicsObject *pReferenceObject, CPhysicsObject *pAttachedObject, IPhysicsConstraintGroup *pGroup, const constraint_lengthparams_t &length )
|
|
{
|
|
MEM_ALLOC_CREDIT();
|
|
CPhysicsConstraint *pConstraint = new CPhysicsConstraint( pReferenceObject, pAttachedObject );
|
|
pConstraint->InitLength( pEnvironment, (CPhysicsConstraintGroup *)pGroup, length );
|
|
return pConstraint;
|
|
}
|
|
|
|
bool IsExternalConstraint( IVP_Controller *pLCS, void *pGameData )
|
|
{
|
|
IVP_U_Vector<IVP_Core> *pCores = pLCS->get_associated_controlled_cores();
|
|
if ( pCores )
|
|
{
|
|
for ( int i = 0; i < pCores->n_elems; i++ )
|
|
{
|
|
if ( pCores->element_at(i) )
|
|
{
|
|
IVP_Real_Object *pivp = pCores->element_at(i)->objects.element_at(0);
|
|
if ( pivp)
|
|
{
|
|
IPhysicsObject *pObject = static_cast<IPhysicsObject *>(pivp->client_data);
|
|
if ( pObject && pObject->GetGameData() != pGameData )
|
|
return true;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
return false;
|
|
}
|
|
|
|
bool SavePhysicsConstraint( const physsaveparams_t ¶ms, CPhysicsConstraint *pConstraint )
|
|
{
|
|
vphysics_save_cphysicsconstraint_t header;
|
|
vphysics_save_constraint_t constraintTemplate;
|
|
memset( &header, 0, sizeof(header) );
|
|
memset( &constraintTemplate, 0, sizeof(constraintTemplate) );
|
|
|
|
pConstraint->WriteToTemplate( header, constraintTemplate );
|
|
|
|
params.pSave->WriteAll( &header );
|
|
if ( IsValidConstraint( header ) )
|
|
{
|
|
switch ( header.constraintType )
|
|
{
|
|
case CONSTRAINT_UNKNOWN:
|
|
Assert(0);
|
|
break;
|
|
case CONSTRAINT_HINGE:
|
|
params.pSave->WriteAll( &constraintTemplate.hinge );
|
|
break;
|
|
case CONSTRAINT_FIXED:
|
|
params.pSave->WriteAll( &constraintTemplate.fixed );
|
|
break;
|
|
case CONSTRAINT_SLIDING:
|
|
params.pSave->WriteAll( &constraintTemplate.sliding );
|
|
break;
|
|
case CONSTRAINT_PULLEY:
|
|
params.pSave->WriteAll( &constraintTemplate.pulley );
|
|
break;
|
|
case CONSTRAINT_LENGTH:
|
|
params.pSave->WriteAll( &constraintTemplate.length );
|
|
break;
|
|
case CONSTRAINT_BALLSOCKET:
|
|
params.pSave->WriteAll( &constraintTemplate.ballsocket );
|
|
break;
|
|
case CONSTRAINT_RAGDOLL:
|
|
params.pSave->WriteAll( &constraintTemplate.ragdoll );
|
|
break;
|
|
}
|
|
return true;
|
|
}
|
|
// inert constraint, just save header
|
|
return true;
|
|
}
|
|
|
|
bool RestorePhysicsConstraint( const physrestoreparams_t ¶ms, CPhysicsConstraint **ppConstraint )
|
|
{
|
|
vphysics_save_cphysicsconstraint_t header;
|
|
memset( &header, 0, sizeof(header) );
|
|
|
|
params.pRestore->ReadAll( &header );
|
|
if ( IsValidConstraint( header ) )
|
|
{
|
|
switch ( header.constraintType )
|
|
{
|
|
case CONSTRAINT_UNKNOWN:
|
|
Assert(0);
|
|
break;
|
|
case CONSTRAINT_HINGE:
|
|
{
|
|
vphysics_save_constrainthinge_t hinge;
|
|
memset( &hinge, 0, sizeof(hinge) );
|
|
params.pRestore->ReadAll( &hinge );
|
|
CPhysicsEnvironment *pEnvironment = (CPhysicsEnvironment *)params.pEnvironment;
|
|
*ppConstraint = (CPhysicsConstraint *)pEnvironment->CreateHingeConstraint( header.pObjReference, header.pObjAttached, header.pGroup, hinge );
|
|
}
|
|
break;
|
|
case CONSTRAINT_FIXED:
|
|
{
|
|
vphysics_save_constraintfixed_t fixed;
|
|
memset( &fixed, 0, sizeof(fixed) );
|
|
params.pRestore->ReadAll( &fixed );
|
|
CPhysicsEnvironment *pEnvironment = (CPhysicsEnvironment *)params.pEnvironment;
|
|
*ppConstraint = (CPhysicsConstraint *)pEnvironment->CreateFixedConstraint( header.pObjReference, header.pObjAttached, header.pGroup, fixed );
|
|
}
|
|
break;
|
|
case CONSTRAINT_SLIDING:
|
|
{
|
|
vphysics_save_constraintsliding_t sliding;
|
|
memset( &sliding, 0, sizeof(sliding) );
|
|
params.pRestore->ReadAll( &sliding );
|
|
CPhysicsEnvironment *pEnvironment = (CPhysicsEnvironment *)params.pEnvironment;
|
|
*ppConstraint = (CPhysicsConstraint *)pEnvironment->CreateSlidingConstraint( header.pObjReference, header.pObjAttached, header.pGroup, sliding );
|
|
}
|
|
break;
|
|
case CONSTRAINT_PULLEY:
|
|
{
|
|
vphysics_save_constraintpulley_t pulley;
|
|
memset( &pulley, 0, sizeof(pulley) );
|
|
params.pRestore->ReadAll( &pulley );
|
|
CPhysicsEnvironment *pEnvironment = (CPhysicsEnvironment *)params.pEnvironment;
|
|
*ppConstraint = (CPhysicsConstraint *)pEnvironment->CreatePulleyConstraint( header.pObjReference, header.pObjAttached, header.pGroup, pulley );
|
|
}
|
|
break;
|
|
case CONSTRAINT_LENGTH:
|
|
{
|
|
vphysics_save_constraintlength_t length;
|
|
memset( &length, 0, sizeof(length) );
|
|
params.pRestore->ReadAll( &length );
|
|
CPhysicsEnvironment *pEnvironment = (CPhysicsEnvironment *)params.pEnvironment;
|
|
*ppConstraint = (CPhysicsConstraint *)pEnvironment->CreateLengthConstraint( header.pObjReference, header.pObjAttached, header.pGroup, length );
|
|
}
|
|
break;
|
|
case CONSTRAINT_BALLSOCKET:
|
|
{
|
|
vphysics_save_constraintballsocket_t ballsocket;
|
|
memset( &ballsocket, 0, sizeof(ballsocket) );
|
|
params.pRestore->ReadAll( &ballsocket );
|
|
CPhysicsEnvironment *pEnvironment = (CPhysicsEnvironment *)params.pEnvironment;
|
|
*ppConstraint = (CPhysicsConstraint *)pEnvironment->CreateBallsocketConstraint( header.pObjReference, header.pObjAttached, header.pGroup, ballsocket );
|
|
}
|
|
break;
|
|
case CONSTRAINT_RAGDOLL:
|
|
{
|
|
vphysics_save_constraintragdoll_t ragdoll;
|
|
memset( &ragdoll, 0, sizeof(ragdoll) );
|
|
params.pRestore->ReadAll( &ragdoll );
|
|
CPhysicsEnvironment *pEnvironment = (CPhysicsEnvironment *)params.pEnvironment;
|
|
*ppConstraint = (CPhysicsConstraint *)pEnvironment->CreateRagdollConstraint( header.pObjReference, header.pObjAttached, header.pGroup, ragdoll );
|
|
}
|
|
break;
|
|
}
|
|
|
|
if ( *ppConstraint )
|
|
{
|
|
(*ppConstraint)->SetGameData( params.pGameData );
|
|
}
|
|
return true;
|
|
}
|
|
|
|
// inert constraint, create an empty shell
|
|
*ppConstraint = new CPhysicsConstraint( NULL, NULL );
|
|
return true;
|
|
}
|
|
|
|
|
|
bool SavePhysicsConstraintGroup( const physsaveparams_t ¶ms, CPhysicsConstraintGroup *pConstraintGroup )
|
|
{
|
|
vphysics_save_cphysicsconstraintgroup_t groupTemplate;
|
|
memset( &groupTemplate, 0, sizeof(groupTemplate) );
|
|
|
|
pConstraintGroup->WriteToTemplate( groupTemplate );
|
|
params.pSave->WriteAll( &groupTemplate );
|
|
return true;
|
|
}
|
|
|
|
bool RestorePhysicsConstraintGroup( const physrestoreparams_t ¶ms, CPhysicsConstraintGroup **ppConstraintGroup )
|
|
{
|
|
vphysics_save_cphysicsconstraintgroup_t groupTemplate;
|
|
memset( &groupTemplate, 0, sizeof(groupTemplate) );
|
|
params.pRestore->ReadAll( &groupTemplate );
|
|
if ( groupTemplate.errorTolerance == 0.0f && groupTemplate.minErrorTicks == 0 )
|
|
{
|
|
constraint_groupparams_t tmp;
|
|
tmp.Defaults();
|
|
groupTemplate.minErrorTicks = tmp.minErrorTicks;
|
|
groupTemplate.errorTolerance = tmp.errorTolerance;
|
|
}
|
|
CPhysicsEnvironment *pEnvironment = (CPhysicsEnvironment *)params.pEnvironment;
|
|
*ppConstraintGroup = (CPhysicsConstraintGroup *)pEnvironment->CreateConstraintGroup( groupTemplate );
|
|
if ( *ppConstraintGroup && groupTemplate.isActive )
|
|
{
|
|
g_ConstraintGroupActivateList.AddToTail( *ppConstraintGroup );
|
|
}
|
|
return true;
|
|
}
|
|
|
|
|
|
void PostRestorePhysicsConstraintGroup()
|
|
{
|
|
MEM_ALLOC_CREDIT();
|
|
for ( int i = 0; i < g_ConstraintGroupActivateList.Count(); i++ )
|
|
{
|
|
g_ConstraintGroupActivateList[i]->Activate();
|
|
}
|
|
g_ConstraintGroupActivateList.Purge();
|
|
}
|