D:/CHAI3D/build-2-0-0/2.0.0/win32/modules/GEL/CGELSkeletonNode.h

Go to the documentation of this file.

//===========================================================================
/*
    This file is part of the GEL dynamics engine.
    Copyright (C) 2003-2009 by Francois Conti, Stanford University.
    All rights reserved.

    \author    <http://www.chai3d.org>
    \author    Francois Conti
    \version   2.0.0 $Rev: 251 $
*/
//===========================================================================

//---------------------------------------------------------------------------
#ifndef CGELSkeletonNodeH
#define CGELSkeletonNodeH
//---------------------------------------------------------------------------
#include "chai3d.h"
//---------------------------------------------------------------------------
using namespace std;
//---------------------------------------------------------------------------

//===========================================================================
//===========================================================================

//===========================================================================
//===========================================================================
class cGELSkeletonNode
{
  public:

    //-----------------------------------------------------------------------
    // CONSTRUCTOR & DESTRUCTOR:
    //-----------------------------------------------------------------------

    cGELSkeletonNode();

    ~cGELSkeletonNode();


        //-----------------------------------------------------------------------
    // METHODS:
    //-----------------------------------------------------------------------

    void setMass(double a_mass);

    inline void addForce(cVector3d &a_force)
    {
        m_force.add(a_force);
    }

    inline void addTorque(cVector3d &a_torque)
    {
        m_torque.add(a_torque);
    }

    inline void setExternalForce(cVector3d &a_force)
    {
        m_externalForce = a_force;
    }

    inline void setExternalTorque(cVector3d &a_torque)
    {
        m_externalTorque = a_torque;
    }

    inline void computeNextPose(double a_timeInterval)
    {
        if (!m_fixed)
        {
            // Euler double integration for position
            cVector3d damping;
            m_vel.mulr(-m_kDampingPos * m_mass, damping);
            m_force.add(damping);
            m_acc = cDiv(m_mass, cAdd(m_force, m_externalForce));
            m_vel = cAdd(m_vel, cMul(a_timeInterval, m_acc));
            m_nextPos = cAdd(m_pos, cMul(a_timeInterval, m_vel));
        }
        else
        {
            m_nextPos = m_pos;
        }

        // Euler double integration for rotation
        cVector3d dampingAng;
        m_angVel.mulr(-m_kDampingRot * m_mass, dampingAng);
        m_torque.add(dampingAng);
        m_angAcc = cMul((1/m_inertia), m_torque);
        m_angVel = cAdd(m_angVel, cMul(a_timeInterval, m_angAcc));

        double normAngVel = m_angVel.length();
        if (normAngVel < 0.000001)
        {
            m_nextRot = m_rot;
        }
        else
        {
            m_nextRot = cRotate(m_rot, m_angVel, a_timeInterval * normAngVel);
        }
    }

    inline void applyNextPose()
    {
        m_pos = m_nextPos;
        m_rot = m_nextRot;
    }

    inline void clearForces()
    {
        if (m_useGravity)
        {
            m_force = m_gravity;
            m_force.mul(m_mass);
        }
        else
        {
            m_force.zero();
        }
        m_torque.zero();
    }

    inline void clearExternalForces()
    {
        m_externalForce.zero();
        m_externalTorque.zero();
    }

    inline void render()
    {
        // set pose
        cMatrixGL mat;
        mat.set(m_pos, m_rot);
        mat.glMatrixPushMultiply();

        // draw node
        m_color.render();
        cDrawSphere(m_radius, 12, 12);

        // draw frame
        if (default_showFrame == true)
        {
            double frameScale = 3.0 * m_radius;
            cDrawFrame(frameScale);
        }

        // pos open gl matrix
        mat.glMatrixPop();

        // render external forces
        glColor4fv( (const float *)&m_color);
        cVector3d v = cAdd(m_pos, cMul(1.0/50.0, m_externalForce));
        glBegin(GL_LINES);
          glVertex3dv( (const double *)&m_pos);
          glVertex3dv( (const double *)&v);
        glEnd();
    }


        //-----------------------------------------------------------------------
    // MEMBERS - GRAPHICAL PROPERTIES:
    //-----------------------------------------------------------------------

    cColorf m_color;


        //-----------------------------------------------------------------------
    // MEMBERS - PHYSICAL PROPERTIES:
    //-----------------------------------------------------------------------

    double m_radius;

    double m_mass;

    cVector3d m_force;

    cVector3d m_torque;

    cVector3d m_acc;

    cVector3d m_angAcc;

    cVector3d m_vel;

    cVector3d m_angVel;

    double m_kDampingPos;

    double m_kDampingRot;

    double m_inertia;

    bool m_fixed;

    bool m_useGravity;

    cVector3d m_gravity;


        //-----------------------------------------------------------------------
    // MEMBERS - POSITION & ORIENTATION:
    //-----------------------------------------------------------------------

    cVector3d m_pos;

    cMatrix3d m_rot;

    cVector3d m_nextPos;

    cMatrix3d m_nextRot;


  private:

        //-----------------------------------------------------------------------
    // MEMBERS - EXTERNAL FORCES:
    //-----------------------------------------------------------------------
      
    cVector3d m_externalForce;

    cVector3d m_externalTorque;


  public:

        //-----------------------------------------------------------------------
    // MEMBERS - DEFAULT SETTINGS:
    //-----------------------------------------------------------------------

    static double default_radius;

    static double default_kDampingPos;

    static double default_kDampingRot;

    static double default_mass;

    static bool default_useGravity;

    static cVector3d default_gravity;

    static bool default_showFrame;

    static cColorf default_color;
};

//---------------------------------------------------------------------------
#endif
//---------------------------------------------------------------------------

---

CHAI3D 2.0.0 documentation
Please address any questions to support@chai3d.org
(C) 2003-2009 - CHAI 3D
All Rights Reserved.