mechanism.h

Go to the documentation of this file.

#ifndef MECHANISMH
#define MECHANISMH

#include "vector.h"
#include "cuiksystem.h"
#include "box.h"
#include "link.h"
#include "joint.h"
#include "plot3d.h"
#include "color.h"

/****************************************************************************/
#define INIT_NUM_LINKS 10
/****************************************************************************/
#define INIT_NUM_JOINTS 10
/****************************************************************************/

typedef struct {
  Tvector joints; 
  Tvector links;  
  unsigned int nbodies; 
  double maxCoord; 
} Tmechanism;

void InitMechanism(Tmechanism *m);

unsigned int GetMechanismNLinks(Tmechanism *m);

unsigned int GetMechanismNJoints(Tmechanism *m);

unsigned int GetMechanismNBodies(Tmechanism *m);

signed int GetMechanismDOF(Tmechanism *m);

void GetMechanismDefiningPoint(unsigned int lID,unsigned int bID,unsigned int pID,
                               double *p,Tmechanism *m);

unsigned int AddLink2Mechanism(Tlink *l,Tmechanism *m);

unsigned int AddJoint2Mechanism(Tjoint *j,Tmechanism *m);

unsigned int AddBody2Mechanism(unsigned int lID,Tcpolyhedron *b,Tmechanism *m);

unsigned int GetLinkID(char *name,Tmechanism *m);

Tlink *GetMechanismLink(unsigned int i,Tmechanism *m);

Tjoint *GetMechanismJoint(unsigned int i,Tmechanism *m);



double GetMechanismMaxCoordinate(Tmechanism *m);

void PlotMechanism(Tplot3d *pt,double axesLength,Tmechanism *m);


void RegenerateMechanismSolution(TCuikSystem *cs,double *sol,Tmechanism *m);

void MoveMechanism(Tplot3d *pt,TCuikSystem *cs,double *sol,
                   double **r,Tmechanism *m);

void DeleteMechanism(Tmechanism *m);

#endif