![]() |
ViSP
2.6.2
|
#include <vpMbEdgeTracker.h>
Public Member Functions | |
vpMbEdgeTracker () | |
virtual | ~vpMbEdgeTracker () |
void | setLambda (const double lambda) |
void | setMovingEdge (const vpMe &_me) |
void | loadConfigFile (const std::string &filename) |
void | loadConfigFile (const char *filename) |
void | loadModel (const std::string &cad_name) |
void | loadModel (const char *cad_name) |
void | track (const vpImage< unsigned char > &I) |
void | display (const vpImage< unsigned char > &I, const vpHomogeneousMatrix &cMo, const vpCameraParameters &cam, const vpColor &col, const unsigned int l=1, const bool displayFullModel=false) |
void | display (const vpImage< vpRGBa > &I, const vpHomogeneousMatrix &cMo, const vpCameraParameters &cam, const vpColor &col, const unsigned int l=1, const bool displayFullModel=false) |
void | resetTracker () |
void | reInitModel (const vpImage< unsigned char > &I, const char *cad_name, const vpHomogeneousMatrix &_cMo) |
void | setDisplayMovingEdges (const bool displayMe) |
void | setFirstThreshold (const double threshold1) |
double | getFirstThreshold () |
void | getMovingEdge (vpMe &_me) |
unsigned int | getNbPoints (const unsigned int _level=0) |
vpMbtPolygon * | getPolygon (const unsigned int _index) |
unsigned int | getNbPolygon () |
void | getLline (std::list< vpMbtDistanceLine * > &linesList, const unsigned int _level=0) |
void | getLcylinder (std::list< vpMbtDistanceCylinder * > &cylindersList, const unsigned int _level=0) |
void | setScales (const std::vector< bool > &_scales) |
std::vector< bool > | getScales () const |
virtual void | setCameraParameters (const vpCameraParameters &_cam) |
virtual void | initClick (const vpImage< unsigned char > &_I, const std::string &_initFile, const bool _displayHelp=false) |
virtual void | initClick (const vpImage< unsigned char > &_I, const std::vector< vpPoint > &points3D_list, const std::string &displayFile="") |
virtual void | initFromPoints (const vpImage< unsigned char > &_I, const std::string &_initFile) |
virtual void | initFromPoints (const vpImage< unsigned char > &_I, const std::vector< vpImagePoint > &points2D_list, const std::vector< vpPoint > &points3D_list) |
virtual void | initFromPose (const vpImage< unsigned char > &_I, const std::string &_initFile) |
virtual void | initFromPose (const vpImage< unsigned char > &_I, const vpHomogeneousMatrix &_cMo) |
virtual void | initFromPose (const vpImage< unsigned char > &_I, const vpPoseVector &cPo) |
virtual void | setCovarianceComputation (const bool &flag) |
virtual void | getCameraParameters (vpCameraParameters &_cam) const |
virtual vpMatrix | getCovarianceMatrix () const |
void | getPose (vpHomogeneousMatrix &_cMo) const |
vpHomogeneousMatrix | getPose () const |
void | setPoseSavingFilename (const std::string &filename) |
void | savePose (const std::string &filename) |
Deprecated functions | |
vp_deprecated vpList< vpMbtDistanceLine * > * | getLline (const unsigned int _level=0) |
vp_deprecated vpList< vpMbtDistanceCylinder * > * | getLcylinder (const unsigned int _level=0) |
vp_deprecated void | init (const vpImage< unsigned char > &I, const vpHomogeneousMatrix &cMo) |
Protected Member Functions | |
void | computeVVS (const vpImage< unsigned char > &_I) |
void | initMovingEdge (const vpImage< unsigned char > &I, const vpHomogeneousMatrix &_cMo) |
void | trackMovingEdge (const vpImage< unsigned char > &I) |
void | updateMovingEdge (const vpImage< unsigned char > &I) |
void | visibleFace (const vpHomogeneousMatrix &cMo, bool &newvisibleline) |
void | reinitMovingEdge (const vpImage< unsigned char > &I, const vpHomogeneousMatrix &_cMo) |
void | addPolygon (vpMbtPolygon &p) |
void | addLine (vpPoint &p1, vpPoint &p2, int polygone=-1, std::string name="") |
void | removeLine (const std::string &name) |
void | addCylinder (const vpPoint &P1, const vpPoint &P2, const double r, const std::string &name="") |
void | removeCylinder (const std::string &name) |
virtual void | initFaceFromCorners (const std::vector< vpPoint > &_corners, const unsigned int _indexFace=-1) |
virtual void | initCylinder (const vpPoint &_p1, const vpPoint _p2, const double _radius, const unsigned int _indexCylinder=0) |
void | testTracking () |
void | initPyramid (const vpImage< unsigned char > &_I, std::vector< const vpImage< unsigned char > * > &_pyramid) |
void | cleanPyramid (std::vector< const vpImage< unsigned char > * > &_pyramid) |
void | reInitLevel (const unsigned int _lvl) |
void | downScale (const unsigned int _scale) |
void | upScale (const unsigned int _scale) |
virtual void | loadVRMLModel (const std::string &_modelFile) |
virtual void | loadCAOModel (const std::string &_modelFile) |
void | computeJTR (const vpMatrix &_J, const vpColVector &_R, vpMatrix &_JTR) |
virtual void | extractFaces (SoVRMLIndexedFaceSet *_face_set) |
virtual void | extractLines (SoVRMLIndexedLineSet *_line_set) |
virtual void | extractCylinders (SoVRMLIndexedFaceSet *_face_set) |
vpPoint | getGravityCenter (const std::vector< vpPoint > &_pts) |
Protected Attributes | |
int | compute_interaction |
double | lambda |
vpMe | me |
std::vector< std::list< vpMbtDistanceLine * > > | lines |
std::vector< std::list< vpMbtDistanceCylinder * > > | cylinders |
unsigned int | nline |
unsigned int | ncylinder |
int | index_polygon |
vpMbtHiddenFaces | faces |
unsigned int | nbvisiblepolygone |
bool | displayMe |
double | percentageGdPt |
std::vector< bool > | scales |
std::vector< const vpImage< unsigned char > * > | Ipyramid |
unsigned int | scaleLevel |
vpCameraParameters | cam |
vpHomogeneousMatrix | cMo |
std::string | modelFileName |
bool | modelInitialised |
bool | cameraInitialised |
bool | coinUsed |
std::string | poseSavingFilename |
bool | computeCovariance |
vpMatrix | covarianceMatrix |
Make the complete tracking of an object by using its CAD model.
This class realise the tracking of an object or a scene given its 3D model. A video example can be found in the http://www.irisa.fr/lagadic/visp/computer-vision.html webpage. The tracker requires the knowledge of the 3D model that could be provided in a vrml or in a cao file. The cao format is described in loadCAOModel(). It may also use an xml file used to tune the behavior of the tracker and an init file used to compute the pose at the very first image.
The following code shows the simplest way to use the tracker.
For application with large inter-images displacement, multi-scale tracking is also possible, by setting the number of scales used and by activating (or not) them using a vector of booleans, as presented in the following code:
The tracker can also be used without display, in that case the initial pose must be known (object always at the same initial pose for example) or computed using another method:
Finally it can be used not to track an object but just to display a model at a given pose:
Definition at line 243 of file vpMbEdgeTracker.h.
vpMbEdgeTracker::vpMbEdgeTracker | ( | ) |
Basic constructor
Definition at line 76 of file vpMbEdgeTracker.cpp.
References compute_interaction, vpMbTracker::computeCovariance, cylinders, displayMe, index_polygon, Ipyramid, lambda, lines, nbvisiblepolygone, ncylinder, nline, percentageGdPt, and scales.
|
virtual |
Basic destructor useful to deallocate the memory.
Definition at line 100 of file vpMbEdgeTracker.cpp.
References cleanPyramid(), cylinders, Ipyramid, lines, and scales.
|
protected |
Add a cylinder to the list of cylinders.
P1 | : The first extremity of the axis. |
P2 | : The second extremity of the axis. |
r | : The radius of the cylinder. |
name | : the optionnal name of the cylinder |
Definition at line 1273 of file vpMbEdgeTracker.cpp.
References vpMbTracker::cam, cylinders, downScale(), vpMath::maximum(), me, ncylinder, scales, and upScale().
Referenced by initCylinder().
|
protected |
Add a line belonging to the th polygone to the list of lines. It is defined by its two extremities.
If the line already exists, the ploygone's index is added to the list of polygon to which it belongs.
P1 | : The first extremity of the line. |
P2 | : The second extremity of the line. |
polygone | : The index of the polygon to which the line belongs. |
name | : the optionnal name of the line |
Definition at line 1200 of file vpMbEdgeTracker.cpp.
References vpMbTracker::cam, downScale(), faces, lines, me, nline, scales, and upScale().
Referenced by addPolygon().
|
protected |
Add a polygon to the list of polygons.
p | : The polygon to add. |
Definition at line 1335 of file vpMbEdgeTracker.cpp.
References addLine(), faces, and index_polygon.
Referenced by initFaceFromCorners().
|
protected |
Clean the pyramid of image allocated with the initPyramid() method. The vector has a size equal to zero at the end of the method.
_pyramid | : The pyramid of image to clean. |
Definition at line 1699 of file vpMbEdgeTracker.cpp.
Referenced by track(), and ~vpMbEdgeTracker().
|
protectedinherited |
Compute , with J the interaction matrix and R the vector of residu.
vpMatrixException::incorrectMatrixSizeError | if the sizes of the matrices do not allow the computation. |
_interaction | : The interaction matrix (size Nx6). |
_error | : The residu vector (size Nx1). |
_JTR | : The resulting JTR matrix (size 6x1). |
Definition at line 1226 of file vpMbTracker.cpp.
References vpMatrix::getCols(), vpMatrix::getRows(), vpMatrixException::incorrectMatrixSizeError, and vpMatrix::resize().
Referenced by computeVVS().
|
protected |
Compute the visual servoing loop to get the pose of the feature set.
vpTrackingException::notEnoughPointError | if the number of detected feature is equal to zero. |
_I | : The current image. |
Definition at line 165 of file vpMbEdgeTracker.cpp.
References vpMbTracker::cam, vpMbTracker::cMo, compute_interaction, vpMbTracker::computeCovariance, vpMatrix::computeCovarianceMatrix(), vpMbTracker::computeJTR(), vpMbTracker::covarianceMatrix, cylinders, vpMatrix::diag(), vpExponentialMap::direct(), vpCameraParameters::get_px(), vpMatrix::getRows(), vpMeSite::getState(), vpHomogeneousMatrix::inverse(), lambda, lines, vpMeSite::M_ESTIMATOR, vpRobust::MEstimator(), vpMeSite::NO_SUPPRESSION, vpTrackingException::notEnoughPointError, vpMatrix::pseudoInverse(), vpColVector::resize(), scaleLevel, vpRobust::setIteration(), vpMeSite::setState(), vpRobust::setThreshold(), vpMath::sign(), vpMath::sqr(), vpRobust::TUKEY, and vpERROR_TRACE.
Referenced by track().
|
virtual |
Display the 3D model from a given position of the camera.
I | : The image. |
_cMo | : Pose used to project the 3D model into the image. |
cam | : The camera parameters. |
col | : The desired color. |
thickness | : The thickness of the lines. |
displayFullModel | : If true, the full model is displayed (even the non visible surfaces). |
Implements vpMbTracker.
Definition at line 969 of file vpMbEdgeTracker.cpp.
References cylinders, lines, scaleLevel, and scales.
void vpMbEdgeTracker::display | ( | const vpImage< vpRGBa > & | I, |
const vpHomogeneousMatrix & | _cMo, | ||
const vpCameraParameters & | cam, | ||
const vpColor & | col, | ||
const unsigned int | thickness = 1 , |
||
const bool | displayFullModel = false |
||
) |
Display the 3D model from a given position of the camera.
I | : The image. |
_cMo | : Pose used to project the 3D model into the image. |
cam | : The camera parameters. |
col | : The desired color. |
thickness | : The thickness of the lines. |
displayFullModel | : If true, the full model is displayed (even the non visible surfaces). |
Definition at line 1002 of file vpMbEdgeTracker.cpp.
References cylinders, lines, scaleLevel, and scales.
|
protected |
Modify the camera parameters to have them corresponding to the current scale. The new parameters are divided by .
_scale | : Scale to use. |
Definition at line 1844 of file vpMbEdgeTracker.cpp.
References vpMbTracker::cam, vpCameraParameters::get_K(), vpCameraParameters::initFromCalibrationMatrix(), and scaleLevel.
Referenced by addCylinder(), addLine(), and track().
|
protectedvirtualinherited |
Extract a cylinder to track from the VMRL model. This method calls the initCylinder() method implemented in the child class.
_face_set | : Pointer to the cylinder in the vrml format. |
Definition at line 1078 of file vpMbTracker.cpp.
References vpException::badValue, vpException::dimensionError, vpPoint::get_oX(), vpPoint::get_oY(), vpPoint::get_oZ(), vpMbTracker::getGravityCenter(), vpMbTracker::initCylinder(), vpMath::maximum(), vpPoint::setWorldCoordinates(), and vpMatrix::sumSquare().
Referenced by vpMbTracker::loadVRMLModel().
|
protectedvirtualinherited |
Extract a face of the object to track from the VMRL model. This method calls the initFaceFromCorners() method implemented in the child class.
_face_set | : Pointer to the face in the vrml format. |
Definition at line 1028 of file vpMbTracker.cpp.
References vpMbTracker::initFaceFromCorners(), and vpPoint::setWorldCoordinates().
Referenced by vpMbTracker::loadVRMLModel().
|
protectedvirtualinherited |
Extract a line of the object to track from the VMRL model. This method calls the initFaceFromCorners() method implemented in the child class.
_line_set | : Pointer to the line in the vrml format. |
Definition at line 1171 of file vpMbTracker.cpp.
References vpMbTracker::initFaceFromCorners(), and vpPoint::setWorldCoordinates().
Referenced by vpMbTracker::loadVRMLModel().
|
inlinevirtualinherited |
Get the camera parameters.
_cam | : copy of the camera parameters used by the tracker. |
Definition at line 203 of file vpMbTracker.h.
|
inlinevirtualinherited |
|
inline |
Definition at line 340 of file vpMbEdgeTracker.h.
Compute the center of gravity of a set of point. This is used in the cylinder extraction to find the center of the circles.
vpException::dimensionError | if the set is empty. |
_pts | : Set of point to extract the center of gravity. |
Definition at line 1142 of file vpMbTracker.cpp.
References vpException::dimensionError, vpPoint::get_oX(), and vpPoint::setWorldCoordinates().
Referenced by vpMbTracker::extractCylinders().
void vpMbEdgeTracker::getLcylinder | ( | std::list< vpMbtDistanceCylinder * > & | cylindersList, |
const unsigned int | _level = 0 |
||
) |
Get the list of the cylinders tracked for the specified level. Each cylinder contains the list of the vpMeSite.
vpException::dimensionError | if the second parameter does not correspond to an used level. |
_level | : Level corresponding to the list to return. |
cylindersList | : The list of the cylinders of the model. |
Definition at line 1824 of file vpMbEdgeTracker.cpp.
References cylinders, vpException::dimensionError, and scales.
vp_deprecated vpList< vpMbtDistanceCylinder * > * vpMbEdgeTracker::getLcylinder | ( | const unsigned int | _level = 0 | ) |
Get the list of the cylinders tracked for the specified level. Each cylinder contains the list of the vpMeSite.
vpException::dimensionError | if the parameter does not correspond to an used level. |
_level | : Level corresponding to the list to return. |
Definition at line 1758 of file vpMbEdgeTracker.cpp.
References vpList< type >::addRight(), cylinders, vpException::dimensionError, and scales.
void vpMbEdgeTracker::getLline | ( | std::list< vpMbtDistanceLine * > & | linesList, |
const unsigned int | _level = 0 |
||
) |
Get the list of the lines tracked for the specified level. Each line contains the list of the vpMeSite.
vpException::dimensionError | if the second parameter does not correspond to an used level. |
_level | : Level corresponding to the list to return. |
linesList | : The list of the lines of the model. |
Definition at line 1800 of file vpMbEdgeTracker.cpp.
References vpException::dimensionError, lines, and scales.
vp_deprecated vpList< vpMbtDistanceLine * > * vpMbEdgeTracker::getLline | ( | const unsigned int | _level = 0 | ) |
Get the list of the lines tracked for the specified level. Each line contains the list of the vpMeSite.
vpException::dimensionError | if the parameter does not correspond to an used level. |
_level | : Level corresponding to the list to return. |
Definition at line 1727 of file vpMbEdgeTracker.cpp.
References vpList< type >::addRight(), vpException::dimensionError, lines, and scales.
|
inline |
Get the moving edge parameters.
Definition at line 348 of file vpMbEdgeTracker.h.
unsigned int vpMbEdgeTracker::getNbPoints | ( | const unsigned int | _level = 0 | ) |
Return the number of good points (vpMeSite) tracked. A good point is a vpMeSite with its flag "suppress" equal to 0. Only these points are used during the virtual visual servoing stage.
vpException::dimensionError | if _level does not represent a used level. |
Definition at line 1522 of file vpMbEdgeTracker.cpp.
References cylinders, vpException::dimensionError, lines, vpMeSite::NO_SUPPRESSION, and scales.
unsigned int vpMbEdgeTracker::getNbPolygon | ( | ) |
Get the number of polygon (face) representing the object to track.
Definition at line 1584 of file vpMbEdgeTracker.cpp.
References faces.
vpMbtPolygon * vpMbEdgeTracker::getPolygon | ( | const unsigned int | _index | ) |
Return the polygon (face) "index".
vpException::dimensionError | if index does not represent a good polygon. |
_index | : Index of the polygon to return. |
Definition at line 1568 of file vpMbEdgeTracker.cpp.
References vpException::dimensionError, and faces.
|
inlineinherited |
Get the current pose between the object and the camera. cMo is the matrix which can be used to express coordinates from the object frame to camera frame.
_cMo | : the pose |
Definition at line 222 of file vpMbTracker.h.
|
inlineinherited |
Get the current pose between the object and the camera. cMo is the matrix which can be used to express coordinates from the object frame to camera frame.
Definition at line 231 of file vpMbTracker.h.
|
inline |
Return the scales levels used for the tracking.
Definition at line 363 of file vpMbEdgeTracker.h.
|
virtual |
Initialize the tracking thanks to the initial pose of the camera.
I | : The image. |
_cMo | : The initial pose used to initialize the tracking. |
Implements vpMbTracker.
Definition at line 1782 of file vpMbEdgeTracker.cpp.
References vpMbTracker::cMo.
|
virtualinherited |
Initialise the tracking by clicking on the image points corresponding to the 3D points (object frame) in the file _initFile. The structure of this file is (without the comments):
_I | : Input image |
_initFile | : File containing the points where to click |
_displayHelp | : Optionnal display of an image ( '_initFile.ppm' ). This image may be used to show where to click. |
vpException::ioError | : The file specified in _initFile doesn't exist. |
Definition at line 139 of file vpMbTracker.cpp.
References vpPose::addPoint(), vpHomogeneousMatrix::buildFrom(), vpMouseButton::button1, vpMbTracker::cam, vpPose::clearPoint(), vpMbTracker::cMo, vpPose::computePose(), vpPose::computeResidual(), vpPixelMeterConversion::convertPoint(), vpPose::DEMENTHON, vpMbTracker::display(), vpDisplay::display(), vpDisplay::displayCharString(), vpDisplay::displayCross(), vpDisplay::displayFrame(), vpDisplay::displayPoint(), vpDisplay::flush(), vpDisplay::getClick(), vpColor::green, vpMbTracker::init(), vpDisplayOpenCV::init(), vpException::ioError, vpPose::LAGRANGE, vpMbTracker::poseSavingFilename, vpImageIo::readPPM(), vpColor::red, vpMbTracker::savePose(), vpPoint::set_x(), vpPoint::set_y(), vpHomogeneousMatrix::setIdentity(), vpPoint::setWorldCoordinates(), and vpPose::VIRTUAL_VS.
|
virtualinherited |
Initialise the tracking by clicking on the image points corresponding to the 3D points (object frame) in the list points3D_list.
_I | : Input image |
points3D_list | : List of the 3D points (object frame). |
displayFile | : Path to the image used to display the help. |
Definition at line 355 of file vpMbTracker.cpp.
References vpPose::addPoint(), vpMouseButton::button1, vpMbTracker::cam, vpPose::clearPoint(), vpMbTracker::cMo, vpPose::computePose(), vpPose::computeResidual(), vpPixelMeterConversion::convertPoint(), vpPose::DEMENTHON, vpMbTracker::display(), vpDisplay::display(), vpDisplay::displayCharString(), vpDisplay::displayCross(), vpDisplay::displayFrame(), vpDisplay::displayPoint(), vpDisplay::flush(), vpDisplay::getClick(), vpColor::green, vpMbTracker::init(), vpDisplayOpenCV::init(), vpPose::LAGRANGE, vpImageIo::readPPM(), vpColor::red, vpPoint::set_x(), vpPoint::set_y(), and vpPose::VIRTUAL_VS.
|
protectedvirtual |
Add a cylinder to track from tow points on the axis (defining the length of the cylinder) and its radius.
_p1 | : First point on the axis. |
_p2 | : Second point on the axis. |
_radius | : Radius of the cylinder. |
_indexCylinder | : Index of the cylinder. |
Implements vpMbTracker.
Definition at line 1442 of file vpMbEdgeTracker.cpp.
References addCylinder(), and ncylinder.
|
protectedvirtual |
Add a face to track from its corners (in the object frame). This method is called from the loadModel() one to add a face of the object to track. The initialisation of the face depends on the primitive to track.
_corners | : The vector of corners representing the face. |
_indexFace | : The index of the face. |
Implements vpMbTracker.
Definition at line 1417 of file vpMbEdgeTracker.cpp.
References addPolygon().
|
virtualinherited |
Initialise the tracking by reading the 3D points (object frame) and the image points in _initFile. The structure of this file is (without the comments):
_I | : Input image |
_initFile | : Path to the file containing all the points. |
Definition at line 471 of file vpMbTracker.cpp.
References vpPose::addPoint(), vpMbTracker::cam, vpMbTracker::cMo, vpPose::computePose(), vpPose::computeResidual(), vpPixelMeterConversion::convertPoint(), vpPose::DEMENTHON, vpMbTracker::init(), vpException::ioError, vpPose::LAGRANGE, vpPoint::set_x(), vpPoint::set_y(), vpPoint::setWorldCoordinates(), vpPose::VIRTUAL_VS, and vpERROR_TRACE.
|
virtualinherited |
Initialise the tracking with the list of image points (points2D_list) and the list of corresponding 3D points (object frame) (points3D_list).
_I | : Input image |
points2D_list | : List of image points. |
points3D_list | : List of 3D points (object frame). |
Definition at line 550 of file vpMbTracker.cpp.
References vpPose::addPoint(), vpMbTracker::cam, vpMbTracker::cMo, vpPose::computePose(), vpPose::computeResidual(), vpPixelMeterConversion::convertPoint(), vpPose::DEMENTHON, vpMbTracker::init(), vpPose::LAGRANGE, vpPoint::set_x(), vpPoint::set_y(), vpPoint::setWorldCoordinates(), vpPose::VIRTUAL_VS, and vpERROR_TRACE.
|
virtualinherited |
Initialise the tracking thanks to the pose in vpPoseVector format, and read in the file _initFile. The structure of this file is (without the comments):
Where the three firsts lines refer to the translation and the three last to the rotation in thetaU parametrisation (see vpThetaUVector).
_I | : Input image |
_initFile | : Path to the file containing the pose. |
Definition at line 604 of file vpMbTracker.cpp.
References vpHomogeneousMatrix::buildFrom(), vpMbTracker::cMo, vpMbTracker::init(), and vpException::ioError.
Referenced by vpMbTracker::initFromPose(), and reInitModel().
|
virtualinherited |
Initialise the tracking thanks to the pose.
_I | : Input image |
_cMo | : Pose matrix. |
Definition at line 639 of file vpMbTracker.cpp.
References vpMbTracker::cMo, and vpMbTracker::init().
|
virtualinherited |
Initialise the tracking thanks to the pose vector.
_I | : Input image |
cPo | : Pose vector. |
Definition at line 651 of file vpMbTracker.cpp.
References vpMbTracker::initFromPose().
|
protected |
Initialize the moving edge thanks to a given pose of the camera. The 3D model is projected into the image to create moving edges along the lines.
I | : The image. |
_cMo | : The pose of the camera used to initialize the moving edges. |
Definition at line 1033 of file vpMbEdgeTracker.cpp.
References cylinders, lines, and scaleLevel.
Referenced by track().
|
protected |
Compute the pyramid of image associated to the image in parameter. The scales computed are the ones corresponding to the scales attribte of the class. If OpenCV is detected, the functions used to computed a smoothed pyramid come from OpenCV, otherwise a simple subsampling (no smoothing, no interpolation) is realised.
_I | : The input image. |
_pyramid | : The pyramid of image to build from the input image. |
Definition at line 1653 of file vpMbEdgeTracker.cpp.
References vpImage< Type >::bitmap, vpImageConvert::convert(), vpImage< Type >::getHeight(), vpImage< Type >::getWidth(), and scales.
Referenced by track().
|
protectedvirtualinherited |
Load a 3D model contained in a .cao file.
the structure of the file is (without the comments) :
_modelFile | : Full name of the .CAO file containing the model. |
Definition at line 839 of file vpMbTracker.cpp.
References vpException::badValue, vpMbTracker::initCylinder(), vpMbTracker::initFaceFromCorners(), vpException::ioError, vpPoint::setWorldCoordinates(), and vpTRACE.
Referenced by vpMbTracker::loadModel().
|
virtual |
Load the xml configuration file. From the configuration file parameters write initialize the corresponding objects (Ecm, camera).
_filename | : full name of the xml file. |
Implements vpMbTracker.
Definition at line 913 of file vpMbEdgeTracker.cpp.
void vpMbEdgeTracker::loadConfigFile | ( | const char * | filename | ) |
Load the xml configuration file. From the configuration file parameters initialize the corresponding objects (Ecm, camera).
vpException::ioError | if the file has not been properly parsed (file not found or wrong format for the data). |
filename | : full name of the xml file. |
Definition at line 933 of file vpMbEdgeTracker.cpp.
References vpException::ioError, setCameraParameters(), setMovingEdge(), vpERROR_TRACE, and vpTRACE.
|
virtual |
Load a 3D model contained in a file.
file | : Full name the file containing the 3D model description. The extension of this file is either .wrl or .cao. |
Reimplemented from vpMbTracker.
Definition at line 1403 of file vpMbEdgeTracker.cpp.
References vpMbTracker::loadModel().
Referenced by reInitModel().
void vpMbEdgeTracker::loadModel | ( | const char * | file | ) |
Load a 3D model contained in a file. This file is either a vrml or a cao file.
file | : Full name the file containing the 3D model description. The extension of this file is either .wrl or .cao. |
Definition at line 1388 of file vpMbEdgeTracker.cpp.
References vpMbTracker::loadModel().
|
protectedvirtualinherited |
Load the 3D model of the object from a vrml file. Only LineSet and FaceSet are extracted from the vrml file.
vpException::fatalError | if the file cannot be open. |
_modelFile | : The full name of the file containing the 3D model. |
Definition at line 734 of file vpMbTracker.cpp.
References vpMbTracker::coinUsed, vpMbTracker::extractCylinders(), vpMbTracker::extractFaces(), vpMbTracker::extractLines(), vpException::fatalError, and vpERROR_TRACE.
Referenced by vpMbTracker::loadModel().
|
protected |
Re initialise the moving edges associated to a given level. This method is used to re-initialise the level if the tracking failed on this level but succedded on the other one.
_lvl | : The level to re-initialise. |
Definition at line 1889 of file vpMbEdgeTracker.cpp.
References vpMbTracker::cMo, cylinders, Ipyramid, lines, scaleLevel, trackMovingEdge(), and updateMovingEdge().
Referenced by track().
void vpMbEdgeTracker::reInitModel | ( | const vpImage< unsigned char > & | _I, |
const char * | _cad_name, | ||
const vpHomogeneousMatrix & | _cMo | ||
) |
Re-initialise the model used by the tracker.
_I | : The image containing the object to initialize. |
_cad_name | : Path to the file containing the 3D model description. |
_cMo | : The new vpHomogeneousMatrix between the camera and the new model |
Definition at line 1504 of file vpMbEdgeTracker.cpp.
References vpMbTracker::initFromPose(), loadModel(), and resetTracker().
|
protected |
Reinitialize the lines if it is required.
A line is reinitialized if the 2D line do not match enough with the projected 3D line.
I | : the image. |
_cMo | : the pose of the used to re-initialise the moving edges |
Definition at line 1150 of file vpMbEdgeTracker.cpp.
References cylinders, lines, and scaleLevel.
Referenced by track().
|
protected |
Remove a cylinder by its name.
name | : The name of the cylinder to remove. |
Definition at line 1312 of file vpMbEdgeTracker.cpp.
|
protected |
Remove a line using its name.
name | : The name of the line to remove. |
Definition at line 1244 of file vpMbEdgeTracker.cpp.
void vpMbEdgeTracker::resetTracker | ( | ) |
Reset the tracker. The model is removed and the pose is set to identity. The tracker needs to be initialized with a new model and a new pose.
Definition at line 1456 of file vpMbEdgeTracker.cpp.
References vpMbTracker::cMo, compute_interaction, cylinders, faces, index_polygon, lambda, lines, nbvisiblepolygone, ncylinder, nline, percentageGdPt, scales, vpHomogeneousMatrix::setIdentity(), and setScales().
Referenced by reInitModel().
|
inherited |
Save the pose in the given filename
filename | : Path to the file used to save the pose. |
Definition at line 662 of file vpMbTracker.cpp.
References vpPoseVector::buildFrom(), and vpMbTracker::cMo.
Referenced by vpMbTracker::initClick().
|
inlinevirtual |
Set the camera parameters.
_cam | : the new camera parameters |
Reimplemented from vpMbTracker.
Definition at line 372 of file vpMbEdgeTracker.h.
Referenced by loadConfigFile().
|
inlinevirtualinherited |
Set if the covaraince matrix has to be computed.
flag | : True if the covariance has to be computed, false otherwise |
Definition at line 196 of file vpMbTracker.h.
|
inline |
Enable to display the points along the line with a color corresponding to their state.
displayMe | : set it to true to display the points. |
Definition at line 328 of file vpMbEdgeTracker.h.
|
inline |
Set the first threshold used to check if the tracking failed. It corresponds to the percentage of good point which is necessary.
The condition which has to be be satisfied is the following : .
The threshold is ideally between 0 and 1.
threshold1 | : The new value of the threshold. |
Definition at line 339 of file vpMbEdgeTracker.h.
|
inline |
Set the value of the gain used to compute the control law.
lambda | : the desired value for the gain. |
Definition at line 300 of file vpMbEdgeTracker.h.
void vpMbEdgeTracker::setMovingEdge | ( | const vpMe & | _me | ) |
Set the moving edge parameters.
_me | : an instance of vpMe containing all the desired parameters |
Definition at line 136 of file vpMbEdgeTracker.cpp.
References cylinders, lines, me, and scales.
Referenced by loadConfigFile().
|
inlineinherited |
Set the filename used to save the initial pose computed using the initClick() method. It is also used to read a previous pose in the same method. If the file is not set then, the initClick() method will create a .0.pos file in the root directory. This directory is the path to the file given to the method initClick() used to know the coordinates in the object frame.
filename | : The new filename. |
Definition at line 242 of file vpMbTracker.h.
void vpMbEdgeTracker::setScales | ( | const std::vector< bool > & | _scales | ) |
Set the scales to use to realise the tracking. The vector of boolean activates or not the scales to se for the object tracking. The first element of the list correspond to the tracking on the full image, the second element corresponds to the tracking on an image sbsampled by two.
Using multi scale tracking allows to track the object with greater moves. It requires the computation of a pyramid of images, but the total tracking can be faster than a tracking based only on the full scale. The pose is computed from the smallest image to the biggest. This may be dangerous if the object to track is small in the image, because the subsampled scale(s) will have only few points to compute the pose (it could result in a loss of precision).
_scales | : The vector describing the levels to use. |
Definition at line 1610 of file vpMbEdgeTracker.cpp.
References cylinders, lines, scales, and vpERROR_TRACE.
Referenced by resetTracker().
|
protectedvirtual |
Check if the tracking failed.
vpTrackingException::fatalError | if the test fails. |
Implements vpMbTracker.
Definition at line 706 of file vpMbEdgeTracker.cpp.
References cylinders, vpTrackingException::fatalError, vpMeSite::getState(), lines, vpMeSite::NO_SUPPRESSION, percentageGdPt, and scaleLevel.
Referenced by track().
|
virtual |
Compute each state of the tracking procedure for all the feature sets.
If the tracking is considered as failed an exception is thrown.
I | : The image. |
Implements vpMbTracker.
Definition at line 766 of file vpMbEdgeTracker.cpp.
References cleanPyramid(), vpMbTracker::cMo, computeVVS(), cylinders, displayMe, downScale(), vpTrackingException::fatalError, vpException::fatalError, initMovingEdge(), initPyramid(), Ipyramid, lines, reInitLevel(), reinitMovingEdge(), scales, testTracking(), trackMovingEdge(), updateMovingEdge(), upScale(), visibleFace(), and vpTRACE.
|
protected |
Track the moving edges in the image.
I | : the image. |
Definition at line 1088 of file vpMbEdgeTracker.cpp.
References vpMbTracker::cMo, cylinders, lines, and scaleLevel.
Referenced by reInitLevel(), and track().
|
protected |
Update the moving edges at the end of the virtual visual servoing.
I | : the image. |
Definition at line 1118 of file vpMbEdgeTracker.cpp.
References vpMbTracker::cMo, cylinders, lines, and scaleLevel.
Referenced by reInitLevel(), and track().
|
protected |
Modify the camera parameters to have them corresponding to the current scale. The new parameters are multiplied by .
_scale | : Scale to use. |
Definition at line 1866 of file vpMbEdgeTracker.cpp.
References vpMbTracker::cam, vpCameraParameters::get_K(), vpCameraParameters::initFromCalibrationMatrix(), and scaleLevel.
Referenced by addCylinder(), addLine(), and track().
|
protected |
Detect the visible faces in the image and says if a new one appeared.
cMo | : The pose of the camera used to project the 3D model into the image. |
newvisibleline | : This parameter is set to true if a new face appeared. |
Definition at line 1361 of file vpMbEdgeTracker.cpp.
References faces, and nbvisiblepolygone.
Referenced by track().
|
protectedinherited |
The camera parameters.
Definition at line 99 of file vpMbTracker.h.
Referenced by addCylinder(), addLine(), computeVVS(), downScale(), vpMbTracker::initClick(), vpMbTracker::initFromPoints(), and upScale().
|
protectedinherited |
Flag used to ensure that the camera is set before the initialisation.
Definition at line 107 of file vpMbTracker.h.
Referenced by vpMbTracker::vpMbTracker().
|
protectedinherited |
The current pose.
Definition at line 101 of file vpMbTracker.h.
Referenced by computeVVS(), init(), vpMbTracker::initClick(), vpMbTracker::initFromPoints(), vpMbTracker::initFromPose(), reInitLevel(), resetTracker(), vpMbTracker::savePose(), track(), trackMovingEdge(), and updateMovingEdge().
|
protectedinherited |
Flag used to specify that the Coin library has been loaded in order to load a vrml model (used to free the memory).
Definition at line 109 of file vpMbTracker.h.
Referenced by vpMbTracker::loadVRMLModel(), vpMbTracker::vpMbTracker(), and vpMbTracker::~vpMbTracker().
|
protected |
If this flag is true, the interaction matrix extracted from the FeatureSet is computed at each iteration in the visual servoing loop.
Definition at line 251 of file vpMbEdgeTracker.h.
Referenced by computeVVS(), resetTracker(), and vpMbEdgeTracker().
|
protectedinherited |
Flag used to specify if the covariance matrix has to be computed or not.
Definition at line 113 of file vpMbTracker.h.
Referenced by computeVVS(), vpMbEdgeTracker(), and vpMbTracker::vpMbTracker().
|
protectedinherited |
|
protected |
Vector of the tracked cylinders.
Definition at line 260 of file vpMbEdgeTracker.h.
Referenced by addCylinder(), computeVVS(), display(), getLcylinder(), getNbPoints(), initMovingEdge(), reInitLevel(), reinitMovingEdge(), removeCylinder(), resetTracker(), setMovingEdge(), setScales(), testTracking(), track(), trackMovingEdge(), updateMovingEdge(), vpMbEdgeTracker(), and ~vpMbEdgeTracker().
|
protected |
If true, the moving edges are displayed during the track() method.
Definition at line 276 of file vpMbEdgeTracker.h.
Referenced by track(), and vpMbEdgeTracker().
|
protected |
Set of faces describing the object.
Definition at line 271 of file vpMbEdgeTracker.h.
Referenced by addLine(), addPolygon(), getNbPolygon(), getPolygon(), resetTracker(), and visibleFace().
|
protected |
Index of the polygon to add, and total number of polygon extracted so far. Cannot be unsigned because the default index of a polygon is -1.
Definition at line 269 of file vpMbEdgeTracker.h.
Referenced by addPolygon(), resetTracker(), and vpMbEdgeTracker().
|
protected |
Pyramid of image associated to the current image. This pyramid is compted in the init() and in the track() methods.
Definition at line 285 of file vpMbEdgeTracker.h.
Referenced by reInitLevel(), track(), vpMbEdgeTracker(), and ~vpMbEdgeTracker().
|
protected |
The gain of the virtual visual servoing stage.
Definition at line 253 of file vpMbEdgeTracker.h.
Referenced by computeVVS(), resetTracker(), and vpMbEdgeTracker().
|
protected |
Vector of list of all the lines tracked (each line is linked to a list of moving edges). Each element of the vector is for a scale (element 0 = level 0 = no subsampling).
Definition at line 258 of file vpMbEdgeTracker.h.
Referenced by addLine(), computeVVS(), display(), getLline(), getNbPoints(), initMovingEdge(), reInitLevel(), reinitMovingEdge(), removeLine(), resetTracker(), setMovingEdge(), setScales(), testTracking(), track(), trackMovingEdge(), updateMovingEdge(), vpMbEdgeTracker(), and ~vpMbEdgeTracker().
|
protected |
The moving edges parameters.
Definition at line 256 of file vpMbEdgeTracker.h.
Referenced by addCylinder(), addLine(), and setMovingEdge().
|
protectedinherited |
The name of the file containing the model (it is used to create a file name.0.pos used to store the compute pose in the initClick method).
Definition at line 103 of file vpMbTracker.h.
Referenced by vpMbTracker::loadModel().
|
protectedinherited |
Flag used to ensure that the CAD model is loaded before the initialisation.
Definition at line 105 of file vpMbTracker.h.
Referenced by vpMbTracker::loadModel(), and vpMbTracker::vpMbTracker().
|
protected |
Number of polygon (face) currently visible.
Definition at line 273 of file vpMbEdgeTracker.h.
Referenced by resetTracker(), visibleFace(), and vpMbEdgeTracker().
|
protected |
Index of the cylinder to add, and total number of polygon extracted so far.
Definition at line 266 of file vpMbEdgeTracker.h.
Referenced by addCylinder(), initCylinder(), resetTracker(), and vpMbEdgeTracker().
|
protected |
Index of the polygon to add, and total number of polygon extracted so far.
Definition at line 263 of file vpMbEdgeTracker.h.
Referenced by addLine(), resetTracker(), and vpMbEdgeTracker().
|
protected |
Percentage of good points over total number of points below which tracking is supposed to have failed.
Definition at line 279 of file vpMbEdgeTracker.h.
Referenced by resetTracker(), testTracking(), and vpMbEdgeTracker().
|
protectedinherited |
Filename used to save the initial pose computed using the initClick() method. It is also used to read a previous pose in the same method.
Definition at line 111 of file vpMbTracker.h.
Referenced by vpMbTracker::initClick().
|
protected |
Current scale level used. This attribute must not be modified outsied of the downScale() and upScale() methods, as it used to specify to some methods which set of distanceLine use.
Definition at line 288 of file vpMbEdgeTracker.h.
Referenced by computeVVS(), display(), downScale(), initMovingEdge(), reInitLevel(), reinitMovingEdge(), testTracking(), trackMovingEdge(), updateMovingEdge(), and upScale().
|
protected |
Vector of scale level to use for the multi-scale tracking.
Definition at line 282 of file vpMbEdgeTracker.h.
Referenced by addCylinder(), addLine(), display(), getLcylinder(), getLline(), getNbPoints(), initPyramid(), removeCylinder(), removeLine(), resetTracker(), setMovingEdge(), setScales(), track(), vpMbEdgeTracker(), and ~vpMbEdgeTracker().