Commit 8259ea87 by Pierre Kraemer

### update several Algo/Geometry functions

parent f0e1b718
 ... @@ -25,7 +25,6 @@ ... @@ -25,7 +25,6 @@ #ifndef __ALGO_GEOMETRY_BOUNDINGBOX_H__ #ifndef __ALGO_GEOMETRY_BOUNDINGBOX_H__ #define __ALGO_GEOMETRY_BOUNDINGBOX_H__ #define __ALGO_GEOMETRY_BOUNDINGBOX_H__ #include "Geometry/basic.h" #include "Geometry/bounding_box.h" #include "Geometry/bounding_box.h" #include "Topology/generic/attributeHandler.h" #include "Topology/generic/attributeHandler.h" #include "Topology/generic/traversor/traversorCell.h" #include "Topology/generic/traversor/traversorCell.h" ... @@ -43,9 +42,7 @@ template ... @@ -43,9 +42,7 @@ template Geom::BoundingBox computeBoundingBox(typename PFP::MAP& map, const VertexAttribute& position) Geom::BoundingBox computeBoundingBox(typename PFP::MAP& map, const VertexAttribute& position) { { Geom::BoundingBox bb ; Geom::BoundingBox bb ; TraversorV t(map) ; foreach_cell(map, [&] (Vertex v) { bb.addPoint(position[v]) ; }); for(Dart d = t.begin(); d != t.end(); d = t.next()) bb.addPoint(position[d]) ; return bb ; return bb ; } } ... ...
 ... @@ -41,7 +41,7 @@ namespace Geometry ... @@ -41,7 +41,7 @@ namespace Geometry * Test if an edge bounded by 2 faces is convex or concave * Test if an edge bounded by 2 faces is convex or concave */ */ template template bool isEdgeConvexe(typename PFP::MAP& map, Dart d, const VertexAttribute& position) ; bool isEdgeConvex(typename PFP::MAP& map, Edge e, const VertexAttribute& position) ; } // namespace Geometry } // namespace Geometry ... ...
 ... @@ -40,14 +40,14 @@ namespace Geometry ... @@ -40,14 +40,14 @@ namespace Geometry { { template template bool isEdgeConvexe(typename PFP::MAP& map, Dart d, const VertexAttribute& position) bool isEdgeConvex(typename PFP::MAP& map, Edge e, const VertexAttribute& position) { { typedef typename PFP::VEC3 VEC3 ; typedef typename PFP::VEC3 VEC3 ; const VEC3 n = faceNormal(map, d, position); const VEC3 n = faceNormal(map, e.dart, position); const VEC3 e = vectorOutOfDart(map, map.phi1(map.phi2(d)), position) ; const VEC3 ee = vectorOutOfDart(map, map.phi1(map.phi2(e.dart)), position) ; if((e * n) > 0) if((ee * n) < 0) return true; return true; else else return false; return false; ... ...
 ... @@ -37,38 +37,36 @@ namespace Geometry ... @@ -37,38 +37,36 @@ namespace Geometry /** /** * compute squared distance from point to the plane of a planar face * compute squared distance from point to the plane of a planar face * @param map the map * @param map the map * @param d a dart of the face * @param f a face * @param position the vertex attribute storing positions * @param P the point * @param P the point * @return the squared distance to tha plane * @return the squared distance to the plane */ */ template template typename PFP::REAL squaredDistancePoint2FacePlane(typename PFP::MAP& map, Dart d, const VertexAttribute& position, const VEC3& P) ; typename PFP::REAL squaredDistancePoint2FacePlane(typename PFP::MAP& map, Face f, const VertexAttribute& position, const VEC3& P) ; /** /** * compute squared distance from point to face (assuming face is convex) * compute squared distance from point to face (assuming face is convex) * Algo: min distance of each subtriangle of face (not optimum ?) * Algo: min distance of each subtriangle of face (not optimum ?) * @param map the map * @param map the map * @param d a dart of the face * @param f a face * @param position the vertex attribute storing positions * @param P the point * @param P the point * @return the squared distance * @return the squared distance */ */ template template typename PFP::REAL squaredDistancePoint2Face(typename PFP::MAP& map, Dart d, const VertexAttribute& position, const VEC3& P) ; typename PFP::REAL squaredDistancePoint2Face(typename PFP::MAP& map, Face f, const VertexAttribute& position, const VEC3& P) ; /** /** * compute squared distance from point to an edge * compute squared distance from point to an edge * @param map the map * @param map the map * @param d a dart of the edge * @param e an edge * @param position the vertex attribute storing positions * @param P the point * @param P the point * @return the squared distance * @return the squared distance */ */ template template typename PFP::REAL squaredDistancePoint2Edge(typename PFP::MAP& map, Dart d, const VertexAttribute& position, const VEC3& P) ; typename PFP::REAL squaredDistancePoint2Edge(typename PFP::MAP& map, Edge e, const VertexAttribute& position, const VEC3& P) ; template bool isPlanar(typename PFP::MAP& map, Dart d, const VertexAttribute& position); } // namespace Geometry } // namespace Geometry ... ...
 ... @@ -23,8 +23,6 @@ ... @@ -23,8 +23,6 @@ *******************************************************************************/ *******************************************************************************/ #include "Geometry/distances.h" #include "Geometry/distances.h" #include "Algo/Geometry/normal.h" #include namespace CGoGN namespace CGoGN { { ... @@ -36,64 +34,50 @@ namespace Geometry ... @@ -36,64 +34,50 @@ namespace Geometry { { template template bool isPlanar(typename PFP::MAP& map, Dart d, const VertexAttribute& position) typename PFP::REAL squaredDistancePoint2FacePlane(typename PFP::MAP& map, Face f, const VertexAttribute& position, const VEC3& P) { { if (map.phi<111>(d)==d) Vertex v(f.dart); return true; const typename PFP::VEC3& A = position[v]; v.dart = map.phi1(v.dart); const typename PFP::VEC3& B = position[v]; v.dart = map.phi1(v.dart); const typename PFP::VEC3& C = position[v]; typename PFP::VEC3 No = Algo::Surface::Geometry::triangleNormal(map, d, position) ; return Geom::squaredDistancePoint2TrianglePlane(P, A, B, C); Dart e = map.phi<11>(d); while (e != d) { typename PFP::VEC3 n = Algo::Surface::Geometry::triangleNormal(map, e, position) ; e = map.phi1(e); if (e!=d) e = map.phi1(e); } } } template template typename PFP::REAL squaredDistancePoint2FacePlane(typename PFP::MAP& map, Dart d, const VertexAttribute& position, const VEC3& P) typename PFP::REAL squaredDistancePoint2Face(typename PFP::MAP& map, Face f, const VertexAttribute& position, const VEC3& P) { const typename PFP::VEC3& A = position[d]; d = map.phi1(d); const typename PFP::VEC3& B = position[d]; d = map.phi1(d); const typename PFP::VEC3& C = position[d]; return Geom::squaredDistancePoint2TrianglePlane(P,A,B,C); } template typename PFP::REAL squaredDistancePoint2Face(typename PFP::MAP& map, Dart d, const VertexAttribute& position, const VEC3& P) { { typedef typename PFP::REAL REAL; typedef typename PFP::REAL REAL; const typename PFP::VEC3& A = position[d]; const typename PFP::VEC3& A = position[f.dart]; Dart d = map.phi1(f.dart); Dart e = map.phi1(d); Dart e = map.phi1(d); Dart f = map.phi1(e); REAL dist2 = Geom::squaredDistancePoint2Triangle(P, A, position[d], position[e]); REAL dist2 = Geom::squaredDistancePoint2Triangle(P,A,position[e],position[f]); d = e; e = f; e = map.phi1(d); f = map.phi1(e); while (f != d) while (e != f.dart) { { REAL d2 = Geom::squaredDistancePoint2Triangle(P,A,position[e],position[f]); REAL d2 = Geom::squaredDistancePoint2Triangle(P, A, position[d], position[e]); if (d2 < dist2) if (d2 < dist2) dist2 = d2; dist2 = d2; e = f; d = e; f = map.phi1(e); e = map.phi1(d); } } return dist2; return dist2; } } template template typename PFP::REAL squaredDistancePoint2Edge(typename PFP::MAP& map, Dart d, const VertexAttribute& position, const VEC3& P) typename PFP::REAL squaredDistancePoint2Edge(typename PFP::MAP& map, Edge e, const VertexAttribute& position, const VEC3& P) { { const typename PFP::VEC3& A = position[d]; const typename PFP::VEC3& A = position[e.dart]; typename PFP::VEC3& AB = position[map.phi1(d)]-A; typename PFP::VEC3 AB = position[map.phi1(e.dart)] - A; typename PFP::REAL AB2 = AB*AB; typename PFP::REAL AB2 = AB * AB; return Geom::squaredDistanceSeg2Point(A,AB,AB2,P) ; return Geom::squaredDistanceSeg2Point(A, AB, AB2, P) ; } } } // namespace Geometry } // namespace Geometry ... ...
 ... @@ -24,7 +24,7 @@ ... @@ -24,7 +24,7 @@ #include "Geometry/basic.h" #include "Geometry/basic.h" #include "Algo/Geometry/normal.h" #include "Algo/Geometry/normal.h" #include "Topology/generic/traversorCell.h" #include "Topology/generic/traversor/traversorCell.h" namespace CGoGN namespace CGoGN { { ... ...
 ... @@ -45,61 +45,61 @@ namespace Geometry ... @@ -45,61 +45,61 @@ namespace Geometry /** /** * test if the volume is convex * test if the volume is convex * @param the map * @param the map * @param a dart of the volume * @param a volume * @param true if the faces of the volume must be in CCW order (default=true) * @param true if the faces of the volume must be in CCW order (default=true) */ */ template template bool isConvex(typename PFP::MAP& map, Dart d, const VertexAttribute& positions, bool CCW, unsigned int thread = 0); bool isConvex(typename PFP::MAP& map, Vol v, const VertexAttribute& positions, bool CCW, unsigned int thread = 0); /** /** * test if a point is inside a volume * test if a point is inside a volume * @param map the map * @param map the map * @param d a dart defining the volume * @param a volume * @param the point * @param the point */ */ template template bool isPointInVolume(typename PFP::MAP& map, Dart d, const VertexAttribute& positions, const typename PFP::VEC3& point); bool isPointInVolume(typename PFP::MAP& map, Vol v, const VertexAttribute& positions, const typename PFP::VEC3& point); /** /** * test if a point is inside a volume * test if a point is inside a volume * @param map the map * @param map the map * @param d a dart defining a convex volume * @param a convex volume * @param the point * @param the point */ */ template template bool isPointInConvexVolume(typename PFP::MAP& map, Dart d, const VertexAttribute& positions, const typename PFP::VEC3& point, bool CCW = true); bool isPointInConvexVolume(typename PFP::MAP& map, Vol v, const VertexAttribute& positions, const typename PFP::VEC3& point, bool CCW = true); /** /** * test if a point is inside a face in a plane * test if a point is inside a face * @param map the map * @param map the map * @param d a dart defining the face * @param a face * @param the point * @param the point */ */ template template bool isPointInConvexFace2D(typename PFP::MAP& map, Dart d, const VertexAttribute& positions, const typename PFP::VEC3& point, bool CCW = true); bool isPointInConvexFace(typename PFP::MAP& map, Face f, const VertexAttribute& positions, const typename PFP::VEC3& point, bool CCW); /** /** * test if a point is inside a face * test if a point is inside a face in a plane * @param map the map * @param map the map * @param d a dart defining the face * @param a face * @param the point * @param the point */ */ template template bool isPointInConvexFace(typename PFP::MAP& map, Dart d, const VertexAttribute& positions, const typename PFP::VEC3& point, bool CCW); bool isPointInConvexFace2D(typename PFP::MAP& map, Face f, const VertexAttribute& positions, const typename PFP::VEC3& point, bool CCW = true); /** /** * test if a point is on an edge * test if a point is on an edge * @param map the map * @param map the map * @param d a dart defining the edge * @param an edge * @param the point * @param the point */ */ template template bool isPointOnEdge(typename PFP::MAP& map, Dart d, const VertexAttribute& positions, const typename PFP::VEC3& point); bool isPointOnEdge(typename PFP::MAP& map, Edge e, const VertexAttribute& positions, const typename PFP::VEC3& point); /** /** * test if a point is on an half-edge defined by a dart * test if a point is on an half-edge defined by a dart * @param map the map * @param map the map * @param d a dart defining the edge * @param a Dart * @param the point * @param the point */ */ template template ... @@ -108,23 +108,22 @@ bool isPointOnHalfEdge(typename PFP::MAP& map, Dart d, const VertexAttribute template bool isPointOnVertex(typename PFP::MAP& map, Dart d, const VertexAttribute& positions, const typename PFP::VEC3& point); bool isPointOnVertex(typename PFP::MAP& map, Vertex v, const VertexAttribute& positions, const typename PFP::VEC3& point); /** /** * test if a face is intersecting or totally included in a tetrahedron * test if a face is intersecting or totally included in a tetrahedron * TODO to test * TODO to test * @param map the map * @param map the map * @param d a dart defining the face * @param f a face * @param the points of the tetra (0,1,2) the first face and (3) the last point of the tetra, in well oriented order * @param the points of the tetra (0,1,2) the first face and (3) the last point of the tetra, in well oriented order * @param true if the faces of the tetra are in CCW order (default=true) * @param true if the faces of the tetra are in CCW order (default=true) */ */ template template bool isConvexFaceInOrIntersectingTetrahedron(typename PFP::MAP& map, Dart d, const VertexAttribute& positions, const typename PFP::VEC3 points[4], bool CCW); bool isConvexFaceInOrIntersectingTetrahedron(typename PFP::MAP& map, Face f, const VertexAttribute& positions, const typename PFP::VEC3 points[4], bool CCW); } // namespace Geometry } // namespace Geometry ... ...
This diff is collapsed.
 ... @@ -42,47 +42,48 @@ namespace Geometry ... @@ -42,47 +42,48 @@ namespace Geometry * (works with triangular faces but not optimized) * (works with triangular faces but not optimized) * TODO to test * TODO to test * @param map the map * @param map the map * @param d a dart defining the n-sided face * @param f a n-sided face * @param PA segment point 1 * @param PA segment point 1 * @param Dir a direction for the line * @param Dir a direction for the line * @param Inter store the intersection point * @param Inter store the intersection point * @return true if segment intersects the face * @return true if segment intersects the face */ */ template template bool intersectionLineConvexFace(typename PFP::MAP& map, Dart d, const VertexAttribute& position, const typename PFP::VEC3& P, const typename PFP::VEC3& Dir, typename PFP::VEC3& Inter) ; bool intersectionLineConvexFace(typename PFP::MAP& map, Face f, const VertexAttribute& position, const typename PFP::VEC3& P, const typename PFP::VEC3& Dir, typename PFP::VEC3& Inter) ; /** /** * test the intersection between a segment and a n-sided face (n>=3) * test the intersection between a segment and a n-sided face (n>=3) * (works with triangular faces but not optimized) * (works with triangular faces but not optimized) * TODO optimize - based on intersectionLineConvexFace - check whether the points are on both sides of the face before computing intersection * TODO optimize - based on intersectionLineConvexFace - check whether the points are on both sides of the face before computing intersection * @param map the map * @param map the map * @param d a dart defining the n-sided face * @param f a n-sided face * @param PA segment point 1 * @param PA segment point 1 * @param PB segment point 2 * @param PB segment point 2 * @param Inter store the intersection point * @param Inter store the intersection point * @return true if segment intersects the face * @return true if segment intersects the face */ */ template template bool intersectionSegmentConvexFace(typename PFP::MAP& map, Dart d, const VertexAttribute& position, const typename PFP::VEC3& PA, const typename PFP::VEC3& PB, typename PFP::VEC3& Inter) ; bool intersectionSegmentConvexFace(typename PFP::MAP& map, Face f, const VertexAttribute& position, const typename PFP::VEC3& PA, const typename PFP::VEC3& PB, typename PFP::VEC3& Inter) ; /** /** * test if two triangles intersect * test if two triangles intersect * (based on the "Faster Triangle-Triangle intersection Tests" by Oliver Deviller and Philippe Guigue) * (based on the "Faster Triangle-Triangle intersection Tests" by Oliver Deviller and Philippe Guigue) * @param the map * @param the map * @param a dart of the first triangle * @param the first triangle * @param a dart of the second triangle * @param the second triangle */ */ template template bool areTrianglesInIntersection(typename PFP::MAP& map, Dart tri1, Dart tri2, const VertexAttribute& position) ; bool areTrianglesInIntersection(typename PFP::MAP& map, Face t1, Face t2, const VertexAttribute& position) ; /** /** * alpha = coef d'interpolation dans [0 ,1] tel que v = (1-alpha)*pin + alpha*pout * alpha = coef d'interpolation dans [0,1] tel que v = (1-alpha)*pin + alpha*pout * est le point d'intersection entre la sphère et le segment [pin, pout] * est le point d'intersection entre la sphère et le segment [pin, pout] * avec pin = position[d] à l'intérieur de la sphère * avec pin = position[v1] à l'intérieur de la sphère * avec pout = position[phi1(d)] à l'extérieur de la sphère * avec pout = position[v2] à l'extérieur de la sphère * et v1 et v2 les deux sommets de l'arête */ */ template template bool intersectionSphereEdge(typename PFP::MAP& map, typename PFP::VEC3& center, typename PFP::REAL radius, Dart d, const VertexAttribute& position, typename PFP::REAL& alpha) ; bool intersectionSphereEdge(typename PFP::MAP& map, typename PFP::VEC3& center, typename PFP::REAL radius, Edge e, const VertexAttribute& position, typename PFP::REAL& alpha) ; } // namespace Geometry } // namespace Geometry ... ...
 ... @@ -44,12 +44,14 @@ namespace Geometry ... @@ -44,12 +44,14 @@ namespace Geometry { { template template bool intersectionLineConvexFace(typename PFP::MAP& map, Dart d, const VertexAttribute& position, const typename PFP::VEC3& P, const typename PFP::VEC3& Dir, typename PFP::VEC3& Inter) bool intersectionLineConvexFace(typename PFP::MAP& map, Face f, const VertexAttribute& position, const typename PFP::VEC3& P, const typename PFP::VEC3& Dir, typename PFP::VEC3& Inter) { { typedef typename PFP::VEC3 VEC3 ; typedef typename PFP::VEC3 VEC3 ; const float SMALL_NUM = std::numeric_limits::min() * 5.0f; const float SMALL_NUM = std::numeric_limits::min() * 5.0f; Dart d = f.dart; VEC3 p1 = position[d]; VEC3 p1 = position[d]; VEC3 n = faceNormal(map, d, position); VEC3 n = faceNormal(map, d, position); VEC3 w0 = P - p1; VEC3 w0 = P - p1; ... @@ -90,12 +92,12 @@ bool intersectionLineConvexFace(typename PFP::MAP& map, Dart d, const VertexAttr ... @@ -90,12 +92,12 @@ bool intersectionLineConvexFace(typename PFP::MAP& map, Dart d, const VertexAttr } } template template bool intersectionSegmentConvexFace(typename PFP::MAP& map, Dart d, const VertexAttribute& position, const typename PFP::VEC3& PA, const typename PFP::VEC3& PB, typename PFP::VEC3& Inter) bool intersectionSegmentConvexFace(typename PFP::MAP& map, Face f, const VertexAttribute& position, const typename PFP::VEC3& PA, const typename PFP::VEC3& PB, typename PFP::VEC3& Inter) { { typedef typename PFP::VEC3 VEC3 ; typedef typename PFP::VEC3 VEC3 ; VEC3 dir = PB - PA; VEC3 dir = PB - PA; if (intersectionLineConvexFace(map, d, position, PA, dir, Inter)) if (intersectionLineConvexFace(map, f, position, PA, dir, Inter)) { { VEC3 dirA = PA - Inter; VEC3 dirA = PA - Inter; VEC3 dirB = PB - Inter; VEC3 dirB = PB - Inter; ... @@ -107,10 +109,13 @@ bool intersectionSegmentConvexFace(typename PFP::MAP& map, Dart d, const VertexA ... @@ -107,10 +109,13 @@ bool intersectionSegmentConvexFace(typename PFP::MAP& map, Dart d, const VertexA } } template template bool areTrianglesInIntersection(typename PFP::MAP& map, Dart tri1, Dart tri2, const VertexAttribute& position) bool areTrianglesInIntersection(typename PFP::MAP& map, Face t1, Face t2, const VertexAttribute& position) { { typedef typename PFP::VEC3 VEC3 ; typedef typename PFP::VEC3 VEC3 ; Dart tri1 = t1.dart; Dart tri2 = t2.dart; //get vertices position //get vertices position VEC3 tris1[3]; VEC3 tris1[3]; VEC3 tris2[3]; VEC3 tris2[3]; ... @@ -174,8 +179,8 @@ bool areTrianglesInIntersection(typename PFP::MAP& map, Dart tri1, Dart tri2, co ... @@ -174,8 +179,8 @@ bool areTrianglesInIntersection(typename PFP::MAP& map, Dart tri1, Dart tri2, co // return isSegmentInTriangle2D(inter1,inter2,tris2[0],tris2[1],triS2[2],nTri2); // return isSegmentInTriangle2D(inter1,inter2,tris2[0],tris2[1],triS2[2],nTri2); //compute face normal //compute face normal VEC3 normale1 = faceNormal(map, tri1, position); VEC3 normale1 = faceNormal(map, t1, position); VEC3 bary1 = faceCentroid(map, tri1, position); VEC3 bary1 = faceCentroid(map, t1, position); int pos = 0; int pos = 0; int neg = 0; int neg = 0; ... @@ -184,9 +189,9 @@ bool areTrianglesInIntersection(typename PFP::MAP& map, Dart tri1, Dart tri2, co ... @@ -184,9 +189,9 @@ bool areTrianglesInIntersection(typename PFP::MAP& map, Dart tri1, Dart tri2, co { { VEC3 nTest = bary1 - tris2[i];