41 #ifndef PCL_SURFACE_ORGANIZED_FAST_MESH_H_ 42 #define PCL_SURFACE_ORGANIZED_FAST_MESH_H_ 45 #include <pcl/surface/reconstruction.h> 64 template <
typename Po
intInT>
68 typedef boost::shared_ptr<OrganizedFastMesh<PointInT> >
Ptr;
69 typedef boost::shared_ptr<const OrganizedFastMesh<PointInT> >
ConstPtr;
206 if (angle_tolerance > 0)
303 addTriangle (
int a,
int b,
int c,
int idx, std::vector<pcl::Vertices>& polygons)
305 assert (idx < static_cast<int> (polygons.size ()));
306 polygons[idx].vertices.resize (3);
307 polygons[idx].vertices[0] = a;
308 polygons[idx].vertices[1] = b;
309 polygons[idx].vertices[2] = c;
321 addQuad (
int a,
int b,
int c,
int d,
int idx, std::vector<pcl::Vertices>& polygons)
323 assert (idx < static_cast<int> (polygons.size ()));
324 polygons[idx].vertices.resize (4);
325 polygons[idx].vertices[0] = a;
326 polygons[idx].vertices[1] = b;
327 polygons[idx].vertices[2] = c;
328 polygons[idx].vertices[3] = d;
341 int field_x_idx = 0,
int field_y_idx = 1,
int field_z_idx = 2)
343 float new_value = value;
354 isShadowed (
const PointInT& point_a,
const PointInT& point_b)
358 Eigen::Vector3f dir_a =
viewpoint_ - point_a.getVector3fMap ();
359 Eigen::Vector3f dir_b = point_b.getVector3fMap () - point_a.getVector3fMap ();
360 float distance_to_points = dir_a.norm ();
361 float distance_between_points = dir_b.norm ();
365 float cos_angle = dir_a.dot (dir_b) / (distance_to_points*distance_between_points);
366 if (cos_angle != cos_angle)
370 bool check_distance =
true;
376 float d = distance_to_points;
378 d = std::max(point_a.z, point_b.z);
380 dist_thresh *= dist_thresh;
382 check_distance = (distance_between_points > dist_thresh);
384 valid = !(check_angle && check_distance);
396 valid = (distance_between_points <= dist_thresh);
437 isValidQuad (
const int& a,
const int& b,
const int& c,
const int& d)
488 #ifdef PCL_NO_PRECOMPILE 489 #include <pcl/surface/impl/organized_fast_mesh.hpp> 492 #endif // PCL_SURFACE_ORGANIZED_FAST_MESH_H_ boost::shared_ptr< OrganizedFastMesh< PointInT > > Ptr
const Eigen::Vector3f & getViewpoint() const
Get the viewpoint from where the input point cloud has been acquired.
void setTriangulationType(TriangulationType type)
Set the triangulation type (see TriangulationType)
void makeQuadMesh(std::vector< pcl::Vertices > &polygons)
Create a quad mesh.
void setDistanceTolerance(float distance_tolerance, bool depth_dependent=false)
boost::shared_ptr< const OrganizedFastMesh< PointInT > > ConstPtr
bool isFinite(const PointT &pt)
Tests if the 3D components of a point are all finite param[in] pt point to be tested return true if f...
float deg2rad(float alpha)
Convert an angle from degrees to radians.
bool check_tree_
A flag specifying whether or not the derived reconstruction algorithm needs the search object tree.
void resetPointData(const int &point_index, pcl::PolygonMesh &mesh, const float &value=0.0f, int field_x_idx=0, int field_y_idx=1, int field_z_idx=2)
Set (all) coordinates of a particular point to the specified value.
void makeAdaptiveCutMesh(std::vector< pcl::Vertices > &polygons)
Create an adaptive cut mesh.
Eigen::Vector3f viewpoint_
Viewpoint from which the point cloud has been acquired (in the same coordinate frame as the data).
Simple triangulation/surface reconstruction for organized point clouds.
bool distance_dependent_
flag whether or not distance_tolerance_ is distance dependent (multiplied by the squared distance to ...
void setTrianglePixelSizeRows(int triangle_size)
Set the edge length (in pixels) used for iterating over rows when constructing the fixed mesh.
void setTrianglePixelSize(int triangle_size)
Set the edge length (in pixels) used for constructing the fixed mesh.
virtual ~OrganizedFastMesh()
Destructor.
void makeLeftCutMesh(std::vector< pcl::Vertices > &polygons)
Create a left cut mesh.
void reconstructPolygons(std::vector< pcl::Vertices > &polygons)
Perform the actual polygonal reconstruction.
TriangulationType triangulation_type_
Type of meshing scheme (quads vs.
int triangle_pixel_size_rows_
size of triangle edges (in pixels) for iterating over rows.
void makeRightCutMesh(std::vector< pcl::Vertices > &polygons)
Create a right cut mesh.
float max_edge_length_a_
max length of edge, scalar component
void setAngleTolerance(float angle_tolerance)
Set the angle tolerance used for checking whether or not an edge is occluded.
float max_edge_length_b_
max length of edge, scalar component
int triangle_pixel_size_columns_
size of triangle edges (in pixels) for iterating over columns
boost::shared_ptr< PointCloud< PointT > > Ptr
bool isValidTriangle(const int &a, const int &b, const int &c)
Check if a triangle is valid.
void setTrianglePixelSizeColumns(int triangle_size)
Set the edge length (in pixels) used for iterating over columns when constructing the fixed mesh.
virtual void performReconstruction(std::vector< pcl::Vertices > &polygons)
Create the surface.
bool isShadowedQuad(const int &a, const int &b, const int &c, const int &d)
Check if a triangle is shadowed.
bool isValidQuad(const int &a, const int &b, const int &c, const int &d)
Check if a quad is valid.
void setMaxEdgeLength(float a, float b=0.0f, float c=0.0f)
Set a maximum edge length.
void setViewpoint(const Eigen::Vector3f &viewpoint)
Set the viewpoint from where the input point cloud has been acquired.
float max_edge_length_c_
max length of edge, scalar component
float cos_angle_tolerance_
(Cosine of the) angle tolerance used when checking whether or not an edge between two points is shado...
MeshConstruction represents a base surface reconstruction class.
std::vector< ::pcl::PCLPointField > fields
void unsetMaxEdgeLength()
void addQuad(int a, int b, int c, int d, int idx, std::vector< pcl::Vertices > &polygons)
Add a new quad to the current polygon mesh.
void useDepthAsDistance(bool enable)
Use the points' depths (z-coordinates) instead of measured distances (points' distances to the viewpo...
::pcl::PCLPointCloud2 cloud
void addTriangle(int a, int b, int c, int idx, std::vector< pcl::Vertices > &polygons)
Add a new triangle to the current polygon mesh.
std::vector< pcl::Vertices > Polygons
float distance_tolerance_
distance tolerance for filtering out shadowed/occluded edges
PointCloudConstPtr input_
The input point cloud dataset.
bool isShadowedTriangle(const int &a, const int &b, const int &c)
Check if a triangle is shadowed.
Define standard C methods to do angle calculations.
void storeShadowedFaces(bool enable)
Store shadowed faces or not.
bool max_edge_length_set_
flag whether or not edges are limited in length
bool use_depth_as_distance_
flag whether or not the points' depths are used instead of measured distances (points' distances to t...
bool isShadowed(const PointInT &point_a, const PointInT &point_b)
Check if a point is shadowed by another point.
bool store_shadowed_faces_
Whether or not shadowed faces are stored, e.g., for exploration.
std::vector< pcl::uint8_t > data
bool max_edge_length_dist_dependent_
flag whether or not max edge length is distance dependent.
pcl::PointCloud< PointInT >::Ptr PointCloudPtr
OrganizedFastMesh()
Constructor.