20 #ifndef _KINEMATICS_H_
21 #define _KINEMATICS_H_
24 #include "mbsim/utils/function.h"
57 virtual fmatvec::Vec
operator()(
const fmatvec::Vec &q,
const double &t,
const void * =NULL) = 0;
83 virtual int getqSize()
const {
throw;
return 0; }
84 virtual fmatvec::Vec
operator()(
const fmatvec::Vec &q,
const double &t,
const void * =NULL) {
return PJT*q(0,
PJT.cols()-1); }
89 const fmatvec::Mat& getTranslationVectors()
const {
return PJT; }
131 virtual fmatvec::Vec
operator()(
const fmatvec::Vec &q,
const double &t,
const void * =NULL) {
return (*
pos)(t); }
178 virtual fmatvec::SqrMat
operator()(
const fmatvec::Vec &q,
const double &t,
const void * =NULL) = 0;
212 virtual fmatvec::SqrMat
operator()(
const fmatvec::Vec &q,
const double &t,
const void * =NULL);
228 virtual fmatvec::SqrMat
operator()(
const fmatvec::Vec &q,
const double &t,
const void * =NULL);
245 virtual fmatvec::SqrMat
operator()(
const fmatvec::Vec &q,
const double &t,
const void * =NULL);
269 virtual fmatvec::SqrMat
operator()(
const fmatvec::Vec &q,
const double &t,
const void * =NULL);
274 const fmatvec::Vec& getAxisOfRotation()
const {
return a; }
275 void setAxisOfRotation(
const fmatvec::Vec& a_) {
a = a_; }
314 virtual fmatvec::SqrMat
operator()(
const fmatvec::Vec &q,
const double &t,
const void * =NULL);
320 const fmatvec::Vec& getAxisOfRotation()
const {
return rot->getAxisOfRotation(); }
321 void setAxisOfRotation(
const fmatvec::Vec& a_) {
rot->setAxisOfRotation(a_); }
367 virtual fmatvec::SqrMat
operator()(
const fmatvec::Vec &q,
const double &t,
const void * =NULL);
387 virtual fmatvec::SqrMat
operator()(
const fmatvec::Vec &q,
const double &t,
const void * =NULL);
423 virtual fmatvec::SqrMat
operator()(
const fmatvec::Vec &q,
const double &t,
const void * =NULL);
442 virtual fmatvec::SqrMat
operator()(
const fmatvec::Vec &q,
const double &t,
const void * =NULL);
474 virtual fmatvec::SqrMat
operator()(
const fmatvec::Vec &q,
const double &t,
const void * =NULL);
521 virtual fmatvec::Mat
operator()(
const fmatvec::Vec &q,
const double &t,
const void * =NULL) = 0;
549 virtual fmatvec::Mat
operator()(
const fmatvec::Vec &q,
const double &t,
const void * =NULL) {
return J; }
575 virtual fmatvec::Mat
operator()(
const fmatvec::Vec &q,
const double &t,
const void * =NULL);
605 virtual fmatvec::Mat
operator()(
const fmatvec::Vec &q,
const double &t,
const void * =NULL);
637 virtual fmatvec::Mat
operator()(
const fmatvec::Vec &q,
const double &t,
const void * =NULL);
673 virtual fmatvec::Mat
operator()(
const fmatvec::Vec &q,
const double &t,
const void * =NULL);
705 virtual fmatvec::Mat
operator()(
const fmatvec::Vec &q,
const double &t,
const void * =NULL);
737 virtual fmatvec::Mat
operator()(
const fmatvec::Vec &q,
const double &t,
const void * =NULL);
764 virtual fmatvec::Mat
operator()(
const fmatvec::Vec &qd,
const fmatvec::Vec& q,
const double& t,
const void*);
790 virtual fmatvec::Mat
operator()(
const fmatvec::Vec &qd,
const fmatvec::Vec& q,
const double& t,
const void*);