Visual Servoing Platform
version 3.0.1
|
#include <visp3/mbt/vpMbtDistanceLine.h>
Public Member Functions | |
vpMbtDistanceLine () | |
~vpMbtDistanceLine () | |
void | addPolygon (const int &index) |
void | buildFrom (vpPoint &_p1, vpPoint &_p2) |
bool | closeToImageBorder (const vpImage< unsigned char > &I, const unsigned int threshold) |
void | computeInteractionMatrixError (const vpHomogeneousMatrix &cMo) |
void | display (const vpImage< unsigned char > &I, const vpHomogeneousMatrix &cMo, const vpCameraParameters &cam, const vpColor col, const unsigned int thickness=1, const bool displayFullModel=false) |
void | display (const vpImage< vpRGBa > &I, const vpHomogeneousMatrix &cMo, const vpCameraParameters &cam, const vpColor col, const unsigned int thickness=1, const bool displayFullModel=false) |
void | displayMovingEdges (const vpImage< unsigned char > &I) |
void | getCameraParameters (vpCameraParameters &camera) const |
unsigned int | getIndex () const |
double | getMeanWeight () const |
std::string | getName () const |
vpMbtPolygon & | getPolygon () |
void | initInteractionMatrixError () |
bool | initMovingEdge (const vpImage< unsigned char > &I, const vpHomogeneousMatrix &cMo) |
bool | isTracked () const |
bool | isVisible () const |
void | reinitMovingEdge (const vpImage< unsigned char > &I, const vpHomogeneousMatrix &cMo) |
void | setCameraParameters (const vpCameraParameters &camera) |
void | setIndex (const unsigned int i) |
void | setMeanWeight (const double w_mean) |
void | setMovingEdge (vpMe *Me) |
void | setName (const std::string line_name) |
void | setName (const char *line_name) |
void | setTracked (const std::string &name, const bool &track) |
void | setVisible (bool _isvisible) |
void | trackMovingEdge (const vpImage< unsigned char > &I, const vpHomogeneousMatrix &cMo) |
void | updateMovingEdge (const vpImage< unsigned char > &I, const vpHomogeneousMatrix &cMo) |
void | updateTracked () |
Public Attributes | |
bool | useScanLine |
std::vector< vpMbtMeLine * > | meline |
vpLine * | line |
vpPoint * | p1 |
vpPoint * | p2 |
vpMatrix | L |
vpColVector | error |
std::vector< unsigned int > | nbFeature |
unsigned int | nbFeatureTotal |
bool | Reinit |
vpMbHiddenFaces< vpMbtPolygon > * | hiddenface |
std::list< int > | Lindex_polygon |
std::vector< bool > | Lindex_polygon_tracked |
bool | isvisible |
Manage the line of a polygon used in the model-based tracker.
Definition at line 65 of file vpMbtDistanceLine.h.
vpMbtDistanceLine::vpMbtDistanceLine | ( | ) |
Basic constructor
Definition at line 58 of file vpMbtDistanceLine.cpp.
vpMbtDistanceLine::~vpMbtDistanceLine | ( | ) |
Basic destructor useful to deallocate the memory.
Definition at line 69 of file vpMbtDistanceLine.cpp.
void vpMbtDistanceLine::addPolygon | ( | const int & | idx | ) |
Add a polygon to the list of polygons the line belongs to.
idx | : Index of the polygon |
Definition at line 223 of file vpMbtDistanceLine.cpp.
References Lindex_polygon, and Lindex_polygon_tracked.
Referenced by vpMbEdgeTracker::addLine().
Build a vpMbtDistanceLine thanks to two points corresponding to the extremities.
_p1 | : The first extremity. |
_p2 | : The second extremity. |
Definition at line 165 of file vpMbtDistanceLine.cpp.
References vpPolygon3D::addPoint(), vpColVector::cross(), vpPoint::get_oX(), vpPoint::get_oY(), vpPoint::get_oZ(), line, vpPolygon3D::p, p1, p2, and vpPolygon3D::setNbPoint().
Referenced by vpMbEdgeTracker::addLine().
bool vpMbtDistanceLine::closeToImageBorder | ( | const vpImage< unsigned char > & | I, |
const unsigned int | threshold | ||
) |
Test wether the line is close to the border of the image (at a given threshold)
I | : the input image (to know its size) |
threshold | : the threshold in pixel |
Definition at line 827 of file vpMbtDistanceLine.cpp.
References vpImage< Type >::getHeight(), vpImage< Type >::getWidth(), isvisible, and meline.
Referenced by vpMbEdgeTracker::computeVVSFirstPhase(), vpMbEdgeTracker::computeVVSFirstPhaseFactor(), and vpMbEdgeKltTracker::trackFirstLoop().
void vpMbtDistanceLine::computeInteractionMatrixError | ( | const vpHomogeneousMatrix & | cMo | ) |
Compute the interaction matrix and the error vector corresponding to the line.
Definition at line 766 of file vpMbtDistanceLine.cpp.
References vpLine::changeFrame(), vpFeatureBuilder::create(), error, vpCameraParameters::get_px(), vpCameraParameters::get_py(), vpCameraParameters::get_u0(), vpCameraParameters::get_v0(), vpFeatureLine::getRho(), vpFeatureLine::getTheta(), vpFeatureLine::interaction(), isvisible, vpMeSite::j, line, meline, and vpLine::projection().
Referenced by vpMbEdgeTracker::computeVVSFirstPhase(), vpMbEdgeTracker::computeVVSFirstPhaseFactor(), vpMbEdgeTracker::computeVVSSecondPhase(), vpMbEdgeKltTracker::trackFirstLoop(), and vpMbEdgeKltTracker::trackSecondLoop().
void vpMbtDistanceLine::display | ( | const vpImage< unsigned char > & | I, |
const vpHomogeneousMatrix & | cMo, | ||
const vpCameraParameters & | camera, | ||
const vpColor | col, | ||
const unsigned int | thickness = 1 , |
||
const bool | displayFullModel = false |
||
) |
Display the line. The 3D line is projected into the image.
I | : The image. |
cMo | : Pose used to project the 3D model into the image. |
camera | : The camera parameters. |
col | : The desired color. |
thickness | : The thickness of the line. |
displayFullModel | : If true, the line is displayed even if it is not visible. |
Definition at line 624 of file vpMbtDistanceLine.cpp.
References vpPoint::changeFrame(), vpCameraParameters::computeFov(), vpPolygon3D::computePolygonClipped(), vpMbHiddenFaces< PolygonType >::computeScanLineQuery(), vpMeterPixelConversion::convertPoint(), vpDisplay::displayLine(), vpPolygon3D::DOWN_CLIPPING, vpPolygon3D::FAR_CLIPPING, vpPolygon3D::getClipping(), vpImage< Type >::getHeight(), vpImage< Type >::getWidth(), hiddenface, isvisible, vpPolygon3D::LEFT_CLIPPING, vpPolygon3D::NEAR_CLIPPING, p1, p2, vpPolygon3D::polyClipped, vpPolygon3D::RIGHT_CLIPPING, vpPolygon3D::UP_CLIPPING, and useScanLine.
void vpMbtDistanceLine::display | ( | const vpImage< vpRGBa > & | I, |
const vpHomogeneousMatrix & | cMo, | ||
const vpCameraParameters & | camera, | ||
const vpColor | col, | ||
const unsigned int | thickness = 1 , |
||
const bool | displayFullModel = false |
||
) |
Display the line. The 3D line is projected into the image.
I | : The image. |
cMo | : Pose used to project the 3D model into the image. |
camera | : The camera parameters. |
col | : The desired color. |
thickness | : The thickness of the line. |
displayFullModel | : If true, the line is displayed even if it is not visible. |
Definition at line 679 of file vpMbtDistanceLine.cpp.
References vpPoint::changeFrame(), vpCameraParameters::computeFov(), vpPolygon3D::computePolygonClipped(), vpMbHiddenFaces< PolygonType >::computeScanLineQuery(), vpMeterPixelConversion::convertPoint(), vpDisplay::displayLine(), vpPolygon3D::DOWN_CLIPPING, vpPolygon3D::FAR_CLIPPING, vpPolygon3D::getClipping(), vpImage< Type >::getHeight(), vpImage< Type >::getWidth(), hiddenface, isvisible, vpPolygon3D::LEFT_CLIPPING, vpPolygon3D::NEAR_CLIPPING, p1, p2, vpPolygon3D::polyClipped, vpPolygon3D::RIGHT_CLIPPING, vpPolygon3D::UP_CLIPPING, and useScanLine.
void vpMbtDistanceLine::displayMovingEdges | ( | const vpImage< unsigned char > & | I | ) |
Enable to display the points along the line with a color corresponding to their state.
I | : The image. |
Definition at line 735 of file vpMbtDistanceLine.cpp.
References meline.
Referenced by vpMbEdgeTracker::displayFeaturesOnImage(), and vpMbEdgeKltTracker::postTracking().
|
inline |
Get the camera paramters.
camera | : The vpCameraParameters used to store the camera parameters. |
Definition at line 147 of file vpMbtDistanceLine.h.
|
inline |
Get the index of the line.
Definition at line 154 of file vpMbtDistanceLine.h.
|
inline |
Get the mean weight of the line. The mean weight is computed thanks to the weight of each moving edge. Those weights are computed by the robust estimation method used during the virtual visual servoing.
Definition at line 162 of file vpMbtDistanceLine.h.
|
inline |
Get the name of the line.
Definition at line 169 of file vpMbtDistanceLine.h.
Referenced by vpMbEdgeTracker::removeLine().
|
inline |
Get the polygon associated to the line.
Definition at line 176 of file vpMbtDistanceLine.h.
Referenced by vpMbEdgeTracker::addLine(), vpMbEdgeTracker::setClipping(), vpMbEdgeTracker::setFarClippingDistance(), and vpMbEdgeTracker::setNearClippingDistance().
void vpMbtDistanceLine::initInteractionMatrixError | ( | ) |
Initialize the size of the interaction matrix and the error vector.
Definition at line 748 of file vpMbtDistanceLine.cpp.
References error, isvisible, meline, nbFeature, nbFeatureTotal, and vpColVector::resize().
Referenced by vpMbEdgeKltTracker::initMbtTracking(), and vpMbEdgeTracker::initMbtTracking().
bool vpMbtDistanceLine::initMovingEdge | ( | const vpImage< unsigned char > & | I, |
const vpHomogeneousMatrix & | cMo | ||
) |
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 line.
I | : The image. |
cMo | : The pose of the camera used to initialize the moving edges. |
Definition at line 317 of file vpMbtDistanceLine.cpp.
References vpPoint::changeFrame(), vpLine::changeFrame(), vpCameraParameters::computeFov(), vpPolygon3D::computePolygonClipped(), vpMbHiddenFaces< PolygonType >::computeScanLineQuery(), vpMeterPixelConversion::convertLine(), vpMeterPixelConversion::convertPoint(), vpImagePoint::get_i(), vpImagePoint::get_j(), vpPolygon3D::getClipping(), vpImage< Type >::getHeight(), vpLine::getRho(), vpLine::getTheta(), vpImage< Type >::getWidth(), hiddenface, isvisible, line, meline, nbFeature, nbFeatureTotal, p1, p2, vpPolygon3D::polyClipped, vpLine::projection(), and useScanLine.
Referenced by vpMbEdgeTracker::initMovingEdge(), reinitMovingEdge(), and vpMbEdgeTracker::trackMovingEdge().
|
inline |
Return if the line is used for tracking.
Definition at line 187 of file vpMbtDistanceLine.h.
Referenced by vpMbEdgeTracker::computeProjectionError(), vpMbEdgeTracker::displayFeaturesOnImage(), vpMbEdgeTracker::getNbPoints(), vpMbEdgeKltTracker::initMbtTracking(), vpMbEdgeTracker::initMbtTracking(), vpMbEdgeTracker::initMovingEdge(), vpMbEdgeKltTracker::postTracking(), vpMbEdgeTracker::testTracking(), and vpMbEdgeTracker::trackMovingEdge().
|
inline |
Check if the line is visible in the image or not.
Definition at line 194 of file vpMbtDistanceLine.h.
Referenced by vpMbEdgeTracker::computeProjectionError(), vpMbEdgeTracker::displayFeaturesOnImage(), vpMbEdgeTracker::getNbPoints(), vpMbEdgeKltTracker::initMbtTracking(), vpMbEdgeTracker::initMbtTracking(), vpMbEdgeKltTracker::postTracking(), vpMbEdgeTracker::reinitMovingEdge(), vpMbEdgeTracker::testTracking(), vpMbEdgeTracker::trackMovingEdge(), and vpMbEdgeTracker::updateMovingEdge().
void vpMbtDistanceLine::reinitMovingEdge | ( | const vpImage< unsigned char > & | I, |
const vpHomogeneousMatrix & | cMo | ||
) |
Reinitialize the line 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 camera. |
Definition at line 596 of file vpMbtDistanceLine.cpp.
References initMovingEdge(), meline, nbFeature, nbFeatureTotal, and Reinit.
Referenced by vpMbEdgeTracker::reInitLevel(), and vpMbEdgeTracker::reinitMovingEdge().
|
inline |
Set the camera paramters.
camera | : The camera parameters. |
Definition at line 202 of file vpMbtDistanceLine.h.
Referenced by vpMbEdgeTracker::addLine().
|
inline |
Set the index of the line.
i | : The index number |
Definition at line 209 of file vpMbtDistanceLine.h.
Referenced by vpMbEdgeTracker::addLine().
|
inline |
Set the mean weight of the line.
w_mean | : The mean weight of the line. |
Definition at line 216 of file vpMbtDistanceLine.h.
Referenced by vpMbEdgeKltTracker::postTrackingMbt(), and vpMbEdgeTracker::updateMovingEdgeWeights().
void vpMbtDistanceLine::setMovingEdge | ( | vpMe * | _me | ) |
Set the moving edge parameters.
_me | : an instance of vpMe containing all the desired parameters |
Definition at line 292 of file vpMbtDistanceLine.cpp.
References meline.
Referenced by vpMbEdgeTracker::addLine(), and vpMbEdgeTracker::setMovingEdge().
|
inline |
Set the name of the line.
line_name | : The name of the line. |
Definition at line 225 of file vpMbtDistanceLine.h.
Referenced by vpMbEdgeTracker::addLine().
|
inline |
Set the name of the line.
line_name | : The name of the line. |
Definition at line 232 of file vpMbtDistanceLine.h.
void vpMbtDistanceLine::setTracked | ( | const std::string & | polyname, |
const bool & | track | ||
) |
Set if the line has to considered during tracking phase. Line won't be considered if all of its polygons are desactivated.
polyname | : name of the polygons that have to be modified. |
track | : True if the polygon has to be tracked, False otherwise. |
Definition at line 237 of file vpMbtDistanceLine.cpp.
References hiddenface, Lindex_polygon, Lindex_polygon_tracked, and updateTracked().
|
inline |
Set a boolean parameter to indicates if the line is visible in the image or not.
_isvisible | : Set to true if the line is visible |
Definition at line 241 of file vpMbtDistanceLine.h.
Referenced by vpMbEdgeTracker::initMovingEdge().
void vpMbtDistanceLine::trackMovingEdge | ( | const vpImage< unsigned char > & | I, |
const vpHomogeneousMatrix & | cMo | ||
) |
Track the moving edges in the image.
I | : the image. |
cMo | : The pose of the camera. |
Definition at line 429 of file vpMbtDistanceLine.cpp.
References isvisible, meline, nbFeature, nbFeatureTotal, and Reinit.
Referenced by vpMbEdgeTracker::trackMovingEdge().
void vpMbtDistanceLine::updateMovingEdge | ( | const vpImage< unsigned char > & | I, |
const vpHomogeneousMatrix & | cMo | ||
) |
Update the moving edges internal parameters.
I | : the image. |
cMo | : The pose of the camera. |
Definition at line 483 of file vpMbtDistanceLine.cpp.
References vpPoint::changeFrame(), vpLine::changeFrame(), vpCameraParameters::computeFov(), vpPolygon3D::computePolygonClipped(), vpMbHiddenFaces< PolygonType >::computeScanLineQuery(), vpMeterPixelConversion::convertLine(), vpMeterPixelConversion::convertPoint(), vpImagePoint::get_i(), vpImagePoint::get_j(), vpPolygon3D::getClipping(), vpImage< Type >::getHeight(), vpLine::getRho(), vpLine::getTheta(), vpImage< Type >::getWidth(), hiddenface, isvisible, line, meline, nbFeature, nbFeatureTotal, p1, p2, vpPolygon3D::polyClipped, vpLine::projection(), Reinit, and useScanLine.
Referenced by vpMbEdgeTracker::updateMovingEdge().
void vpMbtDistanceLine::updateTracked | ( | ) |
Update the boolean specifying if the line has to be tracked. It takes into account the desactivated polygons and the visibility of the others.
Definition at line 268 of file vpMbtDistanceLine.cpp.
References hiddenface, Lindex_polygon, and Lindex_polygon_tracked.
Referenced by vpMbEdgeTracker::initMovingEdge(), and setTracked().
vpColVector vpMbtDistanceLine::error |
The error vector.
Definition at line 94 of file vpMbtDistanceLine.h.
Referenced by computeInteractionMatrixError(), vpMbEdgeTracker::computeVVSFirstPhase(), vpMbEdgeTracker::computeVVSSecondPhase(), initInteractionMatrixError(), and vpMbEdgeKltTracker::trackSecondLoop().
vpMbHiddenFaces<vpMbtPolygon>* vpMbtDistanceLine::hiddenface |
Pointer to the list of faces.
Definition at line 103 of file vpMbtDistanceLine.h.
Referenced by vpMbEdgeTracker::addLine(), vpMbEdgeTracker::computeVVSFirstPhase(), vpMbEdgeTracker::computeVVSFirstPhaseFactor(), display(), initMovingEdge(), vpMbEdgeTracker::initMovingEdge(), setTracked(), vpMbEdgeKltTracker::trackFirstLoop(), updateMovingEdge(), and updateTracked().
bool vpMbtDistanceLine::isvisible |
Indicates if the line is visible or not.
Definition at line 109 of file vpMbtDistanceLine.h.
Referenced by closeToImageBorder(), computeInteractionMatrixError(), display(), initInteractionMatrixError(), initMovingEdge(), trackMovingEdge(), and updateMovingEdge().
vpMatrix vpMbtDistanceLine::L |
The interaction matrix.
Definition at line 92 of file vpMbtDistanceLine.h.
Referenced by vpMbEdgeTracker::computeVVSFirstPhase(), vpMbEdgeTracker::computeVVSSecondPhase(), and vpMbEdgeKltTracker::trackSecondLoop().
std::list<int> vpMbtDistanceLine::Lindex_polygon |
Index of the faces which contain the line.
Definition at line 105 of file vpMbtDistanceLine.h.
Referenced by addPolygon(), vpMbEdgeTracker::computeVVSFirstPhase(), vpMbEdgeTracker::computeVVSFirstPhaseFactor(), vpMbEdgeTracker::initMovingEdge(), setTracked(), vpMbEdgeKltTracker::trackFirstLoop(), and updateTracked().
std::vector<bool> vpMbtDistanceLine::Lindex_polygon_tracked |
Vector of bool associated with Lindex_polygon to know if Lindex_polygon[i] is tracked.
Definition at line 107 of file vpMbtDistanceLine.h.
Referenced by addPolygon(), setTracked(), and updateTracked().
vpLine* vpMbtDistanceLine::line |
The 3D line.
Definition at line 86 of file vpMbtDistanceLine.h.
Referenced by buildFrom(), computeInteractionMatrixError(), initMovingEdge(), updateMovingEdge(), and ~vpMbtDistanceLine().
std::vector<vpMbtMeLine*> vpMbtDistanceLine::meline |
The moving edge container.
Definition at line 84 of file vpMbtDistanceLine.h.
Referenced by closeToImageBorder(), computeInteractionMatrixError(), vpMbEdgeTracker::computeProjectionError(), vpMbEdgeTracker::computeVVSFirstPhase(), vpMbEdgeTracker::computeVVSFirstPhaseFactor(), displayMovingEdges(), vpMbEdgeTracker::getNbPoints(), initInteractionMatrixError(), initMovingEdge(), vpMbEdgeTracker::initMovingEdge(), vpMbEdgeKltTracker::postTrackingMbt(), reinitMovingEdge(), setMovingEdge(), vpMbEdgeTracker::testTracking(), vpMbEdgeKltTracker::trackFirstLoop(), trackMovingEdge(), vpMbEdgeTracker::trackMovingEdge(), updateMovingEdge(), vpMbEdgeTracker::updateMovingEdgeWeights(), and ~vpMbtDistanceLine().
std::vector<unsigned int> vpMbtDistanceLine::nbFeature |
The number of moving edges.
Definition at line 97 of file vpMbtDistanceLine.h.
Referenced by vpMbEdgeTracker::computeVVSFirstPhase(), vpMbEdgeTracker::computeVVSFirstPhaseFactor(), vpMbEdgeTracker::getNbPoints(), initInteractionMatrixError(), initMovingEdge(), vpMbEdgeTracker::initMovingEdge(), vpMbEdgeKltTracker::postTrackingMbt(), reinitMovingEdge(), vpMbEdgeKltTracker::trackFirstLoop(), trackMovingEdge(), updateMovingEdge(), and vpMbEdgeTracker::updateMovingEdgeWeights().
unsigned int vpMbtDistanceLine::nbFeatureTotal |
The number of moving edges.
Definition at line 99 of file vpMbtDistanceLine.h.
Referenced by vpMbEdgeTracker::computeVVSFirstPhase(), vpMbEdgeTracker::computeVVSSecondPhase(), initInteractionMatrixError(), vpMbEdgeKltTracker::initMbtTracking(), vpMbEdgeTracker::initMbtTracking(), initMovingEdge(), vpMbEdgeTracker::initMovingEdge(), vpMbEdgeKltTracker::postTrackingMbt(), reinitMovingEdge(), trackMovingEdge(), vpMbEdgeKltTracker::trackSecondLoop(), updateMovingEdge(), vpMbEdgeTracker::updateMovingEdge(), and vpMbEdgeTracker::updateMovingEdgeWeights().
vpPoint* vpMbtDistanceLine::p1 |
The first extremity.
Definition at line 88 of file vpMbtDistanceLine.h.
Referenced by vpMbEdgeTracker::addLine(), buildFrom(), display(), initMovingEdge(), and updateMovingEdge().
vpPoint* vpMbtDistanceLine::p2 |
The second extremity.
Definition at line 90 of file vpMbtDistanceLine.h.
Referenced by vpMbEdgeTracker::addLine(), buildFrom(), display(), initMovingEdge(), and updateMovingEdge().
bool vpMbtDistanceLine::Reinit |
Indicates if the line has to be reinitialized.
Definition at line 101 of file vpMbtDistanceLine.h.
Referenced by vpMbEdgeKltTracker::postTrackingMbt(), reinitMovingEdge(), vpMbEdgeTracker::reinitMovingEdge(), trackMovingEdge(), updateMovingEdge(), vpMbEdgeTracker::updateMovingEdge(), and vpMbEdgeTracker::updateMovingEdgeWeights().
bool vpMbtDistanceLine::useScanLine |
Use scanline rendering.
Definition at line 81 of file vpMbtDistanceLine.h.
Referenced by vpMbEdgeTracker::addLine(), display(), initMovingEdge(), and updateMovingEdge().