void PlaneFitSmoothing::SmoothPoints(unsigned int iterations, const std::vector<unsigned long>& point_indices) { MeshCore::MeshPoint center; MeshCore::MeshPointArray PointArray = kernel.GetPoints(); MeshCore::MeshPointIterator v_it(kernel); MeshCore::MeshRefPointToPoints vv_it(kernel); MeshCore::MeshPointArray::_TConstIterator v_beg = kernel.GetPoints().begin(); for (unsigned int i=0; i<iterations; i++) { Base::Vector3f N, L; for (std::vector<unsigned long>::const_iterator it = point_indices.begin(); it != point_indices.end(); ++it) { v_it.Set(*it); MeshCore::PlaneFit pf; pf.AddPoint(*v_it); center = *v_it; const std::set<unsigned long>& cv = vv_it[v_it.Position()]; if (cv.size() < 3) continue; std::set<unsigned long>::const_iterator cv_it; for (cv_it = cv.begin(); cv_it !=cv.end(); ++cv_it) { pf.AddPoint(v_beg[*cv_it]); center += v_beg[*cv_it]; } float scale = 1.0f/((float)cv.size()+1.0f); center.Scale(scale,scale,scale); // get the mean plane of the current vertex with the surrounding vertices pf.Fit(); N = pf.GetNormal(); N.Normalize(); // look in which direction we should move the vertex L.Set(v_it->x - center.x, v_it->y - center.y, v_it->z - center.z); if (N*L < 0.0) N.Scale(-1.0, -1.0, -1.0); // maximum value to move is distance to mean plane float d = std::min<float>((float)fabs(this->tolerance),(float)fabs(N*L)); N.Scale(d,d,d); PointArray[v_it.Position()].Set(v_it->x - N.x, v_it->y - N.y, v_it->z - N.z); } // assign values without affecting iterators unsigned long count = kernel.CountPoints(); for (unsigned long idx = 0; idx < count; idx++) { kernel.SetPoint(idx, PointArray[idx]); } } }
void ParameterCorrection::CalcEigenvectors() { MeshCore::PlaneFit planeFit; //for (it = aclPoints.begin(); it!=aclPoints.end(); ++it) // planeFit.AddPoint(*it); for (int i=_pvcPoints->Lower(); i<=_pvcPoints->Upper(); i++) { planeFit.AddPoint(Base::Vector3f( (float)(*_pvcPoints)(i).X(), (float)(*_pvcPoints)(i).Y(), (float)(*_pvcPoints)(i).Z())); } planeFit.Fit(); _clU = planeFit.GetDirU(); _clV = planeFit.GetDirV(); _clW = planeFit.GetNormal(); }