diff --git a/Code/GamePhysics/Implementation/SimpleRigidBody.cpp b/Code/GamePhysics/Implementation/SimpleRigidBody.cpp index df191059..1f2837b2 100644 --- a/Code/GamePhysics/Implementation/SimpleRigidBody.cpp +++ b/Code/GamePhysics/Implementation/SimpleRigidBody.cpp @@ -101,7 +101,8 @@ SimpleRigidBody::State SimpleRigidBody::GetState() const this->rigid.frictionCoeff_Static, this->rigid.frictionCoeff_Kinetic, this->rigid.GetMomentOfInertia(), this->rigid.boundingReach, this->rigid.centerPos, this->rigid.axis, - this->rigid.momentum_Linear, this->rigid.momentum_Angular ); + this->rigid.momentum_Linear, this->rigid.momentum_Angular, + this->rigid.gravityNormal ); } SimpleRigidBody::State & SimpleRigidBody::GetState( SimpleRigidBody::State &targetMem ) const @@ -110,7 +111,8 @@ SimpleRigidBody::State & SimpleRigidBody::GetState( SimpleRigidBody::State &targ this->rigid.frictionCoeff_Static, this->rigid.frictionCoeff_Kinetic, this->rigid.GetMomentOfInertia(), this->rigid.boundingReach, this->rigid.centerPos, this->rigid.axis, - this->rigid.momentum_Linear, this->rigid.momentum_Angular ); + this->rigid.momentum_Linear, this->rigid.momentum_Angular, + this->rigid.gravityNormal ); } void SimpleRigidBody::SetState( const SimpleRigidBody::State &state ) @@ -127,6 +129,7 @@ void SimpleRigidBody::SetState( const SimpleRigidBody::State &state ) this->rigid.frictionCoeff_Kinetic = state.GetFrictionCoeff_Kinetic(); this->rigid.SetMass_KeepMomentum( state.GetMass() ); this->rigid.SetMomentOfInertia_KeepMomentum( state.GetMomentOfInertia() ); + this->rigid.gravityNormal = state.GetGravityNormal(); if( state.IsForwarded() ) { @@ -333,6 +336,7 @@ void SimpleRigidBody::SetGravity( bool ignore) void SimpleRigidBody::SetGravityNormal( const Float3 &normalizedVector ) { this->gravityNormal = normalizedVector; + this->rigid.gravityNormal = Float4( this->gravityNormal, 0 ); } void SimpleRigidBody::SetCustomTag( void *ref ) diff --git a/Code/GamePhysics/PhysicsStructs-Impl.h b/Code/GamePhysics/PhysicsStructs-Impl.h index 512c8e7a..eac9bef3 100644 --- a/Code/GamePhysics/PhysicsStructs-Impl.h +++ b/Code/GamePhysics/PhysicsStructs-Impl.h @@ -39,7 +39,7 @@ namespace Oyster this->ignoreGravity = false; } - inline CustomBodyState::CustomBodyState( ::Oyster::Math::Float mass, ::Oyster::Math::Float restitutionCoeff, ::Oyster::Math::Float staticFrictionCoeff, ::Oyster::Math::Float kineticFrictionCoeff, const ::Oyster::Math::Float4x4 &inertiaTensor, const ::Oyster::Math::Float4 &reach, const ::Oyster::Math::Float4 ¢erPos, const ::Oyster::Math::Float4 &rotation, const ::Oyster::Math::Float4 &linearMomentum, const ::Oyster::Math::Float4 &angularMomentum ) + inline CustomBodyState::CustomBodyState( ::Oyster::Math::Float mass, ::Oyster::Math::Float restitutionCoeff, ::Oyster::Math::Float staticFrictionCoeff, ::Oyster::Math::Float kineticFrictionCoeff, const ::Oyster::Math::Float4x4 &inertiaTensor, const ::Oyster::Math::Float4 &reach, const ::Oyster::Math::Float4 ¢erPos, const ::Oyster::Math::Float4 &rotation, const ::Oyster::Math::Float4 &linearMomentum, const ::Oyster::Math::Float4 &angularMomentum, const ::Oyster::Math::Float4 &gravityNormal ) { this->mass = mass; this->restitutionCoeff = restitutionCoeff; @@ -54,6 +54,7 @@ namespace Oyster this->linearImpulse = this->angularImpulse = ::Oyster::Math::Float4::null; this->deltaPos = this->deltaAxis = ::Oyster::Math::Float4::null; this->isSpatiallyAltered = this->isDisturbed = this->isForwarded = false; + this->gravityNormal = gravityNormal; } inline CustomBodyState & CustomBodyState::operator = ( const CustomBodyState &state ) @@ -75,6 +76,7 @@ namespace Oyster this->isSpatiallyAltered = state.isSpatiallyAltered; this->isDisturbed = state.isDisturbed; this->isForwarded = state.isForwarded; + this->gravityNormal = state.gravityNormal; return *this; } @@ -183,6 +185,11 @@ namespace Oyster return this->deltaAxis; } + inline const ::Oyster::Math::Float4 & CustomBodyState::GetGravityNormal() const + { + return this->gravityNormal; + } + inline void CustomBodyState::SetMass_KeepMomentum( ::Oyster::Math::Float m ) { this->mass = m; @@ -285,6 +292,11 @@ namespace Oyster this->isDisturbed = true; } + inline void CustomBodyState::SetGravityNormal( const ::Oyster::Math::Float4 &gravityNormal ) + { + this->gravityNormal = gravityNormal; + } + inline void CustomBodyState::AddRotation( const ::Oyster::Math::Float4 &angularAxis ) { this->angularAxis += angularAxis; diff --git a/Code/GamePhysics/PhysicsStructs.h b/Code/GamePhysics/PhysicsStructs.h index eafe2b20..059e9f98 100644 --- a/Code/GamePhysics/PhysicsStructs.h +++ b/Code/GamePhysics/PhysicsStructs.h @@ -53,7 +53,8 @@ namespace Oyster { namespace Physics const ::Oyster::Math::Float4 ¢erPos = ::Oyster::Math::Float4::standard_unit_w, const ::Oyster::Math::Float4 &rotation = ::Oyster::Math::Float4::null, const ::Oyster::Math::Float4 &linearMomentum = ::Oyster::Math::Float4::null, - const ::Oyster::Math::Float4 &angularMomentum = ::Oyster::Math::Float4::null ); + const ::Oyster::Math::Float4 &angularMomentum = ::Oyster::Math::Float4::null, + const ::Oyster::Math::Float4 &gravityNormal = ::Oyster::Math::Float4::null); CustomBodyState & operator = ( const CustomBodyState &state ); @@ -78,6 +79,7 @@ namespace Oyster { namespace Physics const ::Oyster::Math::Float4 & GetAngularImpulse() const; const ::Oyster::Math::Float4 & GetForward_DeltaPos() const; const ::Oyster::Math::Float4 & GetForward_DeltaAxis() const; + const ::Oyster::Math::Float4 & GetGravityNormal() const; void SetMass_KeepMomentum( ::Oyster::Math::Float m ); void SetMass_KeepVelocity( ::Oyster::Math::Float m ); @@ -95,6 +97,7 @@ namespace Oyster { namespace Physics void SetAngularMomentum( const ::Oyster::Math::Float4 &h ); void SetLinearImpulse( const ::Oyster::Math::Float4 &j ); void SetAngularImpulse( const ::Oyster::Math::Float4 &j ); + void SetGravityNormal( const ::Oyster::Math::Float4 &gravityNormal ); void AddRotation( const ::Oyster::Math::Float4 &angularAxis ); void AddTranslation( const ::Oyster::Math::Float4 &deltaPos ); @@ -115,6 +118,7 @@ namespace Oyster { namespace Physics ::Oyster::Math::Float4 linearMomentum, angularMomentum; ::Oyster::Math::Float4 linearImpulse, angularImpulse; ::Oyster::Math::Float4 deltaPos, deltaAxis; // Forwarding data sum + ::Oyster::Math::Float4 gravityNormal; bool isSpatiallyAltered, isDisturbed, isForwarded; }; diff --git a/Code/OysterPhysics3D/RigidBody.h b/Code/OysterPhysics3D/RigidBody.h index a2f44480..51c5d2d8 100644 --- a/Code/OysterPhysics3D/RigidBody.h +++ b/Code/OysterPhysics3D/RigidBody.h @@ -20,7 +20,8 @@ namespace Oyster { namespace Physics3D momentum_Linear, //!< The linear momentum G (kg*m/s). momentum_Angular, //!< The angular momentum H (Nm*s) around an parallell axis. impulse_Linear, //!< The linear impulse sum Jl (kg*m/s) that will be consumed each update. - impulse_Angular; //!< The angular impulse sum Ja (kg*m^2/s) that will be consumed each update. + impulse_Angular, //!< The angular impulse sum Ja (kg*m^2/s) that will be consumed each update. + gravityNormal; ::Oyster::Math::Float restitutionCoeff, //!< frictionCoeff_Static, //!< frictionCoeff_Kinetic; //!<