Visual Servoing Platform  version 3.2.0
vpFeaturePoint3D Class Reference

#include <vpFeaturePoint3D.h>

+ Inheritance diagram for vpFeaturePoint3D:

Public Types

enum  { FEATURE_ALL = 0xffff }
 
enum  vpBasicFeatureDeallocatorType { user, vpServo }
 

Public Member Functions

 vpFeaturePoint3D ()
 
virtual ~vpFeaturePoint3D ()
 
void buildFrom (const vpPoint &p)
 
void buildFrom (const double X, const double Y, const double Z)
 
void display (const vpCameraParameters &cam, const vpImage< unsigned char > &I, const vpColor &color=vpColor::green, unsigned int thickness=1) const
 
void display (const vpCameraParameters &cam, const vpImage< vpRGBa > &I, const vpColor &color=vpColor::green, unsigned int thickness=1) const
 
vpFeaturePoint3Dduplicate () const
 
vpColVector error (const vpBasicFeature &s_star, const unsigned int select=FEATURE_ALL)
 
double get_X () const
 
double get_Y () const
 
double get_Z () const
 
void init ()
 
vpMatrix interaction (const unsigned int select=FEATURE_ALL)
 
void print (const unsigned int select=FEATURE_ALL) const
 
void set_X (const double X)
 
void set_Y (const double Y)
 
void set_Z (const double Z)
 
void set_XYZ (const double X, const double Y, const double Z)
 

Static Public Member Functions

static unsigned int selectX ()
 
static unsigned int selectY ()
 
static unsigned int selectZ ()
 

Static Public Attributes

static const unsigned int FEATURE_LINE [32]
 

Protected Attributes

vpColVector s
 
unsigned int dim_s
 
bool * flags
 
unsigned int nbParameters
 

Inherited functionalities from vpBasicFeature

unsigned int dimension_s ()
 
vpColVector get_s (unsigned int select=FEATURE_ALL) const
 
vpBasicFeatureDeallocatorType getDeallocate ()
 
unsigned int getDimension (const unsigned int select=FEATURE_ALL) const
 
virtual double operator[] (const unsigned int i) const
 
void setDeallocate (vpBasicFeatureDeallocatorType d)
 
void setFlags ()
 
static unsigned int selectAll ()
 
vpBasicFeatureDeallocatorType deallocate
 
void resetFlags ()
 

Detailed Description

Class that defines the 3D point visual feature.

A 3D point visual feature corresponds to a 3D point with $ {\bf X} = (X,Y,Z)$ coordinates in the camera frame.

This class is intended to manipulate the 3D point visual feature $ s = (X,Y,Z) $. The interaction matrix related to $ s $ is given by:

\[ L = \left[ \begin{array}{rrrrrr} -1 & 0 & 0 & 0 & -Z & Y \\ 0 & -1 & 0 & Z & 0 & -X \\ 0 & 0 & -1 & -Y & X & 0 \\ \end{array} \right] \]

Two ways are allowed to initialize the feature.

The interaction() method allows to compute the interaction matrix $ L$ associated to the 3D point visual feature, while the error() method computes the error vector $ (s - s^*)$ between the current visual feature and the desired one.

The code below shows how to create a eye-in hand visual servoing task using a 3D point feature $(X,Y,Z)$ that correspond to the 3D point coordinates in the camera frame. To control six degrees of freedom, at least three other features must be considered like vpFeatureThetaU visual features. First we create a current ( $s$) and desired ( $s^*$) 3D point feature, set the task to use the interaction matrix associated to the desired feature $L_{s^*}$ and than compute the camera velocity $v=-\lambda \; {L_{s^*}}^+ \; (s-s^*)$. The current feature $s$ is updated in the while() loop while $s^*$ is set to $Z^*=1$.

#include <iostream>
#include <visp3/core/vpHomogeneousMatrix.h>
#include <visp3/visual_features/vpFeaturePoint3D.h>
#include <visp3/vs/vpServo.h>
int main()
{
vpServo task; // Visual servoing task
// Set the 3D point coordinates in the object frame: oP
vpPoint point(0.1, -0.1, 0);
vpHomogeneousMatrix cMo; // Pose between the camera and the object frame
cMo.buildFrom(0, 0, 1.2, 0, 0, 0);
// ... cMo need here to be computed from a pose estimation
point.changeFrame(cMo); // Compute the 3D point coordinates in the camera frame cP = cMo * oP
// Creation of the current feature s
s.buildFrom(point); // Initialize the feature from the 3D point coordinates in the camera frame: s=(X,Y,Z)
s.print();
// Creation of the desired feature s*.
s_star.buildFrom(0, 0, 1); // Z*=1 meter
s_star.print();
// Set eye-in-hand control law.
// The computed velocities will be expressed in the camera frame
// Interaction matrix is computed with the desired visual features s*
// Set the constant gain
double lambda = 0.8;
task.setLambda(lambda);
// Add the 3D point feature to the task
task.addFeature(s, s_star);
// Control loop
for ( ; ; ) {
// ... cMo need here to be estimated from for example a pose estimation.
point.changeFrame(cMo); // Compute the 3D point coordinates in the camera frame cP = cMo * oP
// Update the current 3D point visual feature
s.buildFrom(point);
// compute the control law
vpColVector v = task.computeControlLaw(); // camera velocity
}
}

If you want to deal only with the $(X,Y)$ subset feature from the 3D point feature, you have just to modify the addFeature() call in the previous example by the following line. In that case, the dimension of $s$ is two.

// Add the (X,Y) subset feature from the 3D point visual feature to the task

If you want to build your own control law, this other example shows how to create a current ( $s$) and desired ( $s^*$) 3D point visual feature, compute the corresponding error vector $(s-s^*)$ and finally build the interaction matrix $L_s$.

#include <iostream>
#include <visp3/core/vpHomogeneousMatrix.h>
#include <visp3/core/vpMatrix.h>
#include <visp3/visual_features/vpFeaturePoint3D.h>
int main()
{
// Set the 3D point coordinates in the object frame: oP
vpPoint point(0.1, -0.1, 0);
vpHomogeneousMatrix cMo; // Pose between the camera and the object frame
cMo.buildFrom(0, 0, 1.2, 0, 0, 0);
// ... cMo need here to be computed from a pose estimation
point.changeFrame(cMo); // Compute the 3D point coordinates in the camera frame cP = cMo * oP
// Creation of the current feature s
s.buildFrom(point); // Initialize the feature from the 3D point coordinates in the camera frame
s.print();
// Creation of the desired feature s*.
s_star.buildFrom(0, 0, 1); // Z*=1 meter
s_star.print();
// Compute the L_s interaction matrix associated to the current feature
vpMatrix L = s.interaction();
std::cout << "L: " << L << std::endl;
// Compute the error vector (s-s*) for the 3D point feature
vpColVector e = s.error(s_star); // e = (s-s*)
std::cout << "e: " << e << std::endl;
}
Examples
mbot-apriltag-pbvs.cpp, servoSimuPoint2DhalfCamVelocity1.cpp, and servoSimuPoint3DCamVelocity.cpp.

Definition at line 207 of file vpFeaturePoint3D.h.

Member Enumeration Documentation

◆ anonymous enum

anonymous enum
inherited
Enumerator
FEATURE_ALL 

Definition at line 81 of file vpBasicFeature.h.

◆ vpBasicFeatureDeallocatorType

Indicates who should deallocate the feature.

Enumerator
user 
vpServo 

Definition at line 87 of file vpBasicFeature.h.

Constructor & Destructor Documentation

◆ vpFeaturePoint3D()

vpFeaturePoint3D::vpFeaturePoint3D ( )

Default constructor that build a 3D point visual feature and initialize it to ${\bf X} = (0, 0, 1)$.

Definition at line 88 of file vpFeaturePoint3D.cpp.

◆ ~vpFeaturePoint3D()

virtual vpFeaturePoint3D::~vpFeaturePoint3D ( )
inlinevirtual

Destructor. Does nothing.

Definition at line 215 of file vpFeaturePoint3D.h.

Member Function Documentation

◆ buildFrom() [1/2]

void vpFeaturePoint3D::buildFrom ( const double  X,
const double  Y,
const double  Z 
)

Build a 3D point visual feature from the camera frame coordinates $(X,Y,Z)$ of a point.

Parameters
X,Y,Z: Camera frame coordinates $(X,Y,Z)$ of a 3D point.
Exceptions
vpFeatureException::badInitializationErrorIf the depth ( $Z$ coordinate) is negative. That means that the 3D point is on the camera which is not possible.
vpFeatureException::badInitializationErrorIf the depth ( $Z$ coordinate) is null. That means that the 3D point is on the camera which is not possible.

Definition at line 447 of file vpFeaturePoint3D.cpp.

◆ buildFrom() [2/2]

void vpFeaturePoint3D::buildFrom ( const vpPoint p)

Build a 3D point visual feature from the camera frame coordinates $(X,Y,Z)$ of a point.

Parameters
p: A point with camera frame coordinates ${^c}P=(X,Y,Z)$ up to date (see vpPoint class).
Exceptions
vpFeatureException::badInitializationErrorIf the depth ( $Z$ coordinate) is negative. That means that the 3D point is behind the camera which is not possible.
vpFeatureException::badInitializationErrorIf the depth ( $Z$ coordinate) is null. That means that the 3D point is on the camera which is not possible.
Examples
mbot-apriltag-pbvs.cpp, and servoSimuPoint3DCamVelocity.cpp.

Definition at line 403 of file vpFeaturePoint3D.cpp.

◆ dimension_s()

unsigned int vpBasicFeature::dimension_s ( )
inlineinherited

Return the dimension of the feature vector $\bf s$.

Definition at line 109 of file vpBasicFeature.h.

◆ display() [1/2]

void vpFeaturePoint3D::display ( const vpCameraParameters cam,
const vpImage< unsigned char > &  I,
const vpColor color = vpColor::green,
unsigned int  thickness = 1 
) const
virtual

Not implemented.

Implements vpBasicFeature.

Definition at line 529 of file vpFeaturePoint3D.cpp.

◆ display() [2/2]

void vpFeaturePoint3D::display ( const vpCameraParameters cam,
const vpImage< vpRGBa > &  I,
const vpColor color = vpColor::green,
unsigned int  thickness = 1 
) const
virtual

Not implemented.

Implements vpBasicFeature.

Definition at line 546 of file vpFeaturePoint3D.cpp.

◆ duplicate()

vpFeaturePoint3D * vpFeaturePoint3D::duplicate ( ) const
virtual

Create an object with the same type.

s_star = s.duplicate(); // s_star is now a vpFeaturePoint3D

Implements vpBasicFeature.

Definition at line 519 of file vpFeaturePoint3D.cpp.

◆ error()

vpColVector vpFeaturePoint3D::error ( const vpBasicFeature s_star,
const unsigned int  select = FEATURE_ALL 
)
virtual

Compute the error $ (s-s^*)$ between the current and the desired visual features from a subset of the possible features.

Parameters
s_star: Desired 3D point visual feature.
select: The error can be computed for a selection of a subset of the possible 3D point coordinate features.
  • To compute the error for all the three coordinates use vpBasicFeature::FEATURE_ALL. In that case the error vector is a 3 dimension column vector.
  • To compute the error for only one of the coordinate feature $(X,Y, or Z)$ use one of the corresponding function selectX(), selectY() or selectZ(). In that case the error vector is a 1 dimension column vector.
Returns
The error $ (s-s^*)$ between the current and the desired visual feature.

The code below shows how to use this method to manipulate the $ Z $ subset:

// Creation of the current feature s
s.set_Z(0.8); // Initialization of the current Z feature
// Creation of the desired feature s*.
s_star.set_Z(1); // Initialization of the current Z* feature to Z*=1 meter
// Compute the interaction matrix for the Z coordinate feature
vpMatrix L_Z = s.interaction( vpFeaturePoint3D::selectZ() );
// Compute the error vector (s-s*) for the Z feature
s.error(s_star, vpFeaturePoint3D::selectZ());

To manipulate the subset features $s=(Y, Z)$, the code becomes:

// Compute the interaction matrix for the Y, Z feature coordinates
vpMatrix L_YZ = s.interaction( vpFeaturePoint3D::selectY() |
// Compute the error vector e = (s-s*) for the Y, Z feature coordinates

Reimplemented from vpBasicFeature.

Definition at line 357 of file vpFeaturePoint3D.cpp.

◆ get_s()

vpColVector vpBasicFeature::get_s ( unsigned int  select = FEATURE_ALL) const
inherited

Get the feature vector $\bf s$.

Examples
servoAfma6Ellipse2DCamVelocity.cpp.

Definition at line 113 of file vpBasicFeature.cpp.

◆ get_X()

double vpFeaturePoint3D::get_X ( ) const

Return the $X$ coordinate in the camera frame of the 3D point.

Definition at line 154 of file vpFeaturePoint3D.cpp.

◆ get_Y()

double vpFeaturePoint3D::get_Y ( ) const

Return the $Y$ coordinate in the camera frame of the 3D point.

Definition at line 157 of file vpFeaturePoint3D.cpp.

◆ get_Z()

double vpFeaturePoint3D::get_Z ( ) const

Return the $Z$ coordinate in the camera frame of the 3D point.

Definition at line 160 of file vpFeaturePoint3D.cpp.

◆ getDeallocate()

vpBasicFeatureDeallocatorType vpBasicFeature::getDeallocate ( )
inlineinherited

Definition at line 122 of file vpBasicFeature.h.

◆ getDimension()

unsigned int vpBasicFeature::getDimension ( const unsigned int  select = FEATURE_ALL) const
inherited

Get the feature vector dimension.

Definition at line 99 of file vpBasicFeature.cpp.

◆ init()

void vpFeaturePoint3D::init ( void  )
virtual

Initialise the memory space requested for a 3D point visual feature.

By default this feature is initialized to ${\bf X} = (0, 0, 1)$.

Implements vpBasicFeature.

Definition at line 63 of file vpFeaturePoint3D.cpp.

◆ interaction()

vpMatrix vpFeaturePoint3D::interaction ( const unsigned int  select = FEATURE_ALL)
virtual

Compute and return the interaction matrix $ L $ associated to a subset of the possible 3D point features $(X,Y,Z)$ that represent the 3D point coordinates expressed in the camera frame.

\[ L = \left[ \begin{array}{rrrrrr} -1 & 0 & 0 & 0 & -Z & Y \\ 0 & -1 & 0 & Z & 0 & -X \\ 0 & 0 & -1 & -Y & X & 0 \\ \end{array} \right] \]

Parameters
select: Selection of a subset of the possible 3D point coordinate features.
  • To compute the interaction matrix for all the three subset features $(X,Y,Z)$ use vpBasicFeature::FEATURE_ALL. In that case the dimension of the interaction matrix is $ [3 \times 6] $
  • To compute the interaction matrix for only one of the subset ( $X, Y,Z$) use one of the corresponding function selectX(), selectY() or selectZ(). In that case the returned interaction matrix is $ [1 \times 6] $ dimension.
Returns
The interaction matrix computed from the 3D point coordinate features.

The code below shows how to compute the interaction matrix associated to the visual feature $s = X $.

vpPoint point;
...
// Creation of the current feature s
vpFeaturePoint3D s;
s.buildFrom(point);
vpMatrix L_X = s.interaction( vpFeaturePoint3D::selectX() );

The code below shows how to compute the interaction matrix associated to the $s = (X,Y) $ subset visual feature:

L_XY is here now a 2 by 6 matrix. The first line corresponds to the $ X $ visual feature while the second one to the $ Y $ visual feature.

It is also possible to build the interaction matrix from all the 3D point coordinates by:

vpMatrix L_XYZ = s.interaction( vpBasicFeature::FEATURE_ALL );

In that case, L_XYZ is a 3 by 6 interaction matrix where the last line corresponds to the $ Z $ visual feature.

Implements vpBasicFeature.

Definition at line 229 of file vpFeaturePoint3D.cpp.

◆ operator[]()

virtual double vpBasicFeature::operator[] ( const unsigned int  i) const
inlinevirtualinherited

Return element i in the state vector (usage : x = s[i] )

Definition at line 129 of file vpBasicFeature.h.

◆ print()

void vpFeaturePoint3D::print ( const unsigned int  select = FEATURE_ALL) const
virtual

Print to stdout the values of the current visual feature $ s $.

Parameters
select: Selection of a subset of the possible 3D point feature coordinates.
vpPoint point;
// Creation of the current feature s
s.buildFrom(point);
s.print(); // print all the 3 components of the translation feature
s.print(vpBasicFeature::FEATURE_ALL); // same behavior then previous line
s.print(vpFeaturePoint3D::selectZ()); // print only the Z component

Implements vpBasicFeature.

Definition at line 495 of file vpFeaturePoint3D.cpp.

◆ resetFlags()

void vpBasicFeature::resetFlags ( )
protectedinherited

Definition at line 130 of file vpBasicFeature.cpp.

References vpBasicFeature::flags, and vpBasicFeature::nbParameters.

◆ selectAll()

static unsigned int vpBasicFeature::selectAll ( )
inlinestaticinherited

Select all the features.

Definition at line 141 of file vpBasicFeature.h.

◆ selectX()

unsigned int vpFeaturePoint3D::selectX ( )
static

Function used to select the $ X$ subset coordinate of the 3D point visual feature.

This function is to use in conjunction with interaction() in order to compute the interaction matrix associated to $ X$ feature.

See the interaction() method for an usage example.

This function is also useful in the vpServo class to indicate that a subset of the visual feature is to use in the control law:

vpServo task;
...
// Add the (X,Y) subset coordinates features from a 3D point to the task
See also
selectY(), selectZ()
Examples
mbot-apriltag-pbvs.cpp.

Definition at line 583 of file vpFeaturePoint3D.cpp.

◆ selectY()

unsigned int vpFeaturePoint3D::selectY ( )
static

Function used to select the $ Y$ subset coordinate of the 3D point visual feature.

This function is to use in conjunction with interaction() in order to compute the interaction matrix associated to $ Y$ feature.

See the interaction() method for an usage example.

This function is also useful in the vpServo class to indicate that a subset of the visual feature is to use in the control law:

vpServo task;
...
// Add the (X,Y) subset coordinates features from a 3D point to the task
See also
selectX(), selectZ()

Definition at line 610 of file vpFeaturePoint3D.cpp.

◆ selectZ()

unsigned int vpFeaturePoint3D::selectZ ( )
static

Function used to select the $ Z$ subset coordinate of the 3D point visual feature.

This function is to use in conjunction with interaction() in order to compute the interaction matrix associated to $ Z$ feature.

See the interaction() method for an usage example.

This function is also useful in the vpServo class to indicate that a subset of the visual feature is to use in the control law:

vpServo task;
...
// Add the (Z) subset coordinate feature from a 3D point to the task
See also
selectX(), selectY()
Examples
mbot-apriltag-pbvs.cpp, and servoSimuPoint2DhalfCamVelocity1.cpp.

Definition at line 636 of file vpFeaturePoint3D.cpp.

◆ set_X()

void vpFeaturePoint3D::set_X ( const double  X)

Initialise the $X$ coordinate in the camera frame of the 3D Point visual feature ${\bf X} = (X,Y,Z)$.

Parameters
X: $X$ coordinate of the visual feature.
See also
get_X()

Definition at line 99 of file vpFeaturePoint3D.cpp.

◆ set_XYZ()

void vpFeaturePoint3D::set_XYZ ( const double  X,
const double  Y,
const double  Z 
)

Initialize the 3D point coordinates.

Parameters
X,Y,Z: $(X,Y,Z)$ coordinates in the camera frame of the 3D point visual feature.
See also
set_X(), set_Y(), set_Z()
Examples
mbot-apriltag-pbvs.cpp, and servoSimuPoint3DCamVelocity.cpp.

Definition at line 143 of file vpFeaturePoint3D.cpp.

◆ set_Y()

void vpFeaturePoint3D::set_Y ( const double  Y)

Initialise the $Y$ coordinate in the camera frame of the 3D Point visual feature ${\bf X} = (X,Y,Z)$.

Parameters
Y: $Y$ coordinate of the visual feature.
See also
get_Y()

Definition at line 114 of file vpFeaturePoint3D.cpp.

◆ set_Z()

void vpFeaturePoint3D::set_Z ( const double  Z)

Initialise the $Z$ coordinate in the camera frame of the 3D Point visual feature ${\bf X} = (X,Y,Z)$.

Parameters
Z: $Z$ coordinate or depth of the visual feature.
See also
get_Z()

Definition at line 129 of file vpFeaturePoint3D.cpp.

◆ setDeallocate()

void vpBasicFeature::setDeallocate ( vpBasicFeatureDeallocatorType  d)
inlineinherited

Definition at line 136 of file vpBasicFeature.h.

◆ setFlags()

void vpBasicFeature::setFlags ( )
inherited

Set feature flags to true to prevent warning when re-computing the interaction matrix without having updated the feature.

Definition at line 140 of file vpBasicFeature.cpp.

Member Data Documentation

◆ deallocate

vpBasicFeatureDeallocatorType vpBasicFeature::deallocate
protectedinherited

Definition at line 147 of file vpBasicFeature.h.

◆ dim_s

unsigned int vpBasicFeature::dim_s
protectedinherited

Dimension of the visual feature.

Definition at line 93 of file vpBasicFeature.h.

Referenced by vpGenericFeature::duplicate(), vpFeatureVanishingPoint::init(), vpFeatureEllipse::init(), and vpFeatureLuminance::init().

◆ FEATURE_LINE

const unsigned int vpBasicFeature::FEATURE_LINE
staticinherited
Initial value:
= {
(unsigned int)(1 << 0), (unsigned int)(1 << 1), (unsigned int)(1 << 2), (unsigned int)(1 << 3),
(unsigned int)(1 << 4), (unsigned int)(1 << 5), (unsigned int)(1 << 6), (unsigned int)(1 << 7),
(unsigned int)(1 << 8), (unsigned int)(1 << 9), (unsigned int)(1 << 10), (unsigned int)(1 << 11),
(unsigned int)(1 << 12), (unsigned int)(1 << 13), (unsigned int)(1 << 14), (unsigned int)(1 << 15),
(unsigned int)(1 << 16), (unsigned int)(1 << 17), (unsigned int)(1 << 18), (unsigned int)(1 << 19),
(unsigned int)(1 << 20), (unsigned int)(1 << 21), (unsigned int)(1 << 22), (unsigned int)(1 << 23),
(unsigned int)(1 << 24), (unsigned int)(1 << 25), (unsigned int)(1 << 26), (unsigned int)(1 << 27),
(unsigned int)(1 << 28), (unsigned int)(1 << 29), (unsigned int)(1 << 30), (unsigned int)(1 << 31)}

Definition at line 79 of file vpBasicFeature.h.

Referenced by vpFeatureEllipse::selectMu02(), vpFeatureEllipse::selectMu11(), vpFeatureEllipse::selectMu20(), vpFeatureVanishingPoint::selectY(), and vpFeatureEllipse::selectY().

◆ flags

bool* vpBasicFeature::flags
protectedinherited

◆ nbParameters

unsigned int vpBasicFeature::nbParameters
protectedinherited

◆ s

vpFeaturePoint3D
Class that defines the 3D point visual feature.
Definition: vpFeaturePoint3D.h:207
vpFeaturePoint3D::selectY
static unsigned int selectY()
Definition: vpFeaturePoint3D.cpp:610
vpFeaturePoint3D::print
void print(const unsigned int select=FEATURE_ALL) const
Definition: vpFeaturePoint3D.cpp:495
vpServo::setLambda
void setLambda(double c)
Definition: vpServo.h:405
vpServo::EYEINHAND_CAMERA
Definition: vpServo.h:158
vpFeatureTranslation
Class that defines the translation visual feature .
Definition: vpFeatureTranslation.h:275
vpBasicFeature::FEATURE_ALL
Definition: vpBasicFeature.h:81
vpFeaturePoint3D::selectX
static unsigned int selectX()
Definition: vpFeaturePoint3D.cpp:583
vpColVector
Implementation of column vector and the associated operations.
Definition: vpColVector.h:71
vpMatrix
Implementation of a matrix and operations on matrices.
Definition: vpMatrix.h:103
vpServo::setServo
void setServo(const vpServoType &servo_type)
Definition: vpServo.cpp:222
vpColVector::print
int print(std::ostream &s, unsigned int length, char const *intro=0) const
Definition: vpColVector.cpp:1304
vpServo::DESIRED
Definition: vpServo.h:189
vpFeaturePoint3D::buildFrom
void buildFrom(const vpPoint &p)
Definition: vpFeaturePoint3D.cpp:403
vpHomogeneousMatrix::buildFrom
void buildFrom(const vpTranslationVector &t, const vpRotationMatrix &R)
Definition: vpHomogeneousMatrix.cpp:222
vpBasicFeature::s
vpColVector s
State of the visual feature.
Definition: vpBasicFeature.h:91
vpServo::setInteractionMatrixType
void setInteractionMatrixType(const vpServoIteractionMatrixType &interactionMatrixType, const vpServoInversionType &interactionMatrixInversion=PSEUDO_INVERSE)
Definition: vpServo.cpp:573
vpServo
Definition: vpServo.h:149
vpServo::computeControlLaw
vpColVector computeControlLaw()
Definition: vpServo.cpp:934
vpServo::addFeature
void addFeature(vpBasicFeature &s, vpBasicFeature &s_star, const unsigned int select=vpBasicFeature::FEATURE_ALL)
Definition: vpServo.cpp:496
vpPoint
Class that defines what is a point.
Definition: vpPoint.h:57
vpHomogeneousMatrix
Implementation of an homogeneous matrix and operations on such kind of matrices.
Definition: vpHomogeneousMatrix.h:91
vpFeaturePoint3D::selectZ
static unsigned int selectZ()
Definition: vpFeaturePoint3D.cpp:636
vpBasicFeature
class that defines what is a visual feature
Definition: vpBasicFeature.h:76