/*//////////////////////////////////////////////////////////////////////////////
// CMT Cosmic Muon Tomography project //////////////////////////////////////////
////////////////////////////////////////////////////////////////////////////////

  Copyright (c) 2014, Universita' degli Studi di Padova, INFN sez. di Padova
  All rights reserved

  Authors: Andrea Rigoni Garola < andrea.rigoni@pd.infn.it >

  ------------------------------------------------------------------
  This library is free software;  you  can  redistribute  it  and/or
  modify it  under the  terms  of  the  GNU  Lesser  General  Public
  License as published  by  the  Free  Software  Foundation;  either
  version 3.0 of the License, or (at your option) any later version.

  This library is  distributed in  the hope that it will  be useful,
  but  WITHOUT ANY WARRANTY;  without  even  the implied warranty of
  MERCHANTABILITY  or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  Lesser General Public License for more details.

  You should have received a copy of  the GNU Lesser General  Public
  License along with this library.

//////////////////////////////////////////////////////////////////////////////*/

#ifdef HAVE_CONFIG_H
#include "config.h"
#endif

#include <vtkSmartPointer.h>

#include <vtkOBJReader.h>
#include <vtkPolyDataReader.h>
#include <vtkSTLReader.h>
#include <vtkXMLPolyDataReader.h>

#include <vtkActor.h>
#include <vtkCellArray.h>
#include <vtkPoints.h>
#include <vtkPolyData.h>
#include <vtkPolyDataMapper.h>

#include <vtkMatrix4x4.h>
#include <vtkNew.h>
#include "Vtk/Math/vtkDense.h"
#include "Vtk/Math/vtkTriangleMesh.h"
#include <iostream>

namespace uLib {
namespace Vtk {

void TriangleMesh::vtk2uLib_update() {
  vtkIdType number_of_points = m_Poly->GetNumberOfPoints();
  vtkIdType number_of_triangles = m_Poly->GetNumberOfPolys();

  std::cout << "//////\n"
            << "number of points = " << number_of_points << "\n"
            << "number of polys  = " << number_of_triangles << "\n"
            << "//////\n";

  this->m_model->Points().clear();
  for (int i = 0; i < number_of_points; ++i) {
    double *point = m_Poly->GetPoint(i);
    this->m_model->Points().push_back(Vector3f(point[0], point[1], point[2]));
  }

  this->m_model->Triangles().resize(number_of_triangles);
  m_Poly->GetPolys()->InitTraversal();
  vtkSmartPointer<vtkIdList> idList = vtkSmartPointer<vtkIdList>::New();
  for (int i = 0; i < number_of_triangles; ++i) {
    m_Poly->GetPolys()->GetNextCell(idList);
    this->m_model->Triangles()[i](0) = idList->GetId(0);
    this->m_model->Triangles()[i](1) = idList->GetId(1);
    this->m_model->Triangles()[i](2) = idList->GetId(2);
  }
  m_Poly->Modified();
  m_Actor->GetMapper()->Update();
}

void TriangleMesh::uLib2vtk_update() {
  vtkIdType number_of_points = this->m_model->Points().size();
  vtkIdType number_of_triangles = this->m_model->Triangles().size();

  vtkSmartPointer<vtkPoints> points = vtkSmartPointer<vtkPoints>::New();
  points->SetNumberOfPoints(number_of_points);
  for (vtkIdType i = 0; i < number_of_points; i++) {
    Vector3f p = this->m_model->Points().at(i);
    points->SetPoint(i, p(0), p(1), p(2));
  }

  vtkSmartPointer<vtkCellArray> polys = vtkSmartPointer<vtkCellArray>::New();
  for (vtkIdType i = 0; i < number_of_triangles; i++) {
    vtkIdType a, b, c;
    a = this->m_model->Triangles().at(i)(0);
    b = this->m_model->Triangles().at(i)(1);
    c = this->m_model->Triangles().at(i)(2);
    polys->InsertNextCell(3);
    polys->InsertCellPoint(a);
    polys->InsertCellPoint(b);
    polys->InsertCellPoint(c);
  }

  m_Poly->SetPoints(points);
  m_Poly->SetPolys(polys);
  m_Poly->Modified();
}

void TriangleMesh::contentUpdate() {
  vtkMatrix4x4 *vmat = m_Actor->GetUserMatrix();
  if (!vmat) {
    vtkNew<vtkMatrix4x4> mat;
    m_Actor->SetUserMatrix(mat);
    vmat = mat;
  }

  Matrix4f transform = this->m_model->GetWorldMatrix();
  Matrix4fToVtk(transform, vmat);

  uLib2vtk_update();

  m_Poly->Modified();
  m_Actor->GetMapper()->Update();
  Prop3D::Update();
}

void TriangleMesh::Update() {
  vtkMatrix4x4 *vmat = m_Actor->GetUserMatrix();
  if (!vmat) return;

  Matrix4f transform = VtkToMatrix4f(vmat);
  this->m_model->SetMatrix(transform);
  this->m_model->Updated();
}

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

TriangleMesh::TriangleMesh(TriangleMesh::Content *content)
    : ObjectWrapper(content), m_Poly(vtkPolyData::New()), m_Actor(vtkActor::New()) {
  vtkSmartPointer<vtkPolyDataMapper> mapper =
      vtkSmartPointer<vtkPolyDataMapper>::New();
  mapper->SetInputData(m_Poly);
  m_Actor->SetMapper(mapper);

  vtkNew<vtkMatrix4x4> vmat;
  Matrix4fToVtk(this->m_model->GetWorldMatrix(), vmat);
  m_Actor->SetUserMatrix(vmat);

  this->SetProp(m_Actor);
  Object::connect(this->m_model.get(), &Content::Updated, this, &TriangleMesh::contentUpdate);
  this->contentUpdate();
}

TriangleMesh::~TriangleMesh() {
  Object::disconnect(this->m_model.get(), &Content::Updated, this, &TriangleMesh::contentUpdate);
  m_Poly->Delete();
  m_Actor->Delete();
}

void TriangleMesh::ReadFromFile(const char *filename) {
  vtkSmartPointer<vtkPolyDataReader> reader =
      vtkSmartPointer<vtkPolyDataReader>::New();
  reader->SetFileName(filename);
  reader->Update();
  m_Poly->DeepCopy(reader->GetOutput());
  vtk2uLib_update();
}

void TriangleMesh::ReadFromXMLFile(const char *filename) {
  vtkSmartPointer<vtkXMLPolyDataReader> reader =
      vtkSmartPointer<vtkXMLPolyDataReader>::New();
  reader->SetFileName(filename);
  reader->Update();
  m_Poly->DeepCopy(reader->GetOutput());
  vtk2uLib_update();
}

void TriangleMesh::ReadFromObjFile(const char *filename) {
  vtkSmartPointer<vtkOBJReader> reader = vtkSmartPointer<vtkOBJReader>::New();
  reader->SetFileName(filename);
  reader->Update();
  m_Poly->DeepCopy(reader->GetOutput());
  vtk2uLib_update();
}

void TriangleMesh::ReadFromStlFile(const char *filename) {
  vtkSmartPointer<vtkSTLReader> reader = vtkSmartPointer<vtkSTLReader>::New();
  reader->SetFileName(filename);
  reader->Update();
  m_Poly->DeepCopy(reader->GetOutput());
  vtk2uLib_update();
}

vtkPolyData *TriangleMesh::GetPolyData() const { return m_Poly; }

} // namespace Vtk
} // namespace uLib