AlignT.cc

/*===========================================================================*\
*                                                                            *
*                              OpenFlipper                                   *
 *           Copyright (c) 2001-2015, RWTH-Aachen University                 *
 *           Department of Computer Graphics and Multimedia                  *
 *                          All rights reserved.                             *
 *                            www.openflipper.org                            *
 *                                                                           *
 *---------------------------------------------------------------------------*
 * This file is part of OpenFlipper.                                         *
 *---------------------------------------------------------------------------*
 *                                                                           *
 * 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.              *
*                                                                            *
\*===========================================================================*/


#include <Eigen/Dense>

namespace align{


template< class MeshT >
void moveToCOG(MeshT& _mesh) {

  ACG::Vec3d mean(0.0);
  for (typename MeshT::VertexIter v_it = _mesh.vertices_begin(); v_it != _mesh.vertices_end(); ++v_it) {
    mean += _mesh.point(*v_it);
  }

  mean /= (double)_mesh.n_vertices();

  for (TriMesh::VertexIter v_it = _mesh.vertices_begin(); v_it != _mesh.vertices_end(); ++v_it) {
    _mesh.set_point(*v_it, _mesh.point(*v_it) - mean);
  }
}


template< class MeshT >
void rotate(MeshT& _mesh) {
  using namespace Eigen;

  Matrix3Xd data = Matrix3Xd::Zero(3, _mesh.n_vertices());
  size_t i(0);
  for (typename MeshT::VertexIter v_it = _mesh.vertices_begin(); v_it != _mesh.vertices_end(); ++v_it, ++i) {
    const ACG::Vec3d tmp = _mesh.point(*v_it);
    data.col(i) = Vector3d(tmp[0], tmp[1], tmp[2]);
  }

  Matrix3d covar = (data * data.transpose()) / (double)_mesh.n_vertices();

  JacobiSVD<Matrix3d> svd(covar, ComputeFullU | ComputeFullV);

  const Matrix3d& u = svd.matrixU();

  Eigen::Vector3d v0 = u.col(0);
  Eigen::Vector3d v1 = u.col(1);
  Eigen::Vector3d v2 = v0.cross(v1);

  v0.normalize();
  v1.normalize();
  v2.normalize();

  Matrix3d trans;
  trans.col(0) = v0;
  trans.col(1) = v1;
  trans.col(2) = v2;

  Matrix3d invTrans = trans.inverse();

  ACG::Matrix4x4d mat;
  mat.identity();
  for (i = 0; i < 3; ++i) {
    for (size_t j = 0; j < 3; ++j) {
      mat(i,j) = invTrans(i,j);
    }
  }

  for (typename MeshT::VertexIter v_it = _mesh.vertices_begin(); v_it != _mesh.vertices_end(); ++v_it, ++i) {
    const ACG::Vec4d tmp(_mesh.point(*v_it)[0], _mesh.point(*v_it)[1], _mesh.point(*v_it)[2], 1.0);
    const ACG::Vec4d res = mat * tmp;

    _mesh.set_point(*v_it, ACG::Vec3d(res[0], res[1],res[2]));
  }
}

template< class MeshT >
void moveCenterOfBBToOrigin(MeshT& _mesh) {

  ACG::Vec3d min(DBL_MAX);
  ACG::Vec3d max(-DBL_MAX);
  for (typename MeshT::VertexIter v_it = _mesh.vertices_begin(); v_it != _mesh.vertices_end(); ++v_it) {
    min.minimize(_mesh.point(*v_it));
    max.maximize(_mesh.point(*v_it));
  }

  const ACG::Vec3d diag = max - min;
  const ACG::Vec3d center = min + 0.5*diag;

  for (typename MeshT::VertexIter v_it = _mesh.vertices_begin(); v_it != _mesh.vertices_end(); ++v_it) {
    _mesh.point(*v_it) -= center;
  }
}

} // namespace align

#define ALIGNT_CC