40 #include <visp3/core/vpMath.h>
41 #include <visp3/visual_features/vpBasicFeature.h>
42 #include <visp3/visual_features/vpFeatureThetaU.h>
45 #include <visp3/core/vpException.h>
46 #include <visp3/visual_features/vpFeatureException.h>
49 #include <visp3/core/vpDebug.h>
416 if (
flags[i] ==
false) {
419 vpTRACE(
"Warning !!! The interaction matrix is computed but Tu_x "
423 vpTRACE(
"Warning !!! The interaction matrix is computed but Tu_y "
427 vpTRACE(
"Warning !!! The interaction matrix is computed but Tu_z "
431 vpTRACE(
"Problem during the reading of the variable flags");
440 for (
unsigned int i = 0; i < 3; i++) {
452 for (
unsigned int i = 0; i < 3; i++)
460 if (rotation ==
cdRc) {
473 for (
int i = 0; i < 3; i++)
474 Lx[0][i + 3] = Lw[0][i];
485 for (
int i = 0; i < 3; i++)
486 Ly[0][i + 3] = Lw[1][i];
497 for (
int i = 0; i < 3; i++)
498 Lz[0][i + 3] = Lw[2][i];
625 std::cout <<
"ThetaU:";
627 std::cout <<
" tux=" <<
s[0];
630 std::cout <<
" tuy=" <<
s[1];
633 std::cout <<
" tuz=" <<
s[2];
635 std::cout << std::endl;
652 if (rotation ==
cdRc)
666 const vpColor & ,
unsigned int )
const
668 static int firsttime = 0;
670 if (firsttime == 0) {
683 const vpColor & ,
unsigned int )
const
685 static int firsttime = 0;
687 if (firsttime == 0) {
class that defines what is a visual feature
vpColVector s
State of the visual feature.
static const unsigned int FEATURE_LINE[32]
unsigned int nbParameters
Number of parameters needed to compute the interaction matrix.
vpColVector get_s(unsigned int select=FEATURE_ALL) const
Get the feature vector .
unsigned int dim_s
Dimension of the visual feature.
vpBasicFeatureDeallocatorType deallocate
Generic class defining intrinsic camera parameters.
Implementation of column vector and the associated operations.
static vpMatrix skew(const vpColVector &v)
void resize(unsigned int i, bool flagNullify=true)
Class to define RGB colors available for display functionnalities.
Error that can be emited by the vpBasicFeature class and its derivates.
Class that defines a 3D visual feature from a axis/angle parametrization that represent the rotatio...
vpMatrix interaction(unsigned int select=FEATURE_ALL)
vpFeatureThetaURotationRepresentationType
vpFeatureThetaURotationRepresentationType getFeatureThetaURotationType() const
static unsigned int selectTUy()
vpFeatureThetaU * duplicate() const
Feature duplication.
vpColVector error(const vpBasicFeature &s_star, unsigned int select=FEATURE_ALL)
void set_TUx(double tu_x)
void display(const vpCameraParameters &cam, const vpImage< unsigned char > &I, const vpColor &color=vpColor::green, unsigned int thickness=1) const
void set_TUz(double tu_z)
void buildFrom(vpThetaUVector &tu)
static unsigned int selectTUx()
void setFeatureThetaURotationType(const vpFeatureThetaURotationRepresentationType r)
static unsigned int selectTUz()
void print(unsigned int select=FEATURE_ALL) const
void set_TUy(double tu_y)
Implementation of an homogeneous matrix and operations on such kind of matrices.
void extract(vpRotationMatrix &R) const
static double sinc(double x)
static double sqr(double x)
Implementation of a matrix and operations on matrices.
void stack(const vpMatrix &A)
Implementation of a rotation matrix and operations on such kind of matrices.
Implementation of a rotation vector as axis-angle minimal representation.