ModHausdorffT.cc 12.7 KB
Newer Older
Jan Möbius's avatar
Jan Möbius committed
1
/* ========================================================================= *
Jan Möbius's avatar
Jan Möbius committed
2 3
 *                                                                           *
 *                               OpenMesh                                    *
Jan Möbius's avatar
Jan Möbius committed
4
 *           Copyright (c) 2001-2015, RWTH-Aachen University                 *
Jan Möbius's avatar
Typo  
Jan Möbius committed
5
 *           Department of Computer Graphics and Multimedia                  *
Jan Möbius's avatar
Jan Möbius committed
6 7
 *                          All rights reserved.                             *
 *                            www.openmesh.org                               *
Jan Möbius's avatar
Jan Möbius committed
8 9
 *                                                                           *
 *---------------------------------------------------------------------------*
Jan Möbius's avatar
Jan Möbius committed
10 11
 * This file is part of OpenMesh.                                            *
 *---------------------------------------------------------------------------*
Jan Möbius's avatar
Jan Möbius committed
12
 *                                                                           *
Jan Möbius's avatar
Jan Möbius committed
13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38
 * Redistribution and use in source and binary forms, with or without        *
 * modification, are permitted provided that the following conditions        *
 * are met:                                                                  *
 *                                                                           *
 * 1. Redistributions of source code must retain the above copyright notice, *
 *    this list of conditions and the following disclaimer.                  *
 *                                                                           *
 * 2. Redistributions in binary form must reproduce the above copyright      *
 *    notice, this list of conditions and the following disclaimer in the    *
 *    documentation and/or other materials provided with the distribution.   *
 *                                                                           *
 * 3. Neither the name of the copyright holder nor the names of its          *
 *    contributors may be used to endorse or promote products derived from   *
 *    this software without specific prior written permission.               *
 *                                                                           *
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS       *
 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED *
 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A           *
 * PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER *
 * OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,  *
 * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,       *
 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR        *
 * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF    *
 * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING      *
 * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS        *
 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.              *
Jan Möbius's avatar
Jan Möbius committed
39 40
 *                                                                           *
 * ========================================================================= */
Jan Möbius's avatar
Jan Möbius committed
41 42 43

/*===========================================================================*\
 *                                                                           *
Jan Möbius's avatar
Jan Möbius committed
44 45
 *   $Revision$                                                        *
 *   $Date$                   *
Jan Möbius's avatar
Jan Möbius committed
46 47 48 49 50 51 52 53 54 55 56 57 58
 *                                                                           *
\*===========================================================================*/

/** \file ModHausdorffT.cc
 */


//=============================================================================
//
//  CLASS ModHausdorffT - IMPLEMENTATION
//
//=============================================================================

59
#define OPENMESH_DECIMATER_MODHAUSDORFFT_C
Jan Möbius's avatar
Jan Möbius committed
60 61 62 63 64 65 66 67 68 69 70 71 72 73


//== INCLUDES =================================================================

#include "ModHausdorffT.hh"


//== NAMESPACES ===============================================================

namespace OpenMesh  {
namespace Decimater {

//== IMPLEMENTATION ==========================================================

74 75 76
template <class MeshT>
typename ModHausdorffT<MeshT>::Scalar
ModHausdorffT<MeshT>::
Jan Möbius's avatar
Jan Möbius committed
77 78 79
distPointTriangleSquared( const Point& _p,
                          const Point& _v0,
                          const Point& _v1,
80
                          const Point& _v2 )
Jan Möbius's avatar
Jan Möbius committed
81
{
82 83 84
  const Point v0v1 = _v1 - _v0;
  const Point v0v2 = _v2 - _v0;
  const Point n = v0v1 % v0v2; // not normalized !
Jan Möbius's avatar
Jan Möbius committed
85
  const Scalar d = n.sqrnorm();
Jan Möbius's avatar
Jan Möbius committed
86 87 88 89 90 91


  // Check if the triangle is degenerated
  if (d < FLT_MIN && d > -FLT_MIN) {
    return -1.0;
  }
Jan Möbius's avatar
Jan Möbius committed
92
  const Scalar invD = static_cast<Scalar>(1.0) / d;
Jan Möbius's avatar
Jan Möbius committed
93 94 95

  // these are not needed for every point, should still perform
  // better with many points against one triangle
96
  const Point v1v2 = _v2 - _v1;
Jan Möbius's avatar
Jan Möbius committed
97 98 99
  const Scalar inv_v0v2_2 = static_cast<Scalar>(1.0) / v0v2.sqrnorm();
  const Scalar inv_v0v1_2 = static_cast<Scalar>(1.0) / v0v1.sqrnorm();
  const Scalar inv_v1v2_2 = static_cast<Scalar>(1.0) / v1v2.sqrnorm();
Jan Möbius's avatar
Jan Möbius committed
100 101


Jan Möbius's avatar
Jan Möbius committed
102 103
  Point v0p = _p - _v0;
  Point t = v0p % n;
Jan Möbius's avatar
Jan Möbius committed
104
  typename Point::value_type  s01, s02, s12;
Jan Möbius's avatar
Jan Möbius committed
105 106
  const Scalar a = (t | v0v2) * -invD;
  const Scalar b = (t | v0v1) * invD;
Jan Möbius's avatar
Jan Möbius committed
107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138

  if (a < 0)
  {
    // Calculate the distance to an edge or a corner vertex
    s02 = ( v0v2 | v0p ) * inv_v0v2_2;
    if (s02 < 0.0)
    {
      s01 = ( v0v1 | v0p ) * inv_v0v1_2;
      if (s01 <= 0.0) {
        v0p = _v0;
      } else if (s01 >= 1.0) {
        v0p = _v1;
      } else {
        v0p = _v0 + v0v1 * s01;
      }
    } else if (s02 > 1.0) {
      s12 = ( v1v2 | ( _p - _v1 )) * inv_v1v2_2;
      if (s12 >= 1.0) {
        v0p = _v2;
      } else if (s12 <= 0.0) {
        v0p = _v1;
      } else {
        v0p = _v1 + v1v2 * s12;
      }
    } else {
      v0p = _v0 + v0v2 * s02;
    }
  } else if (b < 0.0) {
    // Calculate the distance to an edge or a corner vertex
    s01 = ( v0v1 | v0p ) * inv_v0v1_2;
    if (s01 < 0.0)
    {
Jan Möbius's avatar
Jan Möbius committed
139
  // const Point n = v0v1 % v0v2; // not normalized !
Jan Möbius's avatar
Jan Möbius committed
140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185
      s02 = ( v0v2 |  v0p ) * inv_v0v2_2;
      if (s02 <= 0.0) {
        v0p = _v0;
      } else if (s02 >= 1.0) {
        v0p = _v2;
      } else {
        v0p = _v0 + v0v2 * s02;
      }
    } else if (s01 > 1.0) {
      s12 = ( v1v2 | ( _p - _v1 )) * inv_v1v2_2;
      if (s12 >= 1.0) {
        v0p = _v2;
      } else if (s12 <= 0.0) {
        v0p = _v1;
      } else {
        v0p = _v1 + v1v2 * s12;
      }
    } else {
      v0p = _v0 + v0v1 * s01;
    }
  } else if (a+b > 1.0) {
    // Calculate the distance to an edge or a corner vertex
    s12 = ( v1v2 | ( _p - _v1 )) * inv_v1v2_2;
    if (s12 >= 1.0) {
      s02 = ( v0v2 | v0p ) * inv_v0v2_2;
      if (s02 <= 0.0) {
        v0p = _v0;
      } else if (s02 >= 1.0) {
        v0p = _v2;
      } else {
        v0p = _v0 + v0v2*s02;
      }
    } else if (s12 <= 0.0) {
      s01 = ( v0v1 |  v0p ) * inv_v0v1_2;
      if (s01 <= 0.0) {
        v0p = _v0;
      } else if (s01 >= 1.0) {
        v0p = _v1;
      } else {
        v0p = _v0 + v0v1 * s01;
      }
    } else {
      v0p = _v1 + v1v2 * s12;
    }
  } else {
    // Calculate the distance to an interior point of the triangle
186
    return ( (_p - n*((n|v0p) * invD)) - _p).sqrnorm();
Jan Möbius's avatar
Jan Möbius committed
187 188
  }

189
  return (v0p - _p).sqrnorm();
Jan Möbius's avatar
Jan Möbius committed
190 191 192
}


193
template <class MeshT>
Jan Möbius's avatar
Jan Möbius committed
194
void
195
ModHausdorffT<MeshT>::
Jan Möbius's avatar
Jan Möbius committed
196 197 198 199 200
initialize()
{
  typename Mesh::FIter  f_it(mesh_.faces_begin()), f_end(mesh_.faces_end());

  for (; f_it!=f_end; ++f_it)
Jan Möbius's avatar
Jan Möbius committed
201
    mesh_.property(points_, *f_it).clear();
Jan Möbius's avatar
Jan Möbius committed
202 203 204 205 206 207
}


//-----------------------------------------------------------------------------


208
template <class MeshT>
Jan Möbius's avatar
Jan Möbius committed
209
float
210
ModHausdorffT<MeshT>::
Jan Möbius's avatar
Jan Möbius committed
211 212 213 214 215
collapse_priority(const CollapseInfo& _ci)
{
  std::vector<FaceHandle>        faces;   faces.reserve(20);
  typename Mesh::VertexFaceIter  vf_it;
  typename Mesh::FaceHandle      fh;
216
  const typename Mesh::Scalar    sqr_tolerace = tolerance_*tolerance_;
Jan Möbius's avatar
Jan Möbius committed
217 218 219
  typename Mesh::CFVIter         fv_it;
  bool                           ok;

220 221 222
  // Clear the temporary point storage
  tmp_points_.clear();

Jan Möbius's avatar
Jan Möbius committed
223 224
  // collect all points to be tested
  // collect all faces to be tested against
Jan Möbius's avatar
Jan Möbius committed
225
  for (vf_it=mesh_.vf_iter(_ci.v0); vf_it.is_valid(); ++vf_it) {
Jan Möbius's avatar
Jan Möbius committed
226
    fh = *vf_it;
Jan Möbius's avatar
Jan Möbius committed
227 228 229 230 231

    if (fh != _ci.fl && fh != _ci.fr)
      faces.push_back(fh);

    Points& pts = mesh_.property(points_, fh);
232
    std::copy(pts.begin(), pts.end(), std::back_inserter(tmp_points_));
Jan Möbius's avatar
Jan Möbius committed
233 234 235
  }

  // add point to be removed
236
  tmp_points_.push_back(_ci.p0);
Jan Möbius's avatar
Jan Möbius committed
237 238 239

  // setup iterators
  typename std::vector<FaceHandle>::iterator  fh_it, fh_end(faces.end());
240
  typename Points::const_iterator             p_it, p_end(tmp_points_.end());
Jan Möbius's avatar
Jan Möbius committed
241 242 243 244 245 246

  // simulate collapse
  mesh_.set_point(_ci.v0, _ci.p1);

  // for each point: try to find a face such that error is < tolerance
  ok = true;
247

248
  for (p_it=tmp_points_.begin(); ok && p_it!=p_end; ++p_it) {
Jan Möbius's avatar
Jan Möbius committed
249 250 251
    ok = false;

    for (fh_it=faces.begin(); !ok && fh_it!=fh_end; ++fh_it) {
Jan Möbius's avatar
Jan Möbius committed
252 253 254 255
      fv_it=mesh_.cfv_iter(*fh_it);
      const Point& p0 = mesh_.point(*fv_it);
      const Point& p1 = mesh_.point(*(++fv_it));
      const Point& p2 = mesh_.point(*(++fv_it));
Jan Möbius's avatar
Jan Möbius committed
256

257
      if (  distPointTriangleSquared(*p_it, p0, p1, p2) <= sqr_tolerace)
Jan Möbius's avatar
Jan Möbius committed
258 259 260 261 262 263 264 265 266 267 268 269
        ok = true;
    }
  }

  // undo simulation changes
  mesh_.set_point(_ci.v0, _ci.p0);

  return ( ok ? Base::LEGAL_COLLAPSE : Base::ILLEGAL_COLLAPSE );
}

//-----------------------------------------------------------------------------

270 271 272 273 274 275
template<class MeshT>
void ModHausdorffT<MeshT>::set_error_tolerance_factor(double _factor) {
  if (_factor >= 0.0 && _factor <= 1.0) {
    // the smaller the factor, the smaller tolerance gets
    // thus creating a stricter constraint
    // division by error_tolerance_factor_ is for normalization
276
    Scalar tolerance = tolerance_ * Scalar(_factor / this->error_tolerance_factor_);
277 278 279 280 281 282
    set_tolerance(tolerance);
    this->error_tolerance_factor_ = _factor;
  }
}

//-----------------------------------------------------------------------------
Jan Möbius's avatar
Jan Möbius committed
283

284
template <class MeshT>
Jan Möbius's avatar
Jan Möbius committed
285
void
286
ModHausdorffT<MeshT>::
Jan Möbius's avatar
Jan Möbius committed
287 288 289 290 291 292 293 294 295
postprocess_collapse(const CollapseInfo& _ci)
{
  typename Mesh::VertexFaceIter  vf_it;
  FaceHandle                     fh;
  std::vector<FaceHandle>        faces;


  // collect points & neighboring triangles

296
  tmp_points_.clear();
Jan Möbius's avatar
Jan Möbius committed
297 298 299
  faces.reserve(20);

  // collect active faces and their points
Jan Möbius's avatar
Jan Möbius committed
300
  for (vf_it=mesh_.vf_iter(_ci.v1); vf_it.is_valid(); ++vf_it) {
Jan Möbius's avatar
Jan Möbius committed
301
    fh = *vf_it;
Jan Möbius's avatar
Jan Möbius committed
302 303 304
    faces.push_back(fh);

    Points& pts = mesh_.property(points_, fh);
305
    std::copy(pts.begin(), pts.end(), std::back_inserter(tmp_points_));
Jan Möbius's avatar
Jan Möbius committed
306 307 308 309 310 311 312 313
    pts.clear();
  }
  if (faces.empty()) return; // should not happen anyway...


  // collect points of the 2 deleted faces
  if ((fh=_ci.fl).is_valid()) {
    Points& pts = mesh_.property(points_, fh);
314
    std::copy(pts.begin(), pts.end(), std::back_inserter(tmp_points_));
Jan Möbius's avatar
Jan Möbius committed
315 316 317 318
    pts.clear();
  }
  if ((fh=_ci.fr).is_valid()) {
    Points& pts = mesh_.property(points_, fh);
319
    std::copy(pts.begin(), pts.end(), std::back_inserter(tmp_points_));
Jan Möbius's avatar
Jan Möbius committed
320 321 322 323
    pts.clear();
  }

  // add the deleted point
324
  tmp_points_.push_back(_ci.p0);
Jan Möbius's avatar
Jan Möbius committed
325 326 327 328


  // setup iterators
  typename std::vector<FaceHandle>::iterator  fh_it, fh_end(faces.end());
329
  typename Points::const_iterator             p_it, p_end(tmp_points_.end());
Jan Möbius's avatar
Jan Möbius committed
330 331 332 333 334

  // re-distribute points
  Scalar                  emin, e;
  typename Mesh::CFVIter  fv_it;

335
  for (p_it=tmp_points_.begin(); p_it!=p_end; ++p_it) {
Jan Möbius's avatar
Jan Möbius committed
336 337 338
    emin = FLT_MAX;

    for (fh_it=faces.begin(); fh_it!=fh_end; ++fh_it) {
Jan Möbius's avatar
Jan Möbius committed
339 340 341 342
      fv_it=mesh_.cfv_iter(*fh_it);
      const Point& p0 = mesh_.point(*fv_it);
      const Point& p1 = mesh_.point(*(++fv_it));
      const Point& p2 = mesh_.point(*(++fv_it));
Jan Möbius's avatar
Jan Möbius committed
343

344
      e =  distPointTriangleSquared(*p_it, p0, p1, p2);
Jan Möbius's avatar
Jan Möbius committed
345 346 347 348 349 350 351 352 353 354 355 356 357 358 359
      if (e < emin) {
        emin = e;
        fh   = *fh_it;
      }

    }

    mesh_.property(points_, fh).push_back(*p_it);
  }
}


//-----------------------------------------------------------------------------


360 361 362
template <class MeshT>
typename ModHausdorffT<MeshT>::Scalar
ModHausdorffT<MeshT>::
Jan Möbius's avatar
Jan Möbius committed
363 364 365 366 367 368 369 370 371 372 373 374 375
compute_sqr_error(FaceHandle _fh, const Point& _p) const
{
  typename Mesh::CFVIter           fv_it = mesh_.cfv_iter(_fh);
  const Point&                     p0    = mesh_.point(fv_it);
  const Point&                     p1    = mesh_.point(++fv_it);
  const Point&                     p2    = mesh_.point(++fv_it);

  const Points&                    points = mesh_.property(points_, _fh);
  typename Points::const_iterator  p_it   = points.begin();
  typename Points::const_iterator  p_end  = points.end();

  Point  dummy;
  Scalar e;
376 377
  Scalar emax =  distPointTriangleSquared(_p, p0, p1, p2);

378

Jan Möbius's avatar
Jan Möbius committed
379

Jan Möbius's avatar
Jan Möbius committed
380
  for (; p_it!=p_end; ++p_it) {
381
    e =  distPointTriangleSquared(*p_it, p0, p1, p2);
Jan Möbius's avatar
Jan Möbius committed
382 383 384 385 386 387 388 389 390 391 392 393
    if (e > emax)
      emax = e;
  }

  return emax;
}


//=============================================================================
}
}
//=============================================================================