44 #include <visp3/core/vpDebug.h>
45 #include <visp3/core/vpMath.h>
46 #include <visp3/robot/vpBiclops.h>
47 #include <visp3/robot/vpRobotException.h>
80 vpCDEBUG(6) <<
"camera position: " << std::endl << fMc;
100 vpCDEBUG(6) <<
"camera position: " << std::endl << fMc;
175 fMe[0][0] = -c1 * s2;
180 fMe[1][0] = -s1 * s2;
295 os <<
"Geometric parameters: " << std::endl
369 double s2 = sin(q[1]);
370 double c2 = cos(q[1]);
403 double s1 = sin(q[0]);
404 double c1 = cos(q[0]);
void resize(unsigned int nrows, unsigned int ncols, bool flagNullify=true, bool recopy_=true)
friend std::ostream & operator<<(std::ostream &s, const vpArray2D< Type > &A)
unsigned int getRows() const
Jacobian, geometric model functionnalities... for biclops, pan, tilt head.
void computeMGD(const vpColVector &q, vpHomogeneousMatrix &fMc) const
static const float speedLimit
void get_cVe(vpVelocityTwistMatrix &_cVe) const
static const float tiltJointLimit
void get_fJe(const vpColVector &q, vpMatrix &fJe) const
void get_fMc(const vpColVector &q, vpHomogeneousMatrix &fMc) const
vpHomogeneousMatrix get_fMe(const vpColVector &q) const
static const float panJointLimit
DenavitHartenbergModel dh_model_
void get_eJe(const vpColVector &q, vpMatrix &eJe) const
static const unsigned int ndof
Implementation of column vector and the associated operations.
error that can be emited by ViSP classes.
@ dimensionError
Bad dimension.
Implementation of an homogeneous matrix and operations on such kind of matrices.
vpHomogeneousMatrix inverse() const
Implementation of a matrix and operations on matrices.
Implementation of a pose vector and operations on poses.
vpPoseVector buildFrom(double tx, double ty, double tz, double tux, double tuy, double tuz)
vpVelocityTwistMatrix buildFrom(const vpTranslationVector &t, const vpRotationMatrix &R)