34 #ifndef _vpMbDepthDenseTracker_h_
35 #define _vpMbDepthDenseTracker_h_
37 #include <visp3/core/vpPlane.h>
38 #include <visp3/mbt/vpMbTracker.h>
39 #include <visp3/mbt/vpMbtFaceDepthDense.h>
40 #include <visp3/mbt/vpMbtTukeyEstimator.h>
42 #if DEBUG_DISPLAY_DEPTH_DENSE
43 #include <visp3/core/vpDisplay.h>
53 const vpColor &col,
unsigned int thickness = 1,
bool displayFullModel =
false)
override;
56 const vpColor &col,
unsigned int thickness = 1,
bool displayFullModel =
false)
override;
60 virtual std::vector<std::vector<double> >
getModelForDisplay(
unsigned int width,
unsigned int height,
63 bool displayFullModel =
false)
override;
69 virtual void loadConfigFile(
const std::string &configFile,
bool verbose =
true)
override;
72 bool verbose =
false);
73 #if defined(VISP_HAVE_PCL)
74 void reInitModel(
const pcl::PointCloud<pcl::PointXYZ>::ConstPtr &point_cloud,
const std::string &cad_name,
82 virtual void setDepthDenseFilteringMaxDistance(
double maxDistance);
83 virtual void setDepthDenseFilteringMethod(
int method);
84 virtual void setDepthDenseFilteringMinDistance(
double minDistance);
85 virtual void setDepthDenseFilteringOccupancyRatio(
double occupancyRatio);
89 if (stepX == 0 || stepY == 0) {
90 std::cerr <<
"stepX and stepY must be greater than zero!" << std::endl;
94 m_depthDenseSamplingStepX = stepX;
95 m_depthDenseSamplingStepY = stepY;
108 void setUseDepthDenseTracking(
const std::string &name,
const bool &useDepthDenseTracking);
115 virtual void track(
const pcl::PointCloud<pcl::PointXYZ>::ConstPtr &point_cloud);
117 virtual void track(
const std::vector<vpColVector> &point_cloud,
unsigned int width,
unsigned int height);
142 #if DEBUG_DISPLAY_DEPTH_DENSE
149 void computeVisibility(
unsigned int width,
unsigned int height);
158 const std::string &name =
"")
override;
161 const std::string &name =
"")
override;
168 void segmentPointCloud(
const pcl::PointCloud<pcl::PointXYZ>::ConstPtr &point_cloud);
170 void segmentPointCloud(
const std::vector<vpColVector> &point_cloud,
unsigned int width,
unsigned int height);
Generic class defining intrinsic camera parameters.
Implementation of column vector and the associated operations.
Class to define RGB colors available for display functionalities.
Class that defines generic functionalities for display.
Implementation of an homogeneous matrix and operations on such kind of matrices.
Implementation of a matrix and operations on matrices.
virtual vpColVector getRobustWeights() const override
vpMbtTukeyEstimator< double > m_robust_depthDense
Tukey M-Estimator.
virtual vpColVector getError() const override
vpColVector m_weightedError_depthDense
Weighted error.
unsigned int m_depthDenseSamplingStepY
Sampling step in y-direction.
vpMbHiddenFaces< vpMbtPolygon > m_depthDenseHiddenFacesDisplay
Set of faces describing the object used only for display with scan line.
unsigned int m_depthDenseSamplingStepX
Sampling step in x-direction.
vpColVector m_error_depthDense
(s - s*)
vpMatrix m_L_depthDense
Interaction matrix.
std::vector< vpMbtFaceDepthDense * > m_depthDenseListOfActiveFaces
List of current active (visible and features extracted) faces.
void setDepthDenseSamplingStep(unsigned int stepX, unsigned int stepY)
unsigned int m_denseDepthNbFeatures
Nb features.
vpColVector m_w_depthDense
Robust weights.
std::vector< vpMbtFaceDepthDense * > m_depthDenseFaces
List of faces.
Main methods for a model-based tracker.
virtual void track(const vpImage< unsigned char > &I)=0
virtual void resetTracker()=0
virtual void init(const vpImage< unsigned char > &I)=0
virtual std::vector< std::vector< double > > getModelForDisplay(unsigned int width, unsigned int height, const vpHomogeneousMatrix &cMo, const vpCameraParameters &cam, bool displayFullModel=false)=0
virtual void initFaceFromLines(vpMbtPolygon &polygon)=0
virtual void initCircle(const vpPoint &p1, const vpPoint &p2, const vpPoint &p3, double radius, int idFace=0, const std::string &name="")=0
virtual void initCylinder(const vpPoint &p1, const vpPoint &p2, double radius, int idFace=0, const std::string &name="")=0
virtual void computeVVSWeights(vpRobust &robust, const vpColVector &error, vpColVector &w)
virtual void setCameraParameters(const vpCameraParameters &cam)
virtual void setScanLineVisibilityTest(const bool &v)
virtual void setOgreVisibilityTest(const bool &v)
virtual void setPose(const vpImage< unsigned char > &I, const vpHomogeneousMatrix &cdMo)=0
virtual void computeVVSInteractionMatrixAndResidu()=0
virtual void display(const vpImage< unsigned char > &I, const vpHomogeneousMatrix &cMo, const vpCameraParameters &cam, const vpColor &col, unsigned int thickness=1, bool displayFullModel=false)=0
virtual void computeVVSInit()=0
virtual void testTracking()=0
virtual void initFaceFromCorners(vpMbtPolygon &polygon)=0
virtual void loadConfigFile(const std::string &configFile, bool verbose=true)
Implementation of a polygon of the model used by the model-based tracker.
Class that defines a 3D point in the object frame and allows forward projection of a 3D point in the ...