CRigidBody.h

#ifndef C_RigidBody_H
#define C_RigidBody_H
 
#include "SimObject.h"
 
#include <Eigen/Eigen>
namespace environment
{
class EnvironmentProvider;
 
}
namespace rigidbody
{
typedef Eigen::Matrix<double, 6, 6> mat6;
typedef Eigen::Matrix<double, 6, 1> vec6;
typedef Eigen::Matrix<double, 3, 3> mat3;
typedef Eigen::Matrix<double, 3, 1> vec3;
typedef Eigen::Matrix<double, 13, 1> vec13;
typedef Eigen::Quaternion<double> quat;
 
class CRigidBody
{
   public:
   virtual ~CRigidBody(){};
 
   // r: global
   // q: global
   // dX: bodylocal
   // return: bodylocal
   virtual vec6 GetInternalForces(const vec6& dX, const vec3& r, const quat& q, environment::EnvironmentProvider* environment, double time, const double* states) = 0;
 
   // return: bodylocal
   virtual mat6 GetInertiaMatrix(const vec3& r, double time, const double* states, environment::EnvironmentProvider* environment) = 0;
 
   // all global coords
   vec13 GetSecondDerivative(const vec3& r, const quat& q, const vec3& v, const vec3 w, const vec6& externalForces, environment::EnvironmentProvider* environment, double time, const double* states);
 
   // bodylocal coords
   static vec6 GetCoriolisForce(const vec6& dX, const mat6& Inertia);
 
 
#ifdef FH_VISUALIZATION
   virtual void DrawBody(Ogre::SceneNode* renderNode, Ogre::SceneManager* sceneMgr) = 0;
#endif
 
   //static mat6 reorientInertiaRotateTranslate(const mat6& Inertia, const vec6& orientation);
   static mat6 ReorientInertiaTranslateRotate(const mat6& Inertia, const vec6& orientation);
   static mat3 MakeDyadic(const vec3& vector);
   static mat3 GetRotation(const vec3& angle);
   static mat6 GetRotation6(const vec3& angle);
};
}; // namespace rigidbody
#endif