// Gmsh - Copyright (C) 1997-2019 C. Geuzaine, J.-F. Remacle
//
// See the LICENSE.txt file for license information. Please report all
// issues on https://gitlab.onelab.info/gmsh/gmsh/issues.

#include <limits>
#include <set>
#include <map>
#include <algorithm>
#include "GmshConfig.h"
#include "GmshMessage.h"
#include "OS.h"
#include "robustPredicates.h"
#include "BackgroundMesh.h"
#include "meshGFaceDelaunayInsertion.h"
#include "meshGFaceOptimize.h"
#include "meshGFace.h"
#include "GModel.h"
#include "GFace.h"
#include "Numeric.h"
#include "STensor3.h"
#include "Context.h"
#include "discreteFace.h"
#include "intersectCurveSurface.h"
#include "HilbertCurve.h"

#if defined(HAVE_DOMHEX)
#include "pointInsertion.h"
#include "surfaceFiller.h"
#endif

static double LIMIT_ = 0.5 * std::sqrt(2.0) * 1;
int MTri3::radiusNorm = 2;

static void getDegeneratedVertices(GFace *gf, std::set<GEntity*> & degenerated)
{
  degenerated.clear();
  const std::vector<GEdge *> &ed = gf->edges();
  for (size_t i=0;i<ed.size();i++){
    GEdge *e = ed[i];
    if (e->getBeginVertex() == e->getEndVertex()){
      if (e->geomType() == GEntity::Unknown){
	degenerated.insert (e->getBeginVertex());
      }
    }
  }
}

static inline bool intersection_segments_2(double *p1, double *p2, double *q1,
                                           double *q2)
{
  double a = robustPredicates::orient2d(p1, p2, q1);
  double b = robustPredicates::orient2d(p1, p2, q2);
  if(a * b > 0) return 0;
  a = robustPredicates::orient2d(q1, q2, p1);
  b = robustPredicates::orient2d(q1, q2, p2);
  if(a * b > 0) return 0;
  return 1;
}

template <class ITERATOR>
void _printTris(char *name, ITERATOR it, ITERATOR end, bidimMeshData *data,
                GFace *gf = NULL, std::set<GEntity*> *degenerated = NULL)
{
  FILE *ff = Fopen(name, "w");
  if(!ff) {
    Msg::Error("Could not open file '%s'", name);
    return;
  }
  fprintf(ff, "View\"test\"{\n");

  if (data && gf && degenerated){
    const int N = 100;
    while(it != end) {
      MTri3 *worst = *it;
      if(!worst->isDeleted()) {
	for (int i=0;i<3;i++){
	  int whatever =
	    (degenerated -> find ( (worst)->tri()->getVertex(i)->onWhat() ) !=
             degenerated->end())
	    + (degenerated -> find ( (worst)->tri()->getVertex((i+1)%3)->onWhat() ) !=
               degenerated->end());
	  if (whatever == 1){
	    double u1 = data->Us[data->getIndex((worst)->tri()->getVertex(i))];
	    double u2 = data->Us[data->getIndex((worst)->tri()->getVertex((i+1)%3))];
	    double v1 = data->Vs[data->getIndex((worst)->tri()->getVertex(i))];
	    double v2 = data->Vs[data->getIndex((worst)->tri()->getVertex((i+1)%3))];
	    GPoint p_prec;
	    for (int j=0;j<N;j++){
	      double t = (double) j / (N-1);
	      double u = u1 + t * (u2-u1);
	      double v = v1 + t * (v2-v1);
	      GPoint p = gf->point(SPoint2(u,v));
	      if (j){
		fprintf(ff,"SL(%g,%g,%g,%g,%g,%g){1,1};\n",p_prec.x(),p_prec.y(),p_prec.z(),
			p.x(),p.y(),p.z());
	      }
	      p_prec = p;
	    }
	  }
	}
      }
      ++it;
    }
  }
  else {
    while(it != end) {
      MTri3 *worst = *it;
      if(!worst->isDeleted()) {
	if(data) {
          double u1 = data->Us[data->getIndex((worst)->tri()->getVertex(0))];
          double v1 = data->Vs[data->getIndex((worst)->tri()->getVertex(0))];
          double u2 = data->Us[data->getIndex((worst)->tri()->getVertex(1))];
          double v2 = data->Vs[data->getIndex((worst)->tri()->getVertex(1))];
          double u3 = data->Us[data->getIndex((worst)->tri()->getVertex(2))];
          double v3 = data->Vs[data->getIndex((worst)->tri()->getVertex(2))];

          if (degenerated){
            bool deg[3];
            deg[0] = degenerated -> find ( (worst)->tri()->getVertex(0)->onWhat() ) !=
              degenerated->end();
            deg[1] = degenerated -> find ( (worst)->tri()->getVertex(1)->onWhat() ) !=
              degenerated->end();
            deg[2] = degenerated -> find ( (worst)->tri()->getVertex(2)->onWhat() ) !=
              degenerated->end();
            if (deg[0] && !deg[1] && !deg[2]){
              fprintf(ff, "SQ(%g,%g,%g,%g,%g,%g,%g,%g,%g,%g,%g,%g) {%d,%d,%d,%d};\n",
                      u3,v1,0.,u2,v1,0.,u2,v2,0.,u3,v3,0.,
                      (worst)->tri()->getVertex(0)->getNum(),
                      (worst)->tri()->getVertex(0)->getNum(),
                      (worst)->tri()->getVertex(1)->getNum(),
                      (worst)->tri()->getVertex(2)->getNum());
            }
            else if (!deg[0] && deg[1] && !deg[2]){
              fprintf(ff, "SQ(%g,%g,%g,%g,%g,%g,%g,%g,%g,%g,%g,%g) {%d,%d,%d,%d};\n",
                      u1,v2,0.,u3,v2,0.,u3,v3,0.,u1,v1,0.,
                      (worst)->tri()->getVertex(1)->getNum(),
                      (worst)->tri()->getVertex(1)->getNum(),
                      (worst)->tri()->getVertex(2)->getNum(),
                      (worst)->tri()->getVertex(0)->getNum());
            }
            else if (!deg[0] && !deg[1] && deg[2]){
              fprintf(ff, "SQ(%g,%g,%g,%g,%g,%g,%g,%g,%g,%g,%g,%g) {%d,%d,%d,%d};\n",
                      u2,v3,0.,u1,v3,0.,u1,v1,0.,u2,v2,0.,
                      (worst)->tri()->getVertex(2)->getNum(),
                      (worst)->tri()->getVertex(2)->getNum(),
                      (worst)->tri()->getVertex(0)->getNum(),
                      (worst)->tri()->getVertex(1)->getNum());
            }
            else if (!deg[0] && !deg[1] && !deg[2]){
              fprintf(ff, "ST(%g,%g,%g,%g,%g,%g,%g,%g,%g) {%d,%d,%d};\n",
                      u1,v1,0.,u2,v2,0.,u3,v3,0.,
                      (worst)->tri()->getVertex(0)->getNum(),
                      (worst)->tri()->getVertex(1)->getNum(),
                      (worst)->tri()->getVertex(2)->getNum());
            }
          }
          else {
            fprintf(ff, "ST(%g,%g,%g,%g,%g,%g,%g,%g,%g) {%d,%d,%d};\n",
                    u1,v1,0.,u2,v2,0.,u3,v3,0.,
                    (worst)->tri()->getVertex(0)->getNum(),
                    (worst)->tri()->getVertex(1)->getNum(),
                    (worst)->tri()->getVertex(2)->getNum());
          }
        }
	else
	  fprintf(ff, "ST(%g,%g,%g,%g,%g,%g,%g,%g,%g) {%d,%d,%d};\n",
		  (worst)->tri()->getVertex(0)->x(), (worst)->tri()->getVertex(0)->y(),
		  (worst)->tri()->getVertex(0)->z(), (worst)->tri()->getVertex(1)->x(),
		  (worst)->tri()->getVertex(1)->y(), (worst)->tri()->getVertex(1)->z(),
		  (worst)->tri()->getVertex(2)->x(), (worst)->tri()->getVertex(2)->y(),
		  (worst)->tri()->getVertex(2)->z(),
		  (worst)->tri()->getVertex(0)->getNum(),
		  (worst)->tri()->getVertex(1)->getNum(),
		  (worst)->tri()->getVertex(2)->getNum());
      }
      ++it;
    }
  }
  fprintf(ff, "};\n");
  fclose(ff);
}

static bool isActive(MTri3 *t, double limit_, int &active)
{
  if(t->isDeleted()) return false;
  for(active = 0; active < 3; active++) {
    MTri3 *neigh = t->getNeigh(active);
    if(!neigh || (neigh->getRadius() < limit_ && neigh->getRadius() > 0)) {
      // int ip1 = active - 1 < 0 ? 2 : active - 1;
      // int ip2 = active;
      // if(distance(t->tri()->getVertex(ip1), t->tri()->getVertex(ip2)) > 1.e-12)
      return true;
    }
  }
  return false;
}

static bool isActive(MTri3 *t, double limit_, int &i,
                     std::set<MEdge, Less_Edge> *front)
{
  if(t->isDeleted()) return false;
  for(i = 0; i < 3; i++) {
    MTri3 *neigh = t->getNeigh(i);
    if(!neigh || (neigh->getRadius() < limit_ && neigh->getRadius() > 0)) {
      int ip1 = i - 1 < 0 ? 2 : i - 1;
      int ip2 = i;
      MEdge me(t->tri()->getVertex(ip1), t->tri()->getVertex(ip2));
      if(front->find(me) != front->end()) {
        return true;
      }
    }
  }
  return false;
}

static void updateActiveEdges(MTri3 *t, double limit_,
                              std::set<MEdge, Less_Edge> &front)
{
  if(t->isDeleted()) return;
  for(int active = 0; active < 3; active++) {
    MTri3 *neigh = t->getNeigh(active);
    if(!neigh || (neigh->getRadius() < limit_ && neigh->getRadius() > 0)) {
      int ip1 = active - 1 < 0 ? 2 : active - 1;
      int ip2 = active;
      MEdge me(t->tri()->getVertex(ip1), t->tri()->getVertex(ip2));
      front.insert(me);
    }
  }
}

static void circumCenterMetric(double *pa, double *pb, double *pc,
                               const double *metric, double *x, double &Radius2)
{
  // d = (u2-u1) M (u2-u1) = u2 M u2 + u1 M u1 - 2 u2 M u1
  double sys[2][2];
  double rhs[2];

  const double a = metric[0];
  const double b = metric[1];
  const double d = metric[2];

  sys[0][0] = 2. * a * (pa[0] - pb[0]) + 2. * b * (pa[1] - pb[1]);
  sys[0][1] = 2. * d * (pa[1] - pb[1]) + 2. * b * (pa[0] - pb[0]);
  sys[1][0] = 2. * a * (pa[0] - pc[0]) + 2. * b * (pa[1] - pc[1]);
  sys[1][1] = 2. * d * (pa[1] - pc[1]) + 2. * b * (pa[0] - pc[0]);

  rhs[0] = a * (pa[0] * pa[0] - pb[0] * pb[0]) +
           d * (pa[1] * pa[1] - pb[1] * pb[1]) +
           2. * b * (pa[0] * pa[1] - pb[0] * pb[1]);
  rhs[1] = a * (pa[0] * pa[0] - pc[0] * pc[0]) +
           d * (pa[1] * pa[1] - pc[1] * pc[1]) +
           2. * b * (pa[0] * pa[1] - pc[0] * pc[1]);

  if(!sys2x2(sys, rhs, x)) {
    // printf("%g %g %g\n",a,b,d);
  }

  Radius2 = (x[0] - pa[0]) * (x[0] - pa[0]) * a +
            (x[1] - pa[1]) * (x[1] - pa[1]) * d +
            2. * (x[0] - pa[0]) * (x[1] - pa[1]) * b;
}

static void circumCenterMetricXYZ(double *p1, double *p2, double *p3,
                                  SMetric3 &metric,
                                  double *res, double *uv, double &radius)
{
  double v1[3] = {p2[0] - p1[0], p2[1] - p1[1], p2[2] - p1[2]};
  double v2[3] = {p3[0] - p1[0], p3[1] - p1[1], p3[2] - p1[2]};
  double vx[3] = {p2[0] - p1[0], p2[1] - p1[1], p2[2] - p1[2]};
  double vy[3] = {p3[0] - p1[0], p3[1] - p1[1], p3[2] - p1[2]};
  double vz[3];
  prodve(vx, vy, vz);
  prodve(vz, vx, vy);
  norme(vx);
  norme(vy);
  norme(vz);
  double p1P[2] = {0.0, 0.0};
  double p2P[2] = {prosca(v1, vx), prosca(v1, vy)};
  double p3P[2] = {prosca(v2, vx), prosca(v2, vy)};

  double resP[2];

  fullMatrix<double> T(3, 3);
  for(int i = 0; i < 3; i++) T(0, i) = vx[i];
  for(int i = 0; i < 3; i++) T(1, i) = vy[i];
  for(int i = 0; i < 3; i++) T(2, i) = vz[i];
  SMetric3 tra = metric.transform(T);
  double mm[3] = {tra(0, 0), tra(0, 1), tra(1, 1)};

  circumCenterMetric(p1P, p2P, p3P, mm, resP, radius);

  if(uv) {
    double mat[2][2] = {{p2P[0] - p1P[0], p3P[0] - p1P[0]},
                        {p2P[1] - p1P[1], p3P[1] - p1P[1]}};
    double rhs[2] = {resP[0] - p1P[0], resP[1] - p1P[1]};
    sys2x2(mat, rhs, uv);
  }

  res[0] = p1[0] + resP[0] * vx[0] + resP[1] * vy[0];
  res[1] = p1[1] + resP[0] * vx[1] + resP[1] * vy[1];
  res[2] = p1[2] + resP[0] * vx[2] + resP[1] * vy[2];
}

static void circumCenterMetric(MTriangle *base, const double *metric,
                               bidimMeshData &data, double *x, double &Radius2)
{
  // d = (u2-u1) M (u2-u1) = u2 M u2 + u1 M u1 - 2 u2 M u1
  int index0 = data.getIndex(base->getVertex(0));
  int index1 = data.getIndex(base->getVertex(1));
  int index2 = data.getIndex(base->getVertex(2));
  double pa[2] = {data.Us[index0], data.Vs[index0]};
  double pb[2] = {data.Us[index1], data.Vs[index1]};
  double pc[2] = {data.Us[index2], data.Vs[index2]};
  circumCenterMetric(pa, pb, pc, metric, x, Radius2);
}

void buildMetric(GFace *gf, double *uv, double *metric)
{
  Pair<SVector3, SVector3> der = gf->firstDer(SPoint2(uv[0], uv[1]));

  metric[0] = dot(der.first(), der.first());
  metric[1] = dot(der.second(), der.first());
  metric[2] = dot(der.second(), der.second());
}

static double computeTolerance(const double radius)
{
  if(radius <= 1e3) return 1e-12;
  if(radius <= 1e5) return 1e-11;
  return 1e-9;
}

int inCircumCircleAniso(GFace *gf, double *p1, double *p2, double *p3,
                        double *uv, double *metric)
{
  double x[2], Radius2;
  circumCenterMetric(p1, p2, p3, metric, x, Radius2);
  const double a = metric[0];
  const double b = metric[1];
  const double d = metric[2];
  const double d0 = (x[0] - uv[0]);
  const double d1 = (x[1] - uv[1]);
  const double d3 = d0 * d0 * a + d1 * d1 * d + 2.0 * d0 * d1 * b;
  const double tolerance = computeTolerance(Radius2);
  return d3 < Radius2 - tolerance;
}

int inCircumCircleAniso(GFace *gf, MTriangle *base, const double *uv,
                        const double *metricb, bidimMeshData &data)
{
  SPoint3 c;
  double x[2], Radius2;
  double metric[3];
  if(!metricb) {
    int index0 = data.getIndex(base->getVertex(0));
    int index1 = data.getIndex(base->getVertex(1));
    int index2 = data.getIndex(base->getVertex(2));
    double pa[2] = {(data.Us[index0] + data.Us[index1] + data.Us[index2]) / 3.,
                    (data.Vs[index0] + data.Vs[index1] + data.Vs[index2]) / 3.};
    buildMetric(gf, pa, metric);
  }
  else {
    metric[0] = metricb[0];
    metric[1] = metricb[1];
    metric[2] = metricb[2];
  };
  circumCenterMetric(base, metric, data, x, Radius2);

  const double a = metric[0];
  const double b = metric[1];
  const double d = metric[2];

  const double d0 = (x[0] - uv[0]);
  const double d1 = (x[1] - uv[1]);
  const double d3 = d0 * d0 * a + d1 * d1 * d + 2.0 * d0 * d1 * b;
  return d3 < Radius2;
}

MTri3::MTri3(MTriangle *t, double lc, SMetric3 *metric, bidimMeshData *data,
             GFace *gf)
  : deleted(false), base(t)
{
  neigh[0] = neigh[1] = neigh[2] = 0;
  double center[3];
  double pa[3] = {base->getVertex(0)->x(), base->getVertex(0)->y(),
                  base->getVertex(0)->z()};
  double pb[3] = {base->getVertex(1)->x(), base->getVertex(1)->y(),
                  base->getVertex(1)->z()};
  double pc[3] = {base->getVertex(2)->x(), base->getVertex(2)->y(),
                  base->getVertex(2)->z()};

  if(!metric) {
    if(radiusNorm == 3) {
      circum_radius = 1. / base->gammaShapeMeasure();
    }
    else if(radiusNorm == 2) {
      circumCenterXYZ(pa, pb, pc, center);
      const double dx = base->getVertex(0)->x() - center[0];
      const double dy = base->getVertex(0)->y() - center[1];
      const double dz = base->getVertex(0)->z() - center[2];
      circum_radius = std::sqrt(dx * dx + dy * dy + dz * dz) / lc;
    }
    else {
      int const index0 = data->getIndex(base->getVertex(0));
      int const index1 = data->getIndex(base->getVertex(1));
      int const index2 = data->getIndex(base->getVertex(2));
      double const p1[2] = {data->Us[index0], data->Vs[index0]};
      double const p2[2] = {data->Us[index1], data->Vs[index1]};
      double const p3[2] = {data->Us[index2], data->Vs[index2]};

      double midpoint[2] = {(p1[0] + p2[0] + p3[0]) / 3.0,
                            (p1[1] + p2[1] + p3[1]) / 3.0};

      double quadAngle =
        backgroundMesh::current() ?
          backgroundMesh::current()->getAngle(midpoint[0], midpoint[1], 0) :
          0.0;

      double x0 = p1[0] * std::cos(quadAngle) + p1[1] * std::sin(quadAngle);
      double y0 = -p1[0] * std::sin(quadAngle) + p1[1] * std::cos(quadAngle);
      double x1 = p2[0] * std::cos(quadAngle) + p2[1] * std::sin(quadAngle);
      double y1 = -p2[0] * std::sin(quadAngle) + p2[1] * std::cos(quadAngle);
      double x2 = p3[0] * std::cos(quadAngle) + p3[1] * std::sin(quadAngle);
      double y2 = -p3[0] * std::sin(quadAngle) + p3[1] * std::cos(quadAngle);
      double xmax = std::max(std::max(x0, x1), x2);
      double ymax = std::max(std::max(y0, y1), y2);
      double xmin = std::min(std::min(x0, x1), x2);
      double ymin = std::min(std::min(y0, y1), y2);

      double metric[3];
      buildMetric(gf, midpoint, metric);
      double RATIO =
        std::pow(metric[0] * metric[2] - metric[1] * metric[1], -0.25);

      circum_radius = std::max(xmax - xmin, ymax - ymin) / (RATIO * lc);
    }
  }
  else {
    double uv[2];
    circumCenterMetricXYZ(pa, pb, pc, *metric, center, uv, circum_radius);
  }

  if(gf) {
    BoundaryLayerColumns *_columns = gf->getColumns();
    if(_columns) {
      if(_columns->_toFirst.find(t) != _columns->_toFirst.end()) {
        circum_radius = 0;
      }
    }
  }
}

int MTri3::inCircumCircle(const double *p) const
{
  double pa[3] = {base->getVertex(0)->x(), base->getVertex(0)->y(),
                  base->getVertex(0)->z()};
  double pb[3] = {base->getVertex(1)->x(), base->getVertex(1)->y(),
                  base->getVertex(1)->z()};
  double pc[3] = {base->getVertex(2)->x(), base->getVertex(2)->y(),
                  base->getVertex(2)->z()};
  double fourth[3];
  fourthPoint(pa, pb, pc, fourth);

  double result = robustPredicates::insphere(pa, pb, pc, fourth, (double *)p) *
                  robustPredicates::orient3d(pa, pb, pc, fourth);
  return (result > 0) ? 1 : 0;
}

int inCircumCircle(MTriangle *base, const double *p, const double *param,
                   bidimMeshData &data)
{
  int index0 = data.getIndex(base->getVertex(0));
  int index1 = data.getIndex(base->getVertex(1));
  int index2 = data.getIndex(base->getVertex(2));
  double pa[2] = {data.Us[index0], data.Vs[index0]};
  double pb[2] = {data.Us[index1], data.Vs[index1]};
  double pc[2] = {data.Us[index2], data.Vs[index2]};

  double result = robustPredicates::incircle(pa, pb, pc, (double *)param) *
                  robustPredicates::orient2d(pa, pb, pc);
  return (result > 0) ? 1 : 0;
}

template <class Iterator>
static void connectTris(Iterator beg, Iterator end, std::vector<edgeXface> &conn)
{
  conn.clear();

  while(beg != end) {
    if(!(*beg)->isDeleted()) {
      for(int j = 0; j < 3; j++) {
        conn.push_back(edgeXface(*beg, j));
      }
    }
    ++beg;
  }

  if(conn.empty()) return;

  std::sort(conn.begin(), conn.end());

  for(std::size_t i = 0; i < conn.size() - 1; i++) {
    edgeXface &f1 = conn[i];
    edgeXface &f2 = conn[i + 1];

    if(f1 == f2 && f1.t1 != f2.t1) {
      f1.t1->setNeigh(f1.i1, f2.t1);
      f2.t1->setNeigh(f2.i1, f1.t1);
      ++i;
    }
  }
}

void connectTriangles(std::list<MTri3 *> &l)
{
  std::vector<edgeXface> conn;
  connectTris(l.begin(), l.end(), conn);
}

void connectTriangles(std::vector<MTri3 *> &l)
{
  std::vector<edgeXface> conn;
  connectTris(l.begin(), l.end(), conn);
}

void connectTriangles(std::set<MTri3 *, compareTri3Ptr> &l)
{
  std::vector<edgeXface> conn;
  connectTris(l.begin(), l.end(), conn);
}

static int inCircumCircleXY(MTriangle *t, MVertex *v)
{
  MVertex *v1 = t->getVertex(0);
  MVertex *v2 = t->getVertex(1);
  MVertex *v3 = t->getVertex(2);
  double p1[2] = {v1->x(), v1->y()};
  double p2[2] = {v2->x(), v2->y()};
  double p3[2] = {v3->x(), v3->y()};
  double pp[2] = {v->x(), v->y()};
  double result = robustPredicates::incircle(p1, p2, p3, pp) *
                  robustPredicates::orient2d(p1, p2, p3);
  return (result > 0) ? 1 : 0;
}

static void recurFindCavity(std::vector<edgeXface> &shell,
                            std::vector<MTri3 *> &cavity, MVertex *v, MTri3 *t)
{
  t->setDeleted(true);
  // the cavity that has to be removed because it violates delaunay
  // criterion
  cavity.push_back(t);

  for(int i = 0; i < 3; i++) {
    MTri3 *neigh = t->getNeigh(i);
    if(!neigh)
      shell.push_back(edgeXface(t, i));
    else if(!neigh->isDeleted()) {
      int circ = inCircumCircleXY(neigh->tri(), v);
      if(circ)
        recurFindCavity(shell, cavity, v, neigh);
      else
        shell.push_back(edgeXface(t, i));
    }
  }
}

static void recurFindCavityAniso(GFace *gf, std::list<edgeXface> &shell,
                                 std::list<MTri3 *> &cavity, double *metric,
                                 double *param, MTri3 *t, bidimMeshData &data)
{
  t->setDeleted(true);
  // the cavity that has to be removed because it violates delaunay
  // criterion
  cavity.push_back(t);

  for(int i = 0; i < 3; i++) {
    MTri3 *neigh = t->getNeigh(i);
    edgeXface exf(t, i);
    // take care of untouchable internal edges
    std::set<MEdge, Less_Edge>::iterator it =
      data.internalEdges.find(MEdge(exf._v(0), exf._v(1)));
    if(!neigh || it != data.internalEdges.end())
      shell.push_back(exf);
    else if(!neigh->isDeleted()) {
      int circ = inCircumCircleAniso(gf, neigh->tri(), param, metric, data);
      if(circ)
        recurFindCavityAniso(gf, shell, cavity, metric, param, neigh, data);
      else
        shell.push_back(exf);
    }
  }
}

static bool circUV(MTriangle *t, bidimMeshData &data, double *res, GFace *gf)
{
  int index0 = data.getIndex(t->getVertex(0));
  int index1 = data.getIndex(t->getVertex(1));
  int index2 = data.getIndex(t->getVertex(2));
  double u1[3] = {data.Us[index0], data.Vs[index0], 0};
  double u2[3] = {data.Us[index1], data.Vs[index1], 0};
  double u3[3] = {data.Us[index2], data.Vs[index2], 0};
  circumCenterXY(u1, u2, u3, res);
  return true;
}

static bool invMapUV(MTriangle *t, double *p, bidimMeshData &data,
                     double *uv, double tol)
{
  double mat[2][2];
  double b[2];

  int index0 = data.getIndex(t->getVertex(0));
  int index1 = data.getIndex(t->getVertex(1));
  int index2 = data.getIndex(t->getVertex(2));

  double u0 = data.Us[index0];
  double v0 = data.Vs[index0];
  double u1 = data.Us[index1];
  double v1 = data.Vs[index1];
  double u2 = data.Us[index2];
  double v2 = data.Vs[index2];

  mat[0][0] = u1 - u0;
  mat[0][1] = u2 - u0;
  mat[1][0] = v1 - v0;
  mat[1][1] = v2 - v0;

  b[0] = p[0] - u0;
  b[1] = p[1] - v0;
  sys2x2(mat, b, uv);

  if(uv[0] >= -tol && uv[1] >= -tol && uv[0] <= 1. + tol && uv[1] <= 1. + tol &&
     1. - uv[0] - uv[1] > -tol) {
    return true;
  }
  return false;
}

inline double getSurfUV(MTriangle *t, bidimMeshData &data)
{
  int index0 = data.getIndex(t->getVertex(0));
  int index1 = data.getIndex(t->getVertex(1));
  int index2 = data.getIndex(t->getVertex(2));

  double u1 = data.Us[index0];
  double v1 = data.Vs[index0];
  double u2 = data.Us[index1];
  double v2 = data.Vs[index1];
  double u3 = data.Us[index2];
  double v3 = data.Vs[index2];

  const double vv1[2] = {u2 - u1, v2 - v1};
  const double vv2[2] = {u3 - u1, v3 - v1};
  double s = vv1[0] * vv2[1] - vv1[1] * vv2[0];
  return s * 0.5;
}

static int insertVertexB(std::list<edgeXface> &shell, std::list<MTri3 *> &cavity,
                         bool force, GFace *gf, MVertex *v, double *param, MTri3 *t,
                         std::set<MTri3 *, compareTri3Ptr> &allTets,
                         std::set<MTri3 *, compareTri3Ptr> *activeTets,
                         bidimMeshData &data, double *metric, MTri3 **oneNewTriangle,
                         bool verifyStarShapeness = true)
{
  if(cavity.size() == 1) return -1;

  if(shell.size() != cavity.size() + 2) return -2;

  double EPS = verifyStarShapeness ? 1.e-12 : 1.e12;

  std::vector<edgeXface> conn;

  // check that volume is conserved
  double newVolume = 0.0;
  double oldVolume = 0.0;
  double newMinQuality = 2.0;
  double oldMinQuality = 2.0;

  // TODO C++11 std::accumulate with lambda
  std::list<MTri3 *>::iterator ittet = cavity.begin();
  std::list<MTri3 *>::iterator ittete = cavity.end();
  while(ittet != ittete) {
    oldVolume += std::abs(getSurfUV((*ittet)->tri(), data));
    oldMinQuality = std::min(oldMinQuality, (*ittet)->tri()->gammaShapeMeasure());
    ++ittet;
  }

  MTri3 **newTris = new MTri3 *[shell.size()];

  std::vector<MTri3 *> new_cavity;

  int k = 0;

  std::list<edgeXface>::iterator it = shell.begin();

  bool onePointIsTooClose = false;
  double lcMin = std::numeric_limits<double>::infinity();
  double lcBGMMin = std::numeric_limits<double>::infinity();
  // int vIndex = data.getIndex(v);
  // double lcVertex = data.vSizes[vIndex];
  // double lcBGMVertex = data.vSizesBGM[vIndex];
  while(it != shell.end()) {
    MVertex *v0, *v1;
    if(it->ori > 0) {
      v0 = it->_v(0);
      v1 = it->_v(1);
    }
    else {
      v0 = it->_v(1);
      v1 = it->_v(0);
    }
    MTriangle *t = new MTriangle(v0, v1, v);
    int index0 = data.getIndex(t->getVertex(0));
    int index1 = data.getIndex(t->getVertex(1));
    int index2 = data.getIndex(t->getVertex(2));
    const double ONE_THIRD = 1. / 3.;
    double lc = ONE_THIRD * (data.vSizes[index0] + data.vSizes[index1] +
                             data.vSizes[index2]);
    double lcBGM =
      ONE_THIRD * (data.vSizesBGM[index0] + data.vSizesBGM[index1] +
                   data.vSizesBGM[index2]);
    double LL = Extend1dMeshIn2dSurfaces() ? std::min(lc, lcBGM) : lcBGM;

    lcMin = std::min(lcMin, std::min(data.vSizes[index0], data.vSizes[index1]));
    lcBGMMin = std::min(lcBGMMin, std::min(data.vSizesBGM[index0], data.vSizesBGM[index1]));

    MTri3 *t4 = new MTri3(t, LL, 0, &data, gf);

    if(oneNewTriangle) {
      force = true;
      *oneNewTriangle = t4;
    }
    // double din = t->getInnerRadius();

    double d1 = distance(v0, v);
    double d2 = distance(v1, v);
    double d3 = distance(v0, v1);
    double d4 = 1.e22;
    // avoid angles that are too obtuse
    double cosv = ((d1 * d1 + d2 * d2 - d3 * d3) / (2. * d1 * d2));

    if(v0->onWhat()->dim() != 2 && v1->onWhat()->dim() != 2){
      SVector3 v0v1(v1->x() - v0->x(), v1->y() - v0->y(), v1->z() - v0->z());
      SVector3 v0v(v->x() - v0->x(), v->y() - v0->y(), v->z() - v0->z());
      SVector3 pv = crossprod(v0v1, v0v);
      d4 = pv.norm() / d3;
    }

    if((d1 < LL * .5 || d2 < LL * .5 || d4 < LL * .4 || cosv < -.9999) &&
       !force) {
      onePointIsTooClose = true;
    }

    newTris[k++] = t4;
    // all new triangles are pushed front in order to be able to destroy them if
    // the cavity is not star shaped around the new vertex.
    new_cavity.push_back(t4);

    MTri3 *otherSide = it->t1->getNeigh(it->i1);
    if(otherSide) new_cavity.push_back(otherSide);

    double ss = std::abs(getSurfUV(t4->tri(), data));
    if(ss < 1.e-25) ss = 1.e22;

    newVolume += ss;
    newMinQuality = std::min(newMinQuality, t4->tri()->gammaShapeMeasure());

    ++it;
  }

  // for adding a point we require that the area remains the same after addition
  // of the point, and that the point is not too close to an edge
  if(std::abs(oldVolume - newVolume) < EPS * oldVolume && !onePointIsTooClose){
    connectTris(new_cavity.begin(), new_cavity.end(), conn);
    // 30 % of the time is spent here!
    allTets.insert(newTris, newTris + shell.size());
    if(activeTets) {
      for(std::vector<MTri3 *>::iterator i = new_cavity.begin();
          i != new_cavity.end(); ++i) {
        int active_edge;
        if(isActive(*i, LIMIT_, active_edge) && (*i)->getRadius() > LIMIT_) {
          if((*activeTets).find(*i) == (*activeTets).end())
            (*activeTets).insert(*i);
        }
      }
    }
    delete[] newTris;
    return 1;
  }
  else {
    // the cavity is NOT star shaped
    ittet = cavity.begin();
    ittete = cavity.end();
    while(ittet != ittete) {
      (*ittet)->setDeleted(false);
      ++ittet;
    }
    // _printTris("cavity.pos", cavity.begin(), cavity.end(), Us, Vs, false);
    // _printTris("new_cavity.pos", new_cavity.begin(), new_cavity.end(), Us, Vs, false);
    // _printTris("newTris.pos", &newTris[0], newTris+shell.size(), Us, Vs, false);
    // _printTris("allTris.pos", allTets.begin(),allTets.end(), Us, Vs, false);
    for(std::size_t i = 0; i < shell.size(); i++) {
      delete newTris[i]->tri();
      delete newTris[i];
    }
    delete[] newTris;

    if(std::abs(oldVolume - newVolume) > EPS * oldVolume) return -3;
    if(onePointIsTooClose) return -4;
    return -5;
  }
}

static bool invMapXY(MTriangle *t, MVertex *v)
{
  MVertex *v0 = t->getVertex(0);
  MVertex *v1 = t->getVertex(1);
  MVertex *v2 = t->getVertex(2);
  double mat[2][2], b[2], uv[2], tol = 1.e-6;
  mat[0][0] = v1->x() - v0->x();
  mat[0][1] = v2->x() - v0->x();
  mat[1][0] = v1->y() - v0->y();
  mat[1][1] = v2->y() - v0->y();

  b[0] = v->x() - v0->x();
  b[1] = v->y() - v0->y();
  sys2x2(mat, b, uv);

  if(uv[0] >= -tol && uv[1] >= -tol && uv[0] <= 1. + tol && uv[1] <= 1. + tol &&
     1. - uv[0] - uv[1] > -tol) {
    return true;
  }
  return false;
}

static MTri3 *search4Triangle(MTri3 *t, MVertex *v, int maxx, int &ITER)
{
  bool inside = invMapXY(t->tri(), v);
  SPoint3 q1(v->x(), v->y(), 0);
  if(inside) return t;
  while(1) {
    SPoint3 q2 = t->tri()->barycenter();
    int i;
    for(i = 0; i < 3; i++) {
      int i1 = i == 0 ? 2 : i - 1;
      int i2 = i;
      MVertex *v1 = t->tri()->getVertex(i1);
      MVertex *v2 = t->tri()->getVertex(i2);
      SPoint3 p1(v1->x(), v1->y(), 0);
      SPoint3 p2(v2->x(), v2->y(), 0);
      if(intersection_segments_2(p1, p2, q1, q2)) break;
    }
    if(i >= 3) break;
    t = t->getNeigh(i);
    if(!t) break;
    bool inside = invMapXY(t->tri(), v);
    if(inside) return t;
    if(ITER++ > .5 * maxx) break;
  }
  return 0;
}

static MTri3 *search4Triangle(MTri3 *t, double pt[2], bidimMeshData &data,
                              std::set<MTri3 *, compareTri3Ptr> &AllTris,
                              double uv[2], bool force = false)
{
  // bool inside = t->inCircumCircle(pt);
  bool inside = invMapUV(t->tri(), pt, data, uv, 1.e-8);

  if(inside) return t;
  SPoint3 q1(pt[0], pt[1], 0);
  int ITER = 0;
  while(1) {
    int index0 = data.getIndex(t->tri()->getVertex(0));
    int index1 = data.getIndex(t->tri()->getVertex(1));
    int index2 = data.getIndex(t->tri()->getVertex(2));
    SPoint3 q2((data.Us[index0] + data.Us[index1] + data.Us[index2]) / 3.0,
               (data.Vs[index0] + data.Vs[index1] + data.Vs[index2]) / 3.0, 0);
    int i;
    for(i = 0; i < 3; i++) {
      int i1 = data.getIndex(t->tri()->getVertex(i == 0 ? 2 : i - 1));
      int i2 = data.getIndex(t->tri()->getVertex(i));
      SPoint3 p1(data.Us[i1], data.Vs[i1], 0);
      SPoint3 p2(data.Us[i2], data.Vs[i2], 0);
      if(intersection_segments_2(p1, p2, q1, q2)) break;
    }
    if(i >= 3) {
      printf("impossible\n");
      break;
    }
    t = t->getNeigh(i);
    if(!t) break;
    bool inside = invMapUV(t->tri(), pt, data, uv, 1.e-8);
    if(inside) return t;
    if(ITER++ > (int)AllTris.size()) break;
  }

  if(!force) return 0; // FIXME: removing this leads to horrible performance

  for(std::set<MTri3 *, compareTri3Ptr>::iterator itx = AllTris.begin();
      itx != AllTris.end(); ++itx) {
    if(!(*itx)->isDeleted()) {
      inside = invMapUV((*itx)->tri(), pt, data, uv, 1.e-8);
      if(inside) {
        return *itx;
      }
    }
  }
  printf("argh %g %g!!!!\n", pt[0], pt[1]);
  return 0;
}

static bool insertAPoint(GFace *gf,
                         std::set<MTri3 *, compareTri3Ptr>::iterator it,
                         double center[2], double metric[3],
                         bidimMeshData &data,
                         std::set<MTri3 *, compareTri3Ptr> &AllTris,
                         std::set<MTri3 *, compareTri3Ptr> *ActiveTris = 0,
                         MTri3 *worst = 0, MTri3 **oneNewTriangle = 0,
                         bool testStarShapeness = false)
{
  if(worst) {
    it = AllTris.find(worst);
    if(worst != *it) {
      Msg::Error("Could not insert point");
      return false;
    }
  }
  else
    worst = *it;

  MTri3 *ptin = 0;
  std::list<edgeXface> shell;
  std::list<MTri3 *> cavity;
  double uv[2];

  // if the point is able to break the bad triangle "worst"
  if(inCircumCircleAniso(gf, worst->tri(), center, metric, data)) {
    recurFindCavityAniso(gf, shell, cavity, metric, center, worst, data);
    for(std::list<MTri3 *>::iterator itc = cavity.begin(); itc != cavity.end();
        ++itc) {
      if(invMapUV((*itc)->tri(), center, data, uv, 1.e-8)) {
        ptin = *itc;
        break;
      }
    }
  }
  else {
    ptin = search4Triangle(worst, center, data, AllTris, uv,
                           oneNewTriangle ? true : false);
    if(ptin) {
      recurFindCavityAniso(gf, shell, cavity, metric, center, ptin, data);
    }
  }

  if(ptin) {
    // we use here local coordinates as real coordinates x,y and z will be
    // computed hereafter
    GPoint p = gf->point(center[0], center[1]);

    MVertex *v = new MFaceVertex(p.x(), p.y(), p.z(), gf, center[0], center[1]);

    double lc1, lc;
    int index0 = data.getIndex(ptin->tri()->getVertex(0));
    int index1 = data.getIndex(ptin->tri()->getVertex(1));
    int index2 = data.getIndex(ptin->tri()->getVertex(2));
    lc1 = (1. - uv[0] - uv[1]) * data.vSizes[index0] +
          uv[0] * data.vSizes[index1] + uv[1] * data.vSizes[index2];
    if(CTX::instance()->mesh.algo2d == ALGO_2D_BAMG)
      lc = 1.;
    else
      lc = BGM_MeshSize(gf, center[0], center[1], p.x(), p.y(), p.z());

    data.addVertex(v, center[0], center[1], lc1, lc);

    int result = -9;
    if(p.succeeded()) {
      result = insertVertexB(shell, cavity, false, gf, v, center, ptin, AllTris,
                             ActiveTris, data, metric, oneNewTriangle,
                             testStarShapeness);
    }
    if(result != 1) {
      if(result == -1)
        Msg::Debug("Point %g %g cannot be inserted because cavity if of size 1",
                   center[0], center[1]);
      if(result == -2)
        Msg::Debug("Point %g %g cannot be inserted because euler formula is "
                   "not fullfilled",
                   center[0], center[1]);
      if(result == -3)
        Msg::Debug(
          "Point %g %g cannot be inserted because cavity is not star shaped",
          center[0], center[1]);
      if(result == -4)
        Msg::Debug("Point %g %g cannot be inserted because it is too close to "
                   "another point)",
                   center[0], center[1]);
      if(result == -5)
        Msg::Debug("Point %g %g cannot be inserted because it is out of the "
                   "parametric domain)",
                   center[0], center[1]);

      AllTris.erase(it);
      worst->forceRadius(-1);
      AllTris.insert(worst);
      delete v;
      for(std::list<MTri3 *>::iterator itc = cavity.begin();
          itc != cavity.end(); ++itc)
        (*itc)->setDeleted(false);
      return false;
    }
    else {
      gf->mesh_vertices.push_back(v);
      return true;
    }
  }
  else {
    for(std::list<MTri3 *>::iterator itc = cavity.begin(); itc != cavity.end();
        ++itc)
      (*itc)->setDeleted(false);
    AllTris.erase(it);
    worst->forceRadius(0);
    AllTris.insert(worst);
    return false;
  }
}

void bowyerWatson(GFace *gf, int MAXPNT,
                  std::map<MVertex *, MVertex *> *equivalence,
                  std::map<MVertex *, SPoint2> *parametricCoordinates)
{
  std::set<MTri3 *, compareTri3Ptr> AllTris;
  bidimMeshData DATA(equivalence, parametricCoordinates);

  if(!buildMeshGenerationDataStructures(gf, AllTris, DATA)){
    Msg::Error("Invalid meshing data structure");
    return;
  }

  int nbSwaps = edgeSwapPass(gf, AllTris, SWCR_DEL, DATA);
  Msg::Debug("Delaunization of the initial mesh done (%d swaps)", nbSwaps);

  if(AllTris.empty()) {
    Msg::Error("No triangles in initial mesh");
    return;
  }

  int ITER = 0;
  int NBDELETED = 0;
  while(1) {
    MTri3 *worst = *AllTris.begin();
    if(worst->isDeleted()) {
      delete worst->tri();
      delete worst;
      AllTris.erase(AllTris.begin());
      NBDELETED++;
    }
    else {
      if(ITER++ % 5000 == 0) {
        Msg::Debug("%7d points created -- Worst tri radius is %8.3f",
                   DATA.vSizes.size(), worst->getRadius());
      }
      // VERIFY STOP !!!
      if(worst->getRadius() < 0.5 * std::sqrt(2.0) ||
         (int)DATA.vSizes.size() > MAXPNT) {
        break;
      }

      double center[2], metric[3], r2;
      circUV(worst->tri(), DATA, center, gf);
      MTriangle *base = worst->tri();
      int index0 = DATA.getIndex(base->getVertex(0));
      int index1 = DATA.getIndex(base->getVertex(1));
      int index2 = DATA.getIndex(base->getVertex(2));
      double pa[2] = {
        (DATA.Us[index0] + DATA.Us[index1] + DATA.Us[index2]) / 3.,
        (DATA.Vs[index0] + DATA.Vs[index1] + DATA.Vs[index2]) / 3.};

      buildMetric(gf, pa, metric);
      circumCenterMetric(worst->tri(), metric, DATA, center, r2);
      insertAPoint(gf, AllTris.begin(), center, metric, DATA, AllTris);
    }
  }
  nbSwaps = edgeSwapPass(gf, AllTris, SWCR_QUAL, DATA);
  splitElementsInBoundaryLayerIfNeeded(gf);
  transferDataStructure(gf, AllTris, DATA);
}

// Let's try a frontal delaunay approach now that the delaunay mesher is stable.
// We use the approach of Rebay (JCP 1993) that we extend to anisotropic
// metrics. The point isertion is done on the Voronoi Edges.

static double lengthInfniteNorm(const double p[2], const double q[2],
                                const double quadAngle)
{
  double const xp = p[0] * std::cos(quadAngle) + p[1] * std::sin(quadAngle);
  double const yp = -p[0] * std::sin(quadAngle) + p[1] * std::cos(quadAngle);
  double const xq = q[0] * std::cos(quadAngle) + q[1] * std::sin(quadAngle);
  double const yq = -q[0] * std::sin(quadAngle) + q[1] * std::cos(quadAngle);
  double const xmax = std::max(xp, xq);
  double const xmin = std::min(xp, xq);
  double const ymax = std::max(yp, yq);
  double const ymin = std::min(yp, yq);
  return std::max(xmax - xmin, ymax - ymin);
}

static void circumCenterInfinite(MTriangle *base, double quadAngle,
                                 bidimMeshData &data, double *x)
{
  int const index0 = data.getIndex(base->getVertex(0));
  int const index1 = data.getIndex(base->getVertex(1));
  int const index2 = data.getIndex(base->getVertex(2));
  double const pa[2] = {data.Us[index0], data.Vs[index0]};
  double const pb[2] = {data.Us[index1], data.Vs[index1]};
  double const pc[2] = {data.Us[index2], data.Vs[index2]};
  double const xa = pa[0] * std::cos(quadAngle) - pa[1] * std::sin(quadAngle);
  double const ya = pa[0] * std::sin(quadAngle) + pa[1] * std::cos(quadAngle);
  double const xb = pb[0] * std::cos(quadAngle) - pb[1] * std::sin(quadAngle);
  double const yb = pb[0] * std::sin(quadAngle) + pb[1] * std::cos(quadAngle);
  double const xc = pc[0] * std::cos(quadAngle) - pc[1] * std::sin(quadAngle);
  double const yc = pc[0] * std::sin(quadAngle) + pc[1] * std::cos(quadAngle);
  double const xmax = std::max(std::max(xa, xb), xc);
  double const ymax = std::max(std::max(ya, yb), yc);
  double const xmin = std::min(std::min(xa, xb), xc);
  double const ymin = std::min(std::min(ya, yb), yc);
  x[0] = 0.5 * (xmax - xmin);
  x[1] = 0.5 * (ymax - ymin);
}

static double lengthMetric(const double p[2], const double q[2],
                           const double metric[3])
{
  return std::sqrt((p[0] - q[0]) * metric[0] * (p[0] - q[0]) +
                   2 * (p[0] - q[0]) * metric[1] * (p[1] - q[1]) +
                   (p[1] - q[1]) * metric[2] * (p[1] - q[1]));
}

/*
          /|
         / |
        /  |
       /   |
   lc /    |  r
     /     |
    /      |
   /       x
  /        |
 /         |  r/2
/          |
-----------+
     lc/2

     (3 r/2)^2 = lc^2 - lc^2/4
     -> lc^2 3/4 = 9r^2/4
     -> lc^2 = 3 r^2

     r^2 /4 + lc^2/4 = r^2
     -> lc^2 = 3 r^2

*/

static double optimalPointFrontal(GFace *gf, MTri3 *worst, int active_edge,
                                  bidimMeshData &data, double newPoint[2],
                                  double metric[3])
{
  double center[2], r2;
  MTriangle *base = worst->tri();
  circUV(base, data, center, gf);
  int index0 = data.getIndex(base->getVertex(0));
  int index1 = data.getIndex(base->getVertex(1));
  int index2 = data.getIndex(base->getVertex(2));
  double pa[2] = {(data.Us[index0] + data.Us[index1] + data.Us[index2]) / 3.,
                  (data.Vs[index0] + data.Vs[index1] + data.Vs[index2]) / 3.};
  buildMetric(gf, pa, metric);
  circumCenterMetric(worst->tri(), metric, data, center, r2);
  // compute the middle point of the edge
  int ip1 = active_edge - 1 < 0 ? 2 : active_edge - 1;
  int ip2 = active_edge;

  index0 = data.getIndex(base->getVertex(ip1));
  index1 = data.getIndex(base->getVertex(ip2));
  double P[2] = {data.Us[index0], data.Vs[index0]};
  double Q[2] = {data.Us[index1], data.Vs[index1]};
  double midpoint[2] = {0.5 * (P[0] + Q[0]), 0.5 * (P[1] + Q[1])};

  // now we have the edge center and the center of the circumcircle, we try to
  // find a point that would produce a perfect triangle while connecting the 2
  // points of the active edge
  double dir[2] = {center[0] - midpoint[0], center[1] - midpoint[1]};
  double norm = std::sqrt(dir[0] * dir[0] + dir[1] * dir[1]);
  dir[0] /= norm;
  dir[1] /= norm;
  const double RATIO =
    std::sqrt(dir[0] * dir[0] * metric[0] + 2 * dir[1] * dir[0] * metric[1] +
              dir[1] * dir[1] * metric[2]);

  const double rhoM1 =
    0.5 * (data.vSizes[index0] + data.vSizes[index1]); // * RATIO;
  const double rhoM2 =
    0.5 * (data.vSizesBGM[index0] + data.vSizesBGM[index1]); // * RATIO;
  const double rhoM =
    Extend1dMeshIn2dSurfaces() ? std::min(rhoM1, rhoM2) : rhoM2;
  const double rhoM_hat = rhoM;

  const double q = lengthMetric(center, midpoint, metric);
  const double d = rhoM_hat * std::sqrt(3.0) * 0.5;

  // d is corrected in a way that the mesh size is computed at point newPoint

  const double L = std::min(d, q);

  newPoint[0] = midpoint[0] + L * dir[0] / RATIO;
  newPoint[1] = midpoint[1] + L * dir[1] / RATIO;

  return L;
}

/*
            x
            |
            |
            | d =  3^{1/2}/2 h
            |
            |
      ------p------->   n
            h

   x point of the plane

   h being some kind of average between the size field
   and the edge length
*/

static bool optimalPointFrontalB(GFace *gf, MTri3 *worst, int active_edge,
                                 bidimMeshData &data, double newPoint[2],
                                 double metric[3])
{
  // as a starting point, let us use the "fast algo"
  double d = optimalPointFrontal(gf, worst, active_edge, data, newPoint, metric);
  int ip1 = (active_edge + 2) % 3;
  int ip2 = active_edge;
  int ip3 = (active_edge + 1) % 3;
  MVertex *v1 = worst->tri()->getVertex(ip1);
  MVertex *v2 = worst->tri()->getVertex(ip2);
  MVertex *v3 = worst->tri()->getVertex(ip3);
  SVector3 middle((v1->x() + v2->x()) * .5, (v1->y() + v2->y()) * .5,
                  (v1->z() + v2->z()) * .5);
  SVector3 v1v2(v2->x() - v1->x(), v2->y() - v1->y(), v2->z() - v1->z());
  SVector3 tmp(v3->x() - middle.x(), v3->y() - middle.y(),
               v3->z() - middle.z());
  SVector3 n1 = crossprod(v1v2, tmp);
  if(n1.norm() < 1.e-12) return true;
  SVector3 n2 = crossprod(n1, v1v2);
  n1.normalize();
  n2.normalize();
  // we look for a point that is
  // P = d * (n1 std::cos(t) + n2 std::sin(t)) that is on the surface
  // so we have to find t, starting with t = 0
  //  return true;

#if defined(HAVE_HXT)
  if(gf->geomType() == GEntity::DiscreteSurface) {
    discreteFace *ddf = dynamic_cast<discreteFace *>(gf);
    if(ddf) {
      GPoint gp = ddf->intersectionWithCircle(n1, n2, middle, d, newPoint);
      if(gp.succeeded()) return true;
      return false;
    }
  }
#endif

  double uvt[3] = {newPoint[0], newPoint[1], 0.0};
  curveFunctorCircle cc(n2, n1, middle, d);
  surfaceFunctorGFace ss(gf);

  if(intersectCurveSurface(cc, ss, uvt, d * 1.e-8)) {
    // if(gf->containsParam(SPoint2(uvt[0], uvt[1]))) {
      newPoint[0] = uvt[0];
      newPoint[1] = uvt[1];
      return true;
    // }
  }

  return true;
}

void bowyerWatsonFrontal(GFace *gf, std::map<MVertex *, MVertex *> *equivalence,
                         std::map<MVertex *, SPoint2> *parametricCoordinates,
                         std::vector<SPoint2> *true_boundary)
{
  std::set<MTri3 *, compareTri3Ptr> AllTris;
  std::set<MTri3 *, compareTri3Ptr> ActiveTris;
  bidimMeshData DATA(equivalence, parametricCoordinates);
  bool testStarShapeness = true;
  SPoint3 c;
  std::set<GEntity*> degenerated;
  getDegeneratedVertices(gf, degenerated);

  if(!buildMeshGenerationDataStructures(gf, AllTris, DATA)){
    Msg::Error("Invalid meshing data structure");
    return;
  }

  // delaunise the initial mesh
  edgeSwapPass(gf, AllTris, SWCR_DEL, DATA);

  int ITER = 0, active_edge;
  // compute active triangle
  std::set<MTri3 *, compareTri3Ptr>::iterator it = AllTris.begin();
  for(; it != AllTris.end(); ++it) {
    if(isActive(*it, LIMIT_, active_edge))
      ActiveTris.insert(*it);
    else if((*it)->getRadius() < LIMIT_)
      break;
  }

  Range<double> RU = gf->parBounds(0);
  Range<double> RV = gf->parBounds(1);
  SPoint2 FAR(2 * RU.high(), 2 * RV.high());

  // insert points
  int ITERATION = 0;
  while(1) {
    ++ITERATION;
    // if(ITERATION % 1 == 0 && Msg::GetVerbosity() == 99){
    //   char name[245];
    //   sprintf(name,"delFrontal_GFace_%d_Layer_%d.pos",gf->tag(),ITERATION);
    //   _printTris (name, AllTris.begin(), AllTris.end(), &DATA);
    //   sprintf(name,"delFrontal_GFace_%d_Layer_Real%d.pos",gf->tag(),ITERATION);
    //   _printTris (name, AllTris.begin(), AllTris.end(),NULL);
    //   sprintf(name,"delFrontal_GFace_%d_Layer_%d_Active.pos",gf->tag(),ITERATION);
    //   _printTris (name, ActiveTris.begin(), ActiveTris.end(), &DATA);
    // }

    // printf("%d active tris \n",ActiveTris.size());
    if(!ActiveTris.size()) break;
    MTri3 *worst = (*ActiveTris.begin());
    ActiveTris.erase(ActiveTris.begin());

    if(!worst->isDeleted() && isActive(worst, LIMIT_, active_edge) &&
       worst->getRadius() > LIMIT_) {
      if(ITER++ % 5000 == 0)
        Msg::Debug("%7d points created -- Worst tri radius is %8.3f",
                   gf->mesh_vertices.size(), worst->getRadius());
      double newPoint[2], metric[3];
      if(optimalPointFrontalB(gf, worst, active_edge, DATA, newPoint, metric)) {
        // printf("iteration %d passes first round\n",ITERATION);
        SPoint2 NP(newPoint[0], newPoint[1]);
        int nnnn;
        if(!true_boundary ||
           pointInsideParametricDomain(*true_boundary, NP, FAR, nnnn))
          insertAPoint(gf, AllTris.end(), newPoint, metric, DATA, AllTris,
                       &ActiveTris, worst, NULL, testStarShapeness);
      }
    }
  }

  // nbSwaps = edgeSwapPass(gf, AllTris, SWCR_QUAL, DATA);
  // char name[245];
  // sprintf(name, "delFrontal_GFace_%d.pos", gf->tag());
  // _printTris(name, AllTris.begin(), AllTris.end(), &DATA);
  // sprintf(name, "delFrontal_GFace_NEW_%d.pos", gf->tag());
  // _printTris(name, AllTris.begin(), AllTris.end(), &DATA,NULL,&degenerated);
  // sprintf(name, "delFrontal_GFace_%d_Real.pos", gf->tag());
  // _printTris(name, AllTris.begin(), AllTris.end(), NULL);
  // sprintf(name, "delFrontal_GFace_%d_Real_Curved.pos", gf->tag());
  // _printTris(name, AllTris.begin(), AllTris.end(), &DATA,gf,&degenerated);
  // sprintf(name,"delFrontal_GFace_%d_Layer_Real%d.pos",gf->tag(),ITERATION);
  // _printTris (name, AllTris.begin(), AllTris.end(),NULL);
  // sprintf(name,"delFrontal_GFace_%d_Layer_%d_Active.pos",gf->tag(),ITERATION);
  // _printTris (name, ActiveTris.begin(), ActiveTris.end(), &DATA);

  transferDataStructure(gf, AllTris, DATA);

  splitElementsInBoundaryLayerIfNeeded(gf);
}

static void optimalPointFrontalQuad(GFace *gf, MTri3 *worst, int active_edge,
                                    bidimMeshData &data, double newPoint[2],
                                    double metric[3])
{
  MTriangle *base = worst->tri();
  int ip1 = active_edge - 1 < 0 ? 2 : active_edge - 1;
  int ip2 = active_edge;
  int ip3 = (active_edge + 1) % 3;

  int index1 = data.getIndex(base->getVertex(ip1));
  int index2 = data.getIndex(base->getVertex(ip2));
  int index3 = data.getIndex(base->getVertex(ip3));

  double P[2] = {data.Us[index1], data.Vs[index1]};
  double Q[2] = {data.Us[index2], data.Vs[index2]};
  double O[2] = {data.Us[index3], data.Vs[index3]};
  double midpoint[2] = {0.5 * (P[0] + Q[0]), 0.5 * (P[1] + Q[1])};

  // compute background mesh data
  double quadAngle = backgroundMesh::current()->getAngle(midpoint[0], midpoint[1], 0);
  double center[2];
  circumCenterInfinite(base, quadAngle, data, center);

  // rotate the points with respect to the angle
  double XP1 = 0.5 * (Q[0] - P[0]);
  double YP1 = 0.5 * (Q[1] - P[1]);
  double xp = XP1 * std::cos(quadAngle) + YP1 * std::sin(quadAngle);
  double yp = -XP1 * std::sin(quadAngle) + YP1 * std::cos(quadAngle);
  // ensure xp > yp
  bool exchange = false;
  if(std::abs(xp) < std::abs(yp)) {
    double temp = xp;
    xp = yp;
    yp = temp;
    exchange = true;
  }

  buildMetric(gf, midpoint, metric);
  double RATIO = std::pow(metric[0] * metric[2] - metric[1] * metric[1], -0.25);

  const double p = 0.5 * lengthInfniteNorm(P, Q, quadAngle);
  const double q = lengthInfniteNorm(center, midpoint, quadAngle);

  const double rhoM1 =
    0.5 * RATIO * (data.vSizes[index1] + data.vSizes[index2]) / std::sqrt(3.0);
  const double rhoM2 = 0.5 * RATIO *
                       (data.vSizesBGM[index1] + data.vSizesBGM[index2]) /
                       std::sqrt(3.);
  const double rhoM =
    Extend1dMeshIn2dSurfaces() ? std::min(rhoM1, rhoM2) : rhoM2;

  const double rhoM_hat =
    std::min(std::max(rhoM, p), (p * p + q * q) / (2 * q));
  const double factor =
    (rhoM_hat + std::sqrt(rhoM_hat * rhoM_hat - p * p)) / (std::sqrt(3.) * p);

  double npx, npy;
  if(xp * yp > 0) {
    npx = -std::abs(xp) * factor;
    npy = std::abs(xp) * (1. + factor) - std::abs(yp);
  }
  else {
    npx = std::abs(xp) * factor;
    npy = (1. + factor) * std::abs(xp) - std::abs(yp);
  }
  if(exchange) {
    double temp = npx;
    npx = npy;
    npy = temp;
  }

  newPoint[0] =
    midpoint[0] + std::cos(quadAngle) * npx - std::sin(quadAngle) * npy;
  newPoint[1] =
    midpoint[1] + std::sin(quadAngle) * npx + std::cos(quadAngle) * npy;

  if((midpoint[0] - newPoint[0]) * (midpoint[0] - O[0]) +
       (midpoint[1] - newPoint[1]) * (midpoint[1] - O[1]) <
     0) {
    newPoint[0] =
      midpoint[0] - std::cos(quadAngle) * npx + std::sin(quadAngle) * npy;
    newPoint[1] =
      midpoint[1] - std::sin(quadAngle) * npx - std::cos(quadAngle) * npy;
  }
}

void buildBackgroundMesh(GFace *gf, bool crossFieldClosestPoint,
                         std::map<MVertex *, MVertex *> *equivalence,
                         std::map<MVertex *, SPoint2> *parametricCoordinates)
{
#if defined(HAVE_DOMHEX)
  if(!old_algo_hexa()) return;
#endif

  quadsToTriangles(gf, 100000);

  if(!backgroundMesh::current()) {
    std::vector<MTriangle *> TR;
    for(unsigned int i = 0; i < gf->triangles.size(); i++) {
      TR.push_back(new MTriangle(gf->triangles[i]->getVertex(0),
                                 gf->triangles[i]->getVertex(1),
                                 gf->triangles[i]->getVertex(2)));
    }
    // avoid computing curvatures on the fly : only on the BGM computes once
    // curvatures at each node

    // disable curvature control
    int CurvControl = CTX::instance()->mesh.lcFromCurvature;
    CTX::instance()->mesh.lcFromCurvature = 0;
    // do a background mesh
    bowyerWatson(gf, 40000, equivalence, parametricCoordinates);
    // re-enable curv control if asked
    CTX::instance()->mesh.lcFromCurvature = CurvControl;
    // apply this to the BGM
    if(crossFieldClosestPoint)
      backgroundMesh::setCrossFieldsByDistance(gf); // faster for delquad
    else
      backgroundMesh::set(gf); // will solve PDE
    if(Msg::GetVerbosity() == 99) {
      char name[256];
      sprintf(name, "bgm-%d.pos", gf->tag());
      backgroundMesh::current()->print(name, gf);
      sprintf(name, "cross-%d.pos", gf->tag());
      backgroundMesh::current()->print(name, gf, 1);
    }
    gf->triangles = TR;
  }
}

void bowyerWatsonFrontalLayers(
  GFace *gf, bool quad, std::map<MVertex *, MVertex *> *equivalence,
  std::map<MVertex *, SPoint2> *parametricCoordinates)
{
  std::set<MTri3 *, compareTri3Ptr> AllTris;
  std::set<MTri3 *, compareTri3Ptr> ActiveTris;
  bidimMeshData DATA(equivalence, parametricCoordinates);

  if(quad) {
    LIMIT_ = std::sqrt(2.0) * 0.99;
    // LIMIT_ = 4./3.;//std::sqrt(2.) * .99;
    MTri3::radiusNorm = -1;
  }

  if(!buildMeshGenerationDataStructures(gf, AllTris, DATA)){
    Msg::Error("Invalid meshing data structure");
    return;
  }

  // delaunise the initial mesh
  int nbSwaps = edgeSwapPass(gf, AllTris, SWCR_DEL, DATA);
  Msg::Debug("Delaunization of the initial mesh done (%d swaps)", nbSwaps);

  int ITER = 0, active_edge;
  // compute active triangle
  std::set<MTri3 *, compareTri3Ptr>::iterator it = AllTris.begin();
  std::set<MEdge, Less_Edge> _front;
  for(; it != AllTris.end(); ++it) {
    if(isActive(*it, LIMIT_, active_edge)) {
      ActiveTris.insert(*it);
      updateActiveEdges(*it, LIMIT_, _front);
    }
    else if((*it)->getRadius() < LIMIT_)
      break;
  }

  // insert points
  int ITERATION = 1;
  int max_layers = quad ? 10000 : 4;
  while(1) {
    ITERATION++;
    // if(ITERATION % 1 == 0 && Msg::GetVerbosity() == 99){
    //   char name[245];
    //   sprintf(name,"delInfinite_GFace_%d_Layer_%d.pos",gf->tag(),ITERATION);
    //   _printTris (name, AllTris.begin(), AllTris.end(), DATA,true);
    //   sprintf(name,"delInfinite_GFace_%d_Layer_%d_Active.pos",gf->tag(),ITERATION);
    //   _printTris (name, ActiveTris.begin(),  ActiveTris.end(),DATA,true);
    // }

    std::set<MTri3 *, compareTri3Ptr> ActiveTrisNotInFront;

    // printf("%d active triangles\n",ActiveTris.size());

    while(1) {
      if(!ActiveTris.size()) break;

      /* if (1 || gf->tag() == 1900){
           char name[245];
           sprintf(name,"x_GFace_%d_Layer_%d.pos",gf->tag(),ITER);
           _printTris (name, AllTris, Us,Vs,true);
         }
      */
      std::set<MTri3 *, compareTri3Ptr>::iterator WORST_ITER =
        ActiveTris.begin();

      MTri3 *worst = (*WORST_ITER);
      ActiveTris.erase(WORST_ITER);
      if(!worst->isDeleted() &&
         (ITERATION > max_layers ?
            isActive(worst, LIMIT_, active_edge) :
            isActive(worst, LIMIT_, active_edge, &_front)) &&
         worst->getRadius() > LIMIT_) {
        // for (active_edge = 0 ; active_edge < 0 ; active_edge ++){
        //   if (active_edges[active_edge])break;
        // }
        if(ITER++ % 5000 == 0)
          Msg::Debug(
            "%7d points created -- Worst tri infinite radius is %8.3f -- "
            "front size %6d",
            DATA.vSizes.size(), worst->getRadius(), _front.size());

        // compute the middle point of the edge
        double newPoint[2], metric[3] = {1, 0, 1};
        if(quad)
          optimalPointFrontalQuad(gf, worst, active_edge, DATA, newPoint, metric);
        else
          optimalPointFrontalB(gf, worst, active_edge, DATA, newPoint, metric);

        insertAPoint(gf, AllTris.end(), newPoint, 0, DATA, AllTris, &ActiveTris,
                     worst);
        // else if (!worst->isDeleted() && worst->getRadius() > LIMIT_){
        //   ActiveTrisNotInFront.insert(worst);
        // }

        /*
         if(ITER % 1== 0){
           char name[245];
           sprintf(name,"frontal%d-ITER%d.pos",gf->tag(),ITER);
           _printTris (name, AllTris, Us,Vs,false);
         }
         */
      }
      else if(!worst->isDeleted() && worst->getRadius() > LIMIT_) {
        ActiveTrisNotInFront.insert(worst);
      }
    }
    _front.clear();
    it = ActiveTrisNotInFront.begin();
    for(; it != ActiveTrisNotInFront.end(); ++it) {
      if((*it)->getRadius() > LIMIT_ && isActive(*it, LIMIT_, active_edge)) {
        ActiveTris.insert(*it);
        updateActiveEdges(*it, LIMIT_, _front);
      }
    }
    // Msg::Info("%d active tris %d front edges %d not in front",
    //           ActiveTris.size(),_front.size(),ActiveTrisNotInFront.size());
    if(!ActiveTris.size()) break;
  }

  transferDataStructure(gf, AllTris, DATA);
  MTri3::radiusNorm = 2;
  LIMIT_ = 0.5 * std::sqrt(2.0) * 1;

  backgroundMesh::unset();

  splitElementsInBoundaryLayerIfNeeded(gf);
}

void bowyerWatsonParallelograms(
  GFace *gf, std::map<MVertex *, MVertex *> *equivalence,
  std::map<MVertex *, SPoint2> *parametricCoordinates)
{
  std::set<MTri3 *, compareTri3Ptr> AllTris;
  bidimMeshData DATA(equivalence, parametricCoordinates);
  std::vector<MVertex *> packed;
  std::vector<SMetric3> metrics;

#if defined(HAVE_DOMHEX)
  if(old_algo_hexa())
    packingOfParallelograms(gf, packed, metrics);
  else {
    Filler2D f;
    f.pointInsertion2D(gf, packed, metrics);
  }
#else
  Msg::Error("Packing of parallelograms algorithm requires DOMHEX");
#endif

  if(!buildMeshGenerationDataStructures(gf, AllTris, DATA)){
    Msg::Error("Invalid meshing data structure");
    return;
  }

  // delaunise the initial mesh
  int nbSwaps = edgeSwapPass(gf, AllTris, SWCR_DEL, DATA);
  Msg::Debug("Delaunization of the initial mesh done (%d swaps)", nbSwaps);

  // std::sort(packed.begin(), packed.end(), MVertexLessThanLexicographic());
  SortHilbert(packed);

  MTri3 *oneNewTriangle = 0;
  for(unsigned int i = 0; i < packed.size();) {
    MTri3 *worst = *AllTris.begin();
    if(worst->isDeleted()) {
      delete worst->tri();
      delete worst;
      AllTris.erase(AllTris.begin());
    }
    else {
      double newPoint[2];
      packed[i]->getParameter(0, newPoint[0]);
      packed[i]->getParameter(1, newPoint[1]);
      delete packed[i];
      double metric[3];
      buildMetric(gf, newPoint, metric);

      bool success = insertAPoint(gf, AllTris.begin(), newPoint, metric, DATA,
                                  AllTris, 0, oneNewTriangle, &oneNewTriangle);
      if(!success) oneNewTriangle = 0;
      i++;
    }

    if(1.0 * AllTris.size() > 2.5 * DATA.vSizes.size()) {
      std::set<MTri3 *, compareTri3Ptr>::iterator itd = AllTris.begin();
      while(itd != AllTris.end()) {
        if((*itd)->isDeleted()) {
          delete *itd;
          AllTris.erase(itd++);
        }
        else
          itd++;
      }
    }
  }

  transferDataStructure(gf, AllTris, DATA);
  backgroundMesh::unset();

  splitElementsInBoundaryLayerIfNeeded(gf);
}

void bowyerWatsonParallelogramsConstrained(
  GFace *gf, const std::set<MVertex *> &constr_vertices,
  std::map<MVertex *, MVertex *> *equivalence,
  std::map<MVertex *, SPoint2> *parametricCoordinates)
{
  std::set<MTri3 *, compareTri3Ptr> AllTris;
  bidimMeshData DATA(equivalence, parametricCoordinates);
  std::vector<MVertex *> packed;
  std::vector<SMetric3> metrics;

#if defined(HAVE_DOMHEX)
  packingOfParallelogramsConstrained(gf, constr_vertices, packed, metrics);
#else
  Msg::Error("Packing of parallelograms algorithm requires DOMHEX");
#endif

  if(!buildMeshGenerationDataStructures(gf, AllTris, DATA)){
    Msg::Error("Invalid meshing data structure");
    return;
  }

  // delaunise the initial mesh
  int nbSwaps = edgeSwapPass(gf, AllTris, SWCR_DEL, DATA);
  Msg::Debug("Delaunization of the initial mesh done (%d swaps)", nbSwaps);

  std::sort(packed.begin(), packed.end(), MVertexLessThanLexicographic());

  MTri3 *oneNewTriangle = 0;
  for(unsigned int i = 0; i < packed.size();) {
    MTri3 *worst = *AllTris.begin();
    if(worst->isDeleted()) {
      delete worst->tri();
      delete worst;
      AllTris.erase(AllTris.begin());
    }
    else {
      double newPoint[2];
      packed[i]->getParameter(0, newPoint[0]);
      packed[i]->getParameter(1, newPoint[1]);
      delete packed[i];
      double metric[3];
      buildMetric(gf, newPoint, metric);

      bool success = insertAPoint(gf, AllTris.begin(), newPoint, metric, DATA,
                                  AllTris, 0, oneNewTriangle, &oneNewTriangle);
      if(!success) oneNewTriangle = 0;
      i++;
    }

    if(1.0 * AllTris.size() > 2.5 * DATA.vSizes.size()) {
      std::set<MTri3 *, compareTri3Ptr>::iterator itd = AllTris.begin();
      while(itd != AllTris.end()) {
        if((*itd)->isDeleted()) {
          delete *itd;
          AllTris.erase(itd++);
        }
        else
          itd++;
      }
    }
  }

  transferDataStructure(gf, AllTris, DATA);
  for(unsigned int i = 0; i < gf->getNumMeshVertices(); i++) {
    MVertex *vtest = gf->getMeshVertex(i);
    double para0, para1;
    vtest->getParameter(0, para0);
    vtest->getParameter(1, para1);
  }
  backgroundMesh::unset();

  splitElementsInBoundaryLayerIfNeeded(gf);
}

static void initialSquare(std::vector<MVertex *> &v, MVertex *box[4],
                          std::vector<MTri3 *> &t)
{
  SBoundingBox3d bbox;
  for(std::size_t i = 0; i < v.size(); i++) {
    MVertex *pv = v[i];
    bbox += SPoint3(pv->x(), pv->y(), pv->z());
  }
  bbox *= 1.3;
  box[0] = new MVertex(bbox.min().x(), bbox.min().y(), 0);
  box[1] = new MVertex(bbox.max().x(), bbox.min().y(), 0);
  box[2] = new MVertex(bbox.max().x(), bbox.max().y(), 0);
  box[3] = new MVertex(bbox.min().x(), bbox.max().y(), 0);
  MTriangle *t0 = new MTriangle(box[0], box[1], box[2]);
  MTriangle *t1 = new MTriangle(box[2], box[3], box[0]);
  t.push_back(new MTri3(t0, 0.0));
  t.push_back(new MTri3(t1, 0.0));
  connectTriangles(t);
}

static MTri3 *getTriToBreak(MVertex *v, std::vector<MTri3 *> &t, int &ITER)
{
  // last inserted is used as starting point we know it is not deleted
  unsigned int k = t.size() - 1;
  while(t[k]->isDeleted()) {
    k--;
  }
  MTri3 *start = t[k];
  start = search4Triangle(start, v, (int)t.size(), ITER);
  if(start) return start;
  for(size_t i = 0; i < t.size(); i++) {
    if(!t[i]->isDeleted() && inCircumCircleXY(t[i]->tri(), v)) return t[i];
  }
  return 0;
}

static bool triOnBox(MTriangle *t, MVertex *box[4])
{
  for(size_t i = 0; i < 3; i++) {
    for(size_t j = 0; j < 4; j++) {
      if(t->getVertex(i) == box[j]) return true;
    }
  }
  return false;
}

// vertices are supposed to be sitting in the XY plane !

void recoverEdges(std::vector<MTri3 *> &t, std::vector<MEdge> &edges);

void delaunayMeshIn2D(std::vector<MVertex *> &v,
                      std::vector<MTriangle *> &result, bool removeBox,
                      std::vector<MEdge> *edgesToRecover, bool hilbertSort)
{
  std::vector<MTri3 *> t;
  t.reserve(v.size() * 2);
  std::vector<edgeXface> conn;
  std::vector<edgeXface> shell;
  std::vector<MTri3 *> cavity;
  MVertex *box[4];
  initialSquare(v, box, t);

  double AVG_ITER = 0;
  double AVG_CAVSIZE = 0;

  if(hilbertSort) SortHilbert(v);

  for(size_t i = 0; i < v.size(); i++) {
    MVertex *pv = v[i];

    int NITER = 0;
    MTri3 *found = getTriToBreak(pv, t, NITER);
    AVG_ITER += (double)NITER;
    if(!found) {
      Msg::Error("Cannot insert a point in 2D Delaunay");
      continue;
    }
    shell.clear();
    cavity.clear();

    recurFindCavity(shell, cavity, pv, found);
    AVG_CAVSIZE += (double)cavity.size();

    std::vector<MTri3 *> extended_cavity;
    for(unsigned int count = 0; count < shell.size(); count++) {
      const edgeXface &fxt = shell[count];
      MTriangle *tr;
      MTri3 *t3;
      MVertex *v0 = fxt._v(0);
      MVertex *v1 = fxt._v(1);
      MTri3 *otherSide = fxt.t1->getNeigh(fxt.i1);
      if(count < cavity.size()) {
        t3 = cavity[count];
        tr = t3->tri();
        tr->setVertex(0, v0);
        tr->setVertex(1, v1);
        tr->setVertex(2, pv);
      }
      else {
        tr = new MTriangle(v0, v1, pv);
        t3 = new MTri3(tr, 0.0);
        t.push_back(t3);
      }
      extended_cavity.push_back(t3);
      if(otherSide) extended_cavity.push_back(otherSide);
    }

    for(unsigned int k = 0; k < std::min(cavity.size(), shell.size()); k++) {
      cavity[k]->setDeleted(false);
      for(unsigned int l = 0; l < 3; l++) {
        cavity[k]->setNeigh(l, 0);
      }
    }
    connectTris(extended_cavity.begin(), extended_cavity.end(), conn);
  }

  if(edgesToRecover) recoverEdges(t, *edgesToRecover);

  for(size_t i = 0; i < t.size(); i++) {
    if(t[i]->isDeleted() || (removeBox && triOnBox(t[i]->tri(), box)))
      delete t[i]->tri();
    else {
      result.push_back(t[i]->tri());
    }
    delete t[i];
  }

  if(removeBox) {
    for(int i = 0; i < 4; i++) delete box[i];
  }
  else {
    for(int i = 0; i < 4; i++) v.push_back(box[i]);
  }
}

bool swapedge(MVertex *v1, MVertex *v2, MVertex *v3, MVertex *v4, MTri3 *t1,
              int iLocalEdge)
{
  MTri3 *t2 = t1->getNeigh(iLocalEdge);
  if(!t2) return false;

  MTriangle *t1b = new MTriangle(v2, v3, v4);
  MTriangle *t2b = new MTriangle(v4, v3, v1);
  double BEFORE = t1->tri()->getVolume() + t2->tri()->getVolume();
  double AFTER = t1b->getVolume() + t2b->getVolume();
  // printf("swapping %d %d %d %d %g %g\n",
  //        v1->getNum(),v2->getNum(),v3->getNum(),v4->getNum(),BEFORE,AFTER);
  if(std::abs(BEFORE - AFTER) / BEFORE > 1.e-8) {
    delete t1b;
    delete t2b;
    return false;
  }
  // printf("volumes ok\n");

  delete t1->tri();
  delete t2->tri();
  t1->setTri(t1b);
  t2->setTri(t2b);

  std::set<MTri3 *> cavity;
  cavity.insert(t1);
  cavity.insert(t2);
  for(int i = 0; i < 3; i++) {
    if(t1->getNeigh(i)) cavity.insert(t1->getNeigh(i));
    if(t2->getNeigh(i)) cavity.insert(t2->getNeigh(i));
  }
  std::vector<edgeXface> conn;
  connectTris(cavity.begin(), cavity.end(), conn);
  return true;
}

bool diffend(MVertex *v1, MVertex *v2, MVertex *p1, MVertex *p2)
{
  if(v1 == p1 || v2 == p1 || v1 == p2 || v2 == p2) return false;
  return true;
}

static bool recoverEdgeBySwaps(std::vector<MTri3 *> &t, MVertex *mv1,
                               MVertex *mv2, std::vector<MEdge> &edges)
{
  SPoint3 pv1(mv1->x(), mv1->y(), 0);
  SPoint3 pv2(mv2->x(), mv2->y(), 0);
  double xcc[2];
  for(unsigned int i = 0; i < t.size(); i++) {
    for(unsigned int j = 0; j < 3; j++) {
      MVertex *v1 = t[i]->tri()->getVertex((j + 2) % 3);
      MVertex *v2 = t[i]->tri()->getVertex(j);
      MVertex *v3 = t[i]->tri()->getVertex((j + 1) % 3);
      MVertex *o = t[i]->otherSide(j);
      if(o) {
        SPoint3 p1(v1->x(), v1->y(), 0);
        SPoint3 p2(v2->x(), v2->y(), 0);
        SPoint3 p3(v3->x(), v3->y(), 0);
        SPoint3 po(o->x(), o->y(), 0);
        if(diffend(v1, v2, mv1, mv2)) {
          if(intersection_segments(p1, p2, pv1, pv2, xcc)) {
            // if
            // (std::binary_search(edges.begin(),edges.end(),MEdge(v1,v2),Less_Edge)){
            //  Msg::Error("1D mesh self intersects");
            //	    }
            if(!intersection_segments(po, p3, pv1, pv2, xcc) ||
               (v3 == mv1 || o == mv1 || v3 == mv2 || o == mv2)) {
              if(swapedge(v1, v2, v3, o, t[i], j)) return true;
            }
          }
        }
      }
    }
  }
  return false;
}

// recover the edges by edge swapping in the triangulation.
// edges are not supposed to

void recoverEdges(std::vector<MTri3 *> &t, std::vector<MEdge> &edges)
{
  Less_Edge le;
  std::sort(edges.begin(), edges.end(), le);
  std::set<MEdge, Less_Edge> setOfMeshEdges;
  for(size_t i = 0; i < t.size(); i++) {
    for(int j = 0; j < 3; j++) {
      setOfMeshEdges.insert(t[i]->tri()->getEdge(j));
    }
  }

  std::vector<MEdge> edgesToRecover;
  for(unsigned int i = 0; i < edges.size(); i++) {
    if(setOfMeshEdges.find(edges[i]) == setOfMeshEdges.end())
      edgesToRecover.push_back(edges[i]);
  }

  Msg::Info("%d edges to recover among %d edges", edgesToRecover.size(),
            edges.size());
  // int iter = 0;
  // char name[256];
  // sprintf(name,"iter%d.pos",iter++);
  // _printTris (name, t.begin(),t.end(),0);
  for(unsigned int i = 0; i < edgesToRecover.size(); i++) {
    MVertex *mstart = edgesToRecover[i].getVertex(0);
    MVertex *mend = edgesToRecover[i].getVertex(1);
    Msg::Info("recovering edge %d %d", mstart->getNum(), mend->getNum());
    // int iter;
    while(recoverEdgeBySwaps(t, mstart, mend, edges)) {
      // iter ++;
    }
  }
}
