//=============================================================================
// Copyright (c) Kitware, Inc.
// All rights reserved.
// See LICENSE.txt for details.
//
// This software is distributed WITHOUT ANY WARRANTY; without even
// the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR
// PURPOSE.  See the above copyright notice for more information.
//=============================================================================
#include "smtk/session/polygon/internal/Vertex.h"
#include "smtk/session/polygon/Session.h"
#include "smtk/session/polygon/internal/Model.h"

#include "smtk/io/Logger.h"

#include "smtk/common/CompilerInformation.h"

SMTK_THIRDPARTY_PRE_INCLUDE
#include "boost/polygon/polygon.hpp"
SMTK_THIRDPARTY_POST_INCLUDE

namespace smtk
{
namespace session
{
namespace polygon
{
namespace internal
{

/**\brief Return true if the edge can be inserted.
  *
  * FIXME: This will have precision issues with small angles because
  *        sqrt() is not calculated with intervals and overflow may
  *        occur when edge neighbor-points are far from each other.
  */
bool vertex::canInsertEdge(const Point& neighborhood, incident_edges::iterator* where)
{
  // Early termination... 0 or 1 existing vertices are always in CCW order no
  // matter where we insert
  if (m_edges.size() < 2)
  {
    // Are we busy splitting an edge?
    // If so, an edge has been removed from this vertex and
    // will be replaced by the new edge. Don't panic if it looks
    // like a face will be split.
    // If not...
    if (!m_insideSplit)
    {
      // A vertex with 1 incident edge that is part of a face has face completely
      // surrounding the vertex; it will never be valid to insert another edge
      // there without removing the face first.
      if (!m_edges.empty() && m_edges.front().m_adjacentFace)
        return false;
    }

    // Otherwise, it is always valid to insert a new edge anywhere.
    if (where)
      *where = m_edges.begin();
    return true;
  }

  pmodel* model = this->parentAs<pmodel>();
  Point pt(neighborhood.x() - m_coords.x(), neighborhood.y() - m_coords.y());

  Point prevPt(model->edgeTestPoint(m_edges.back().m_edgeId, !m_edges.back().m_edgeOut));
  Point pa(prevPt.x() - m_coords.x(), prevPt.y() - m_coords.y());
  incident_edges::iterator it;
  for (it = m_edges.begin(); it != m_edges.end(); ++it)
  {
    Point currPt = model->edgeTestPoint(it->m_edgeId, !it->m_edgeOut);
    Point pb(currPt.x() - m_coords.x(), currPt.y() - m_coords.y());

    // Test whether "t" is in the CCW range between "a" and "b":
    // (Done using signs of cross-products to check angle relationships.)
    HighPrecisionCoord axb =
      HighPrecisionCoord(pa.x()) * pb.y() - HighPrecisionCoord(pb.x()) * pa.y();
    HighPrecisionCoord axt =
      HighPrecisionCoord(pa.x()) * pt.y() - HighPrecisionCoord(pt.x()) * pa.y();
    HighPrecisionCoord txb =
      HighPrecisionCoord(pt.x()) * pb.y() - HighPrecisionCoord(pb.x()) * pt.y();
    bool inside =
      (axb > 0 && axt > 0 && txb > 0) || // A->B < 180 degrees => A->T and T->B also < 180 degrees
      (axb < 0 &&
        !(axt < 0 &&
          txb < 0)) || // A->B > 180 degrees => if B->T and T->A < 180 degrees, T outside A->B
      (axb == 0 && axt < 0 && txb < 0); // A->B = 180 degrees => A->T and T->B also < 180 degrees

    if (inside)
    {
      if (!it->m_adjacentFace || m_insideSplit)
      { // There is no face; it's OK to add the edge here.
        if (where)
          *where = it;
        return true;
      }
      else
      {
        smtkErrorMacro(model->session()->log(), "Edge would split face " << it->m_adjacentFace);
        return false;
      }
    }
    else if (axt == 0)
    {
      // check if t and a are collinear and on the opposite sides
      if (pa.x() != 0 && HighPrecisionCoord(pt.x() / pa.x()) < 0)
      {
        if (where)
          *where = it;
        return true;
      }
      else if (pa.y() != 0 && HighPrecisionCoord(pt.y() / pa.y()) < 0)
      {
        if (where)
          *where = it;
        return true;
      }
    }
    else if (txb == 0)
    {
      // check if t and b are collinear and on the opposite sides
      if (pb.x() != 0 && HighPrecisionCoord(pt.x() / pb.x()) < 0)
      {
        if (where)
          *where = it;
        return true;
      }
      else if (pb.y() != 0 && HighPrecisionCoord(pt.y() / pb.y()) < 0)
      {
        if (where)
          *where = it;
        return true;
      }
    }
    pa = pb;
  }
  smtkErrorMacro(model->session()->log(), "Overlapping collinear edges");
  return false;
}

/**\brief Insert the edge \a where told (by canInsertEdge).
  *
  * \a edgeOutwards indicates whether the forward-direction edge
  * is outward or inward-pointing (from/to this vertex).
  */
vertex::incident_edges::iterator vertex::insertEdgeAt(
  incident_edges::iterator where, const Id& edgeId, bool edgeOutwards)
{
  incident_edge_data edgeData;
  edgeData.m_edgeId = edgeId;
  edgeData.m_edgeOut = edgeOutwards;
  // NB: Not inserting edge where a face exists, so edgeData.m_adjacentFace should be left NULL.
  return m_edges.insert(where, edgeData);
}

/**\brief Insert the edge \a where told (by canInsertEdge).
  *
  * \a edgeOutwards indicates whether the forward-direction edge
  * is outward or inward-pointing (from/to this vertex).
  * \a faceId is the UUID of the face immediately **clockwise (CW)** of this edge relative to the vertex.
  */
vertex::incident_edges::iterator vertex::insertEdgeAt(
  incident_edges::iterator where, const Id& edgeId, bool edgeOutwards, const Id& faceId)
{
  incident_edge_data edgeData;
  edgeData.m_edgeId = edgeId;
  edgeData.m_edgeOut = edgeOutwards;
  edgeData.m_adjacentFace = faceId;
  return m_edges.insert(where, edgeData);
}

/**\brief Remove the edge incidence record at the given position.
  *
  * This does not perform any updates to other incidence records.
  */
void vertex::removeEdgeAt(incident_edges::iterator where)
{
  m_edges.erase(where);
}

bool vertex::setFaceAdjacency(
  const Id& incidentEdge, const Id& adjacentFace, bool isCCW, int edgeDir)
{
  incident_edges::iterator it;
  for (it = m_edges.begin(); it != m_edges.end(); ++it)
  {
    // This conditional is complex because we must handle the case when
    // an edge has both endpoints into the same vertex:
    if (it->edgeId() == incidentEdge &&
      (                   // The edge ID matches and either:
          edgeDir == 0 || // we don't care about edge direction or
          (edgeDir != 0 &&
            (edgeDir > 0) ==
              it->isEdgeOutgoing()) // the edge direction also matches (i.e., head at vertex)
          ))
    {
      if (isCCW)
      {
        ++it;
        if (it == this->edgesEnd())
        {
          it = this->edgesBegin();
        }
        it->m_adjacentFace = adjacentFace;
      }
      else
      {
        it->m_adjacentFace = adjacentFace;
      }
      this->dump();
      return true;
    }
  }
  this->dump();
  return false;
}

/**\brief Remove all references to \a face from this vertex.
  *
  * Note that this always loops through every edge-incidence record
  * since a face may have any arbitrary number of edges incoming to
  * the same vertex. The same edge may be incident once or twice.
  *
  * The number of edge-incidences marked as having \a face just
  * clockwise (relative to the vertex) is returned.
  */
int vertex::removeFaceAdjacencies(const Id& face)
{
  int numIncidents = 0;
  incident_edges::iterator it;
  for (it = m_edges.begin(); it != m_edges.end(); ++it)
  {
    if (it->m_adjacentFace == face)
    {
      it->m_adjacentFace = Id();
      ++numIncidents;
    }
  }
  return numIncidents;
}

/**\brief Remove all references to \a edge from this vertex.
  *
  * Note that this always loops through every edge-incidence record
  * since an edge may be incident to the same vertex at both its ends.
  *
  * The number of incidences featuring \a edge is returned.
  */
int vertex::removeIncidentEdge(const Id& edge)
{
  int numIncidences = 0;
  if (m_edges.empty())
  {
    return numIncidences;
  }

  incident_edges::iterator it;
  incident_edges::iterator tmp = m_edges.begin();
  do
  {
    it = tmp;
    ++it;
    if (tmp->m_edgeId == edge)
    {
      ++numIncidences;
      m_edges.erase(tmp);
    }
    tmp = it;
  } while (tmp != m_edges.end());
  return numIncidences;
}

void vertex::dump()
{
  std::cout << "    Vertex " << this->id() << "   (" << this->point().x() << " "
            << this->point().y() << ")"
            << "\n";
  for (incident_edges::iterator it = this->edgesBegin(); it != edgesEnd(); ++it)
  {
    std::cout << "      e: " << it->edgeId() << " " << (it->isEdgeOutgoing() ? "O" : "I")
              << "      f: " << it->clockwiseFaceId() << "\n";
  }
}

} // namespace internal
} // namespace polygon
} // namespace session
} // namespace smtk
