TAPsSpringVertex.cpp

Go to the documentation of this file.

/******************************************************************************
TAPsSpringVertex.cpp

SpringVertex class is a class for a spring connecting between two ParticleVertex.

SUKITTI PUNAK   (11/08/2004)
UPDATE          (11/08/2004)
******************************************************************************/
#include "TAPsSpringVertex.hpp"
// Using Inclusion Model (i.e. definitions are included in declarations)
//                       (this name.cpp is included in name.hpp)
// Each friend is defined directly inside its declaration.

BEGIN_NAMESPACE_TAPs
//=============================================================================
// Constructors and Destructor
//-----------------------------------------------------------------------------
// SpringVertex Constructor
template <typename T>
SpringVertex<T>::SpringVertex
(
    ParticleVertex<T> &P1, 
    ParticleVertex<T> &P2, 
    T k, T d, T l 
)   : 
    m_rcP1( P1 ), 
    m_rcP2( P2 ), 
    m_tK( k ), 
    m_tD( d ), 
    m_tL( l )
{}
//-----------------------------------------------------------------------------
// SpringVertex Constructor
template <typename T>
SpringVertex<T>::SpringVertex
(
    ParticleVertex<T> &P1, 
    ParticleVertex<T> &P2, 
    T k, T d
)   : 
    m_rcP1( P1 ), 
    m_rcP2( P2 ), 
    m_tK( k ), 
    m_tD( d )
{
    T x = P2.GetPosition().GetX() - P1.GetPosition().GetX();
    T y = P2.GetPosition().GetY() - P1.GetPosition().GetY();
    T z = P2.GetPosition().GetZ() - P1.GetPosition().GetZ();
    m_tL = sqrt( x*x + y*y + z*z );
}
//-----------------------------------------------------------------------------
// SpringVertex Destructor
template <typename T>
SpringVertex<T>::~SpringVertex()
{}
//-----------------------------------------------------------------------------
//=============================================================================
// Calculate and Return the (Internal) Force of a Spring
//-----------------------------------------------------------------------------
template <typename T>
Vector3<T> SpringVertex<T>::GetForce() const
{
    // Local Variables ---------------------------------------------------------
    // spring current length vector
    Vector3<T> cL = ( m_rcP1.GetPosition() - m_rcP2.GetPosition() );
    // spring current length scalar
    T scl = cL.Length();
    // velocity difference of the two particles linked by the spring
    Vector3<T> V = ( m_rcP1.GetVelocity() - m_rcP2.GetVelocity() );

    // F1 = -{Ks(l - r) + Kd[(V1-V2)*L]/l}*L/l
    // F2 = -F1
    //   where Ks = spring stiffness, Kd = spring damping,
    //     V1 and V2 are velocity of particles linked by the spring
    //     r = spring rest length
    //     L = vector of difference of positions of particle#1 and #2
    //     l = magnitude of L
    return -( (m_tK * (scl - m_tL)) +  (m_tD * ((V*cL) / scl)) ) * (cL / scl);
}
//-----------------------------------------------------------------------------
//=============================================================================
// Get/Set Functions
//-----------------------------------------------------------------------------
// Get Particle #1
template <typename T>
inline ParticleVertex<T> & SpringVertex<T>::GetParticleVertexOne ()
{   return m_rcP1;  }
//-----------------------------------------------------------------------------
// Get Particle #2
template <typename T>
inline ParticleVertex<T> & SpringVertex<T>::GetParticleVertexTwo ()
{   return m_rcP2;  }
//-----------------------------------------------------------------------------
// Get Constant K
template <typename T>
inline T SpringVertex<T>::GetConstantK () const
{   return m_tK;    }
//-----------------------------------------------------------------------------
// Get Damping D
template <typename T>
inline T SpringVertex<T>::GetDampingD () const
{   return m_tD;    }
//-----------------------------------------------------------------------------
// Get Rest Length L
template <typename T>
inline T SpringVertex<T>::GetRestLengthL() const
{   return m_tL;    }
//-----------------------------------------------------------------------------
// Get Current Length
template <typename T>
inline T SpringVertex<T>::GetCurrentLength() const
{   return ( m_rcP1.GetPosition() - m_rcP2.GetPosition() ).Length();    }
//-----------------------------------------------------------------------------
//=============================================================================
END_NAMESPACE_TAPs
//345678901234567890123456789012345678901234567890123456789012345678901234567890
//--+----1----+----2----+----3----+----4----+----5----+----6----+----7----+----8