2 // Before editing this file, make sure it's a file of your own (i.e.: it wasn't generated from xml description; if so : your modifications will be lost)
4 #include "bbcreaVtkCreateMeshFromPoints.h"
5 #include "bbcreaVtkPackage.h"
7 #include "vtkTriangleStrip.h"
8 #include "vtkTriangle.h"
14 BBTK_ADD_BLACK_BOX_TO_PACKAGE(creaVtk,CreateMeshFromPoints)
15 BBTK_BLACK_BOX_IMPLEMENTATION(CreateMeshFromPoints,bbtk::AtomicBlackBox);
17 // Before editing this file, make sure it's a file of your own (i.e.: it wasn't generated from xml description; if so : your modifications will be lost)
19 void CreateMeshFromPoints::Process()
22 // THE MAIN PROCESSING METHOD BODY
23 // Here we simply set the input 'In' value to the output 'Out'
24 // And print out the output value
25 // INPUT/OUTPUT ACCESSORS ARE OF THE FORM :
26 // void bbSet{Input|Output}NAME(const TYPE&)
27 // const TYPE& bbGet{Input|Output}NAME() const
29 // * NAME is the name of the input/output
30 // (the one provided in the attribute 'name' of the tag 'input')
31 // * TYPE is the C++ type of the input/output
32 // (the one provided in the attribute 'type' of the tag 'input')
34 // bbSetOutputOut( bbGetInputIn() );
35 // std::cout << "Output value = " <<bbGetOutputOut() << std::endl;
37 std::vector<double> lstX = bbGetInputLstX();
38 std::vector<double> lstY = bbGetInputLstY();
39 std::vector<double> lstZ = bbGetInputLstZ();
40 std::vector<int> lstIndexs = bbGetInputLstIndexs();
41 if ( (lstIndexs.size()<1) || (lstX.size()==0) || (lstX.size()!=lstY.size()) || (lstY.size()!=lstZ.size()) )
43 printf("Warning! CreateMeshFromPoints::Process: List of points X Y Z and LstIndexes is not correct\n");
46 int ii,sizeSegment1,sizeSegment2;
48 // vtkSmartPointer<vtkPoints> points = vtkSmartPointer<vtkPoints>::New();
49 if (points!=NULL) points->Delete();
50 points = vtkPoints::New();
51 int i,sizeLstX = lstX.size();
52 for (i=0;i<sizeLstX;i++)
54 points->InsertNextPoint(lstX[i],lstY[i],lstZ[i]);
56 // vtkSmartPointer<vtkCellArray> cells = vtkSmartPointer<vtkCellArray>::New();
57 if (cells!=NULL) cells->Delete();
58 cells = vtkCellArray::New();
60 int maxSegment1,maxSegment2;
63 int sizeLstIdexes=lstIndexs.size();
64 for (i=0; i<sizeLstIdexes-1; i++ )
66 sizeSegment1 = lstIndexs[i];
67 sizeSegment2 = lstIndexs[i+1];
68 vtkSmartPointer<vtkTriangleStrip> triangleStrip = vtkSmartPointer<vtkTriangleStrip>::New();
69 triangleStrip->GetPointIds()->SetNumberOfIds(sizeSegment1+sizeSegment2);
70 maxElements=sizeSegment1;
71 if (maxElements<sizeSegment2) maxElements=sizeSegment2;
72 maxSegment1 = iGeneral+sizeSegment1;
73 maxSegment2 = iGeneral+sizeSegment1+sizeSegment2;
75 iSeg2 = iGeneral+sizeSegment1;
76 for (ii=0; ii<maxElements; ii++)
78 triangleStrip->GetPointIds()->SetId(ii*2 ,iSeg1);
79 triangleStrip->GetPointIds()->SetId(ii*2+1,iSeg2);
82 if (iSeg1>=maxSegment1) { iSeg1=maxSegment1-1; }
83 if (iSeg2>=maxSegment2) { iSeg2=maxSegment2-1; }
85 iGeneral=iGeneral+sizeSegment1;
86 cells->InsertNextCell(triangleStrip);
89 if(bbGetInputCloseSurface())
91 int lastId1 = lstIndexs[0]-1;
92 int lastId2 = sizeLstX - 1;
93 int firstId2 = sizeLstX - lstIndexs[sizeLstIdexes - 1];
94 bool face1open = std::fabs(lstX[0] - lstX[lastId1]) > 0.0001 && std::fabs(lstY[0] - lstY[lastId1]) > 0.0001 && std::fabs(lstZ[0] - lstZ[lastId1]) > 0.0001;
95 bool face2open = std::fabs(lstX[firstId2] - lstX[lastId2]) > 0.0001 && std::fabs(lstY[firstId2] - lstY[lastId2]) > 0.0001 && std::fabs(lstZ[firstId2] - lstZ[lastId2]) > 0.0001;
97 bool altFace1open = std::fabs(lstX[0] - lstX[firstId2]) > 0.0001 && std::fabs(lstY[0] - lstY[firstId2]) > 0.0001 && std::fabs(lstZ[0] - lstZ[firstId2]) > 0.0001;
98 bool altFace2open = std::fabs(lstX[lastId1] - lstX[lastId2]) > 0.0001 && std::fabs(lstY[lastId1] - lstY[lastId2]) > 0.0001 && std::fabs(lstZ[lastId1] - lstZ[lastId2]) > 0.0001;
100 //false = Open Contour
101 //true = Closed Contour
102 if(!face1open && !face2open)
104 // isClosedCont = true;
105 CloseContourSides(lstIndexs, true, true);
107 else if(!altFace1open && !altFace2open)
109 // isClosedCont = true;
110 CloseContourSides(lstIndexs, false, true);
113 CloseOpenContourSurface(lstIndexs);
117 // vtkPolyData *polydata = vtkPolyData::New();
118 if (polydata!=NULL) polydata->Delete();
119 polydata = vtkPolyData::New();
120 polydata->SetPoints(points);
121 polydata->SetStrips(cells);
122 // vtkCleanPolyData *clean=vtkCleanPolyData::New();
123 if (clean!=NULL) clean->Delete();
124 clean = vtkCleanPolyData::New();
125 clean->SetInputData(polydata);
127 // vtkTriangleFilter *triangle = vtkTriangleFilter::New();
128 if (triangle!=NULL) triangle->Delete();
129 triangle = vtkTriangleFilter::New();
130 triangle->SetInputData( clean->GetOutput() );
132 bbSetOutputOut( triangle->GetOutput() );
133 // bbSetOutputOut( clean->GetOutput() );
135 //printf("PG CreateMeshFromPoints::Process: End\n");
138 * Closes the sides of the contour
139 * iterates in one way or the other, depending on the order of the points and calculated vectors.
140 * uPointOrder: Points are order in a U shape
141 * lstIndexs: number of points on each spline
143 void CreateMeshFromPoints::CloseContourSides(std::vector<int> lstIndexs, bool uPointOrder, bool isClosedCont){
144 int sizeLstIdexes = lstIndexs.size();
145 int sizePoints = bbGetInputLstX().size();
147 int firstIndex, end, centroidId, numPointsFace, contraryId;
148 int increment = uPointOrder?1:sizeLstIdexes;
150 int numProcessFaces = sizeLstIdexes > 1?2:1;
151 for(int facesIdx = 0; facesIdx < numProcessFaces; facesIdx++){
152 std::fill(std::begin(centroid), std::end(centroid), 0);
156 numPointsFace = uPointOrder?lstIndexs[0]: sizeLstIdexes;
157 end = uPointOrder?firstIndex + numPointsFace:sizePoints - lstIndexs[sizeLstIdexes - 1] + 1;
158 contraryId = sizePoints-1;
160 firstIndex = uPointOrder?sizePoints - lstIndexs[sizeLstIdexes-1]:lstIndexs[0]-1;
161 numPointsFace = uPointOrder?lstIndexs[sizeLstIdexes-1]:sizeLstIdexes;
162 end = uPointOrder?firstIndex + numPointsFace:sizePoints;
165 if(numPointsFace > 1)
167 bool validCentroid = CalcValidCentroid(centroid, firstIndex, end, increment, numPointsFace);
170 bool normalOrder = isPointingCorrectly(firstIndex, firstIndex+increment, centroid, contraryId);
171 centroidId = points->InsertNextPoint(centroid[0], centroid[1], centroid[2]);
172 //vtkSmartPointer<vtkTriangleStrip> triangleStrip = vtkSmartPointer<vtkTriangleStrip>::New();
173 //triangleStrip->GetPointIds()->SetNumberOfIds(numPointsFace*2 + (!isClosedCont?2:0));
174 //int triangleIndex = 0;
177 int initial = firstIndex;
178 for(int index = initial; index < end; index+=increment){
179 if(index+increment >= end && !isClosedCont){
180 vtkNew<vtkTriangle> triangle;
181 triangle->GetPointIds()->SetId(0, index);
182 triangle->GetPointIds()->SetId(1, initial);
183 triangle->GetPointIds()->SetId(2, centroidId);
184 cells->InsertNextCell(triangle);
185 }else if(index+increment < end){
186 vtkNew<vtkTriangle> triangle;
187 triangle->GetPointIds()->SetId(0, index);
188 triangle->GetPointIds()->SetId(1, index+increment);
189 triangle->GetPointIds()->SetId(2, centroidId);
190 cells->InsertNextCell(triangle);
193 triangleStrip->GetPointIds()->SetId(triangleIndex,index);
194 triangleStrip->GetPointIds()->SetId(triangleIndex+1,centroidId);//1
195 if(index+increment >= end && !isClosedCont){
196 triangleStrip->GetPointIds()->SetId(triangleIndex+2,initial);//2
197 triangleStrip->GetPointIds()->SetId(triangleIndex+3,centroidId);//3
202 //cells->InsertNextCell(triangleStrip);
204 int initial = firstIndex-1;
205 int triangleStripStart = end-1;
206 for(int index = triangleStripStart; index > initial; index-=increment){
207 if(index-increment <= initial && !isClosedCont){
208 vtkNew<vtkTriangle> triangle;
209 triangle->GetPointIds()->SetId(0, index);
210 triangle->GetPointIds()->SetId(1, triangleStripStart);
211 triangle->GetPointIds()->SetId(2, centroidId);
212 cells->InsertNextCell(triangle);
213 }else if(index-increment > initial){
214 vtkNew<vtkTriangle> triangle;
215 triangle->GetPointIds()->SetId(0, index);
216 triangle->GetPointIds()->SetId(1, index-increment);
217 triangle->GetPointIds()->SetId(2, centroidId);
218 cells->InsertNextCell(triangle);
220 /**triangleStrip->GetPointIds()->SetId(triangleIndex,index);
221 triangleStrip->GetPointIds()->SetId(triangleIndex+1,centroidId);
222 if(index-increment <= initial && !isClosedCont){
223 triangleStrip->GetPointIds()->SetId(triangleIndex+2,triangleStripStart);
224 triangleStrip->GetPointIds()->SetId(triangleIndex+3,centroidId);
229 //cells->InsertNextCell(triangleStrip);
238 * Checks if the normal from firstPointId, secPointId and centroid points away
239 * from the vector centroid to contrPointId.
240 * Used to check that the order used to create the new polygons is correct.
242 bool CreateMeshFromPoints::isPointingCorrectly( int firstPointId, int secPointId, double(¢roid)[3], int contrPointId) {
244 double firstPoint[3], secPoint[3], contrPoint[3];
245 points->GetPoint(firstPointId, firstPoint);
246 points->GetPoint(secPointId, secPoint);
248 double firstVect[3], secVect[3], normal[3], contrVect[3];
250 vtkMath::Subtract(firstPoint, centroid, firstVect);
251 vtkMath::Subtract(secPoint, centroid, secVect);
253 points->GetPoint(contrPointId, contrPoint);
254 vtkMath::Subtract(contrPoint, centroid, contrVect);
256 vtkMath::Cross(firstVect, secVect, normal);
258 dotCalc = vtkMath::Dot(normal, contrVect);
264 * Checks if points on each side of the shapes represent a curve.
266 bool CreateMeshFromPoints::CheckLinePointOrder(){
267 int sizePoints = bbGetInputLstX().size();
268 std::vector<int> lstIndexs = bbGetInputLstIndexs();
269 double point1[3], point2[3], point3[3];
271 double firstRadiusSum = 0;
272 double secondRadiusSum = 0;
273 for(int i = 0; i < lstIndexs[0] && lstIndexs[0] > 9; i+=5){
274 if(i+10 < lstIndexs[0]){
275 points->GetPoint(i, point1);
276 points->GetPoint(i+5, point2);
277 points->GetPoint(i+10, point3);
278 firstRadiusSum += vtkMath::Solve3PointCircle(point1, point2, point3, center);
282 for(int i = 0; i < sizePoints && lstIndexs.size() > 9; i+=(lstIndexs.size()*5)){
283 if(i+(10*lstIndexs.size()) < sizePoints){
284 points->GetPoint(i, point1);
285 points->GetPoint(i+(5*lstIndexs.size()), point2);
286 points->GetPoint(i+(10*lstIndexs.size()), point3);
287 secondRadiusSum += vtkMath::Solve3PointCircle(point1, point2, point3, center);
291 return firstRadiusSum > secondRadiusSum;
295 * Closes an open contour
296 * lstIndexs: number of points on each spline
298 void CreateMeshFromPoints::CloseOpenContourSurface(std::vector<int> lstIndexs){
299 bool linePointOrder = CheckLinePointOrder();
300 CloseContourSides(lstIndexs, !linePointOrder, false);
301 CloseContourBottom(!linePointOrder);
305 * Calculates centroid and checks if points are collinear.
306 * centroid: array to store calculation
307 * start: start index of points to use
308 * end: end index of points to use
309 * increment: increment to be used in point iteration
310 * numPoints: number of points used to calculate the centroid.
311 * Returns a bool indicating the validity of the centroid calculated.
312 * False = invalid centroid = all points are the same.
314 bool CreateMeshFromPoints::CalcValidCentroid(double(¢roid)[3], int start, int end, int increment, int numPoints){
315 double currPoint[3] = {}, prevPoint[3] = {}, middlePoint[3] = {}, firstPoint[3] = {};
316 double vector1[3], vector2[3];
317 bool samePoint = true;
318 int splineMidPoint = numPoints/2;
319 bool collinear = true;
321 points->GetPoint(start, firstPoint);
322 points->GetPoint(splineMidPoint, middlePoint);
323 vtkMath::Subtract(middlePoint, firstPoint, vector1);
325 for(int i = start; i < end; i+=increment){
326 points->GetPoint(i, currPoint);
327 if(samePoint && i > start && (currPoint[0] != prevPoint[0] || currPoint[1] != prevPoint[1] || currPoint[2] != prevPoint[2])){
331 vtkMath::Subtract(currPoint, firstPoint, vector2);
332 double angle = vtkMath::AngleBetweenVectors(vector1, vector2);
333 if(angle > 0.0001 && collinear){
337 centroid[0] += currPoint[0];
338 centroid[1] += currPoint[1];
339 centroid[2] += currPoint[2];
340 std::copy(std::begin(currPoint), std::end(currPoint), prevPoint);
343 centroid[0] /= numPoints;
344 centroid[1] /= numPoints;
345 centroid[2] /= numPoints;
347 return !samePoint && !collinear;
351 * Closes the bottom of the given countour.
352 * Should only be used when its an open contour.
353 * uPointOrder: points are ordered in U shape
355 void CreateMeshFromPoints::CloseContourBottom(bool uPointOrder){
356 std::vector<int> lstIndexs = bbGetInputLstIndexs();
357 int sizeLstIdexes = lstIndexs.size();
358 int sizeLstX = bbGetInputLstX().size();
360 vtkSmartPointer<vtkTriangleStrip> triangleStripBottom = vtkSmartPointer<vtkTriangleStrip>::New();
361 triangleStripBottom->GetPointIds()->SetNumberOfIds(sizeLstIdexes*2);
362 int triangleIndex = 0, currentId = 0, nextId = 0;
363 for(int splineIndex = 0; splineIndex < sizeLstIdexes;splineIndex++){
364 triangleStripBottom->GetPointIds()->SetId(triangleIndex, currentId);
365 nextId = uPointOrder?currentId + lstIndexs[splineIndex] - 1:sizeLstX - sizeLstIdexes + splineIndex;
366 triangleStripBottom->GetPointIds()->SetId(triangleIndex+1, nextId);
368 currentId = uPointOrder?nextId + 1: splineIndex+1;
370 cells->InsertNextCell(triangleStripBottom);
374 // Before editing this file, make sure it's a file of your own (i.e.: it wasn't generated from xml description; if so : your modifications will be lost)
376 void CreateMeshFromPoints::bbUserSetDefaultValues()
379 // SET HERE THE DEFAULT INPUT/OUTPUT VALUES OF YOUR BOX
380 // Here we initialize the input 'In' to 0
382 bbSetInputCloseSurface(false);
390 // Before editing this file, make sure it's a file of your own (i.e.: it wasn't generated from xml description; if so : your modifications will be lost)
392 void CreateMeshFromPoints::bbUserInitializeProcessing()
395 // THE INITIALIZATION METHOD BODY :
397 // but this is where you should allocate the internal/output pointers
403 // Before editing this file, make sure it's a file of your own (i.e.: it wasn't generated from xml description; if so : your modifications will be lost)
405 void CreateMeshFromPoints::bbUserFinalizeProcessing()
408 // THE FINALIZATION METHOD BODY :
410 // but this is where you should desallocate the internal/output pointers
415 // EO namespace bbcreaVtk