91#include "sfh/timers/Timer.h"
94#include <Eigen/Geometry>
115 CBall(std::string simObjectName, ISimObjectCreator* creator);
119#ifdef FH_VISUALIZATION
122 virtual void RenderInit(Ogre::Root*
const OgreRoot, ISimObjectCreator*
const creator);
125 virtual void RenderUpdate(
const double T,
const double*
const X);
139 void OdeFcn(
const double T,
const double*
const X,
double*
const XDot,
const bool IsMajorTimeStep);
150 const double*
ForceOut(
const double T,
const double*
const X);
181 virtual const double*
Position(
const double T,
const double*
const X);
190 virtual const double*
Velocity(
const double T,
const double*
const X);
213#ifdef FH_VISUALIZATION
214 std::string m_material;
215 std::string m_meshName;
217 Ogre::SceneManager* m_sceneMgr;
218 vector<Ogre::SceneNode*> m_renderNodes;
219 vector<Ogre::Entity*> m_renderEntities;
Eigen::VectorXd m_interForces
3-DOF force acting on each ball i (col(F_i)) from the box. [N]
Definition: CBall.h:202
virtual const double * Velocity(const double T, const double *const X)
Returns the position of the balls.
const double * ForceOut(const double T, const double *const X)
Returns the force acting from the balls on the box.
CBall(std::string simObjectName, ISimObjectCreator *creator)
Reads parameters, registers states, input/output ports and shared resources.
void CalcForces(const double T, const double *const X)
Calculates contact forces between balls and box.
void ForceInterBall(const double T, const double *const X)
Calculates contact forces between the balls.
int m_iStatePos
Orientation of the box, Euler angles, x,y,z [rad].
Definition: CBall.h:206
Eigen::VectorXd m_forces
Side of the plane, relative normal vector (-1: inside, 1: outside, else: undef)
Definition: CBall.h:201
double m_time
The force acting on the box. [N].
Definition: CBall.h:210
double m_outForce[3]
The index of the velocity state.
Definition: CBall.h:209
ISignalPort * m_inBoxPos
3-DOF force acting between each ball i (col(F_i)). [N]
Definition: CBall.h:204
double * m_radius
The masses of the balls. [kg].
Definition: CBall.h:196
double m_gravity
Number of balls [#].
Definition: CBall.h:194
Eigen::Vector3d m_norms[6]
The dimensions of the box Lx, Ly, Lz [m].
Definition: CBall.h:199
void OdeFcn(const double T, const double *const X, double *const XDot, const bool IsMajorTimeStep)
Cleans up dynamically allocated memory.
double * m_mass
The gravity (assumed along z-axis) [kgms^-2].
Definition: CBall.h:195
double m_boxDim[3]
The linear stiffnesses of the ball. [N/m].
Definition: CBall.h:198
int m_planeSide[6]
Array of box unit normal vectors [-].
Definition: CBall.h:200
double * m_stiffness
The radii of the balls. [m].
Definition: CBall.h:197
int m_iStateVel
The index of the position state.
Definition: CBall.h:207
ISignalPort * m_inBoxRot
Centroid of the box [m].
Definition: CBall.h:205
virtual const double * Position(const double T, const double *const X)
Returns the velocity of the balls.