Skip to content
Snippets Groups Projects
MElement.cpp 42 KiB
Newer Older
// Gmsh - Copyright (C) 1997-2011 C. Geuzaine, J.-F. Remacle
Christophe Geuzaine's avatar
Christophe Geuzaine committed
// See the LICENSE.txt file for license information. Please report all
// bugs and problems to <gmsh@geuz.org>.
Claudine Bon's avatar
Claudine Bon committed
#include <stdlib.h>
#include <math.h>
#include "GmshConfig.h"
#include "GmshMessage.h"
#include "MElement.h"
#include "MPoint.h"
#include "MLine.h"
#include "MTriangle.h"
#include "MQuadrangle.h"
#include "MTetrahedron.h"
#include "MHexahedron.h"
#include "MPrism.h"
#include "MPyramid.h"
#include "GEntity.h"
#include "GFace.h"
Christophe Geuzaine's avatar
Christophe Geuzaine committed
#include "StringUtils.h"
#include "Numeric.h"
#include "Context.h"
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed

Christophe Geuzaine's avatar
Christophe Geuzaine committed
#define SQU(a)      ((a)*(a))

int MElement::_globalNum = 0;
double MElement::_isInsideTolerance = 1.e-6;
MElement::MElement(int num, int part) : _visible(1)
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
{
#pragma omp critical
  {
    if(num){
      _num = num;
      _globalNum = std::max(_globalNum, _num);
    }
    else{
      _num = ++_globalNum;
    }
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  }
}

void MElement::_getEdgeRep(MVertex *v0, MVertex *v1,
                           double *x, double *y, double *z, SVector3 *n,
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
                           int faceIndex)
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
{
  x[0] = v0->x(); y[0] = v0->y(); z[0] = v0->z();
  x[1] = v1->x(); y[1] = v1->y(); z[1] = v1->z();
  if(faceIndex >= 0){
    n[0] = n[1] = getFace(faceIndex).normal();
  }
  else{
    MEdge e(v0, v1);
    n[0] = n[1] = e.normal();
  }
}

void MElement::_getFaceRep(MVertex *v0, MVertex *v1, MVertex *v2,
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
                           double *x, double *y, double *z, SVector3 *n)
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
{
  x[0] = v0->x(); x[1] = v1->x(); x[2] = v2->x();
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  y[0] = v0->y(); y[1] = v1->y(); y[2] = v2->y();
  z[0] = v0->z(); z[1] = v1->z(); z[2] = v2->z();
  SVector3 t1(x[1] - x[0], y[1] - y[0], z[1] - z[0]);
  SVector3 t2(x[2] - x[0], y[2] - y[0], z[2] - z[0]);
  SVector3 normal = crossprod(t1, t2);
  normal.normalize();
  for(int i = 0; i < 3; i++) n[i] = normal;
}

Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
char MElement::getVisibility() const
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
{
  if(CTX::instance()->hideUnselected && _visible < 2) return false;
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
}

double MElement::minEdge()
{
  double m = 1.e25;
  for(int i = 0; i < getNumEdges(); i++){
    MEdge e = getEdge(i);
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
    m = std::min(m, e.getVertex(0)->distance(e.getVertex(1)));
  }
  return m;
}

double MElement::maxEdge()
{
  double m = 0.;
  for(int i = 0; i < getNumEdges(); i++){
    MEdge e = getEdge(i);
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
    m = std::max(m, e.getVertex(0)->distance(e.getVertex(1)));
  }
  return m;
}

double MElement::rhoShapeMeasure()
{
  double min = minEdge();
  double max = maxEdge();
  if(max)
    return min / max;
  else
    return 0.;
}

Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
void MElement::getShapeFunctions(double u, double v, double w, double s[], int o)
  const polynomialBasis* fs = getFunctionSpace(o);
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  if(fs) fs->f(u, v, w, s);
Christophe Geuzaine's avatar
Christophe Geuzaine committed
  else Msg::Error("Function space not implemented for this type of element");
void MElement::getGradShapeFunctions(double u, double v, double w, double s[][3],
  const polynomialBasis* fs = getFunctionSpace(o);
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  if(fs) fs->df(u, v, w, s);
Christophe Geuzaine's avatar
Christophe Geuzaine committed
  else Msg::Error("Function space not implemented for this type of element");
void MElement::getHessShapeFunctions(double u, double v, double w, double s[][3][3],
                                     int o)
{
  const polynomialBasis* fs = getFunctionSpace(o);
  if(fs) fs->ddf(u, v, w, s);
  else Msg::Error("Function space not implemented for this type of element");
}

SPoint3 MElement::barycenter()
  SPoint3 p(0., 0., 0.);
  int n = getNumVertices();
  for(int i = 0; i < n; i++) {
    MVertex *v = getVertex(i);
    p[0] += v->x();
    p[1] += v->y();
    p[2] += v->z();
  p[0] /= (double)n;
  p[1] /= (double)n;
  p[2] /= (double)n;
  return p;
  getIntegrationPoints(getDim() * (getPolynomialOrder() - 1), &npts, &pts);
  double vol = 0.;
  for (int i = 0; i < npts; i++){
    vol += getJacobianDeterminant(pts[i].pt[0], pts[i].pt[1], pts[i].pt[2])
int MElement::getVolumeSign()
{
  double v = getVolume();
  if(v < 0.) return -1;
  else if(v > 0.) return 1;
  else return 0;
}

bool MElement::setVolumePositive()
  if(getDim() < 3) return true;
  int s = getVolumeSign();
  if(s < 0) revert();
  if(!s) return false;
  return true;
}

Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
std::string MElement::getInfoString()
{
  char tmp[256];
  sprintf(tmp, "Element %d", getNum());
  return std::string(tmp);
}

static double _computeDeterminantAndRegularize(MElement *ele, double jac[3][3])
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
{
  switch (ele->getDim()) {
Samuel Melchior's avatar
1D  
Samuel Melchior committed
      dJ = 1.0;
      jac[0][0] = jac[1][1] = jac[2][2] = 1.0;
      jac[0][1] = jac[1][0] = jac[2][0] = 0.0;
      dJ = sqrt(SQU(jac[0][0]) + SQU(jac[0][1]) + SQU(jac[0][2]));

      // regularize matrix
      double a[3], b[3], c[3];
Samuel Melchior's avatar
1D  
Samuel Melchior committed
      a[0] = jac[0][0];
      a[1] = jac[0][1];
      a[2] = jac[0][2];
      if((fabs(a[0]) >= fabs(a[1]) && fabs(a[0]) >= fabs(a[2])) ||
         (fabs(a[1]) >= fabs(a[0]) && fabs(a[1]) >= fabs(a[2]))) {
        b[0] = a[1]; b[1] = -a[0]; b[2] = 0.;
      }
      else {
        b[0] = 0.; b[1] = a[2]; b[2] = -a[1];
      }
Samuel Melchior's avatar
1D  
Samuel Melchior committed
      norme(b);
      prodve(a, b, c);
Samuel Melchior's avatar
1D  
Samuel Melchior committed
      norme(c);
      jac[1][0] = b[0]; jac[1][1] = b[1]; jac[1][2] = b[2];
      jac[2][0] = c[0]; jac[2][1] = c[1]; jac[2][2] = c[2];
      break;
    }
  case 2:
    {
      dJ = sqrt(SQU(jac[0][0] * jac[1][1] - jac[0][1] * jac[1][0]) +
                SQU(jac[0][2] * jac[1][0] - jac[0][0] * jac[1][2]) +
                SQU(jac[0][1] * jac[1][2] - jac[0][2] * jac[1][1]));

      // regularize matrix
      double a[3], b[3], c[3];
      a[0] = jac[0][0];
      a[1] = jac[0][1];
      a[2] = jac[0][2];
      b[0] = jac[1][0];
      b[1] = jac[1][1];
      b[2] = jac[1][2];
      prodve(a, b, c);
      norme(c);
      jac[2][0] = c[0]; jac[2][1] = c[1]; jac[2][2] = c[2];
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
    }
  case 3:
    {
      dJ = fabs(jac[0][0] * jac[1][1] * jac[2][2] + jac[0][2] * jac[1][0] * jac[2][1] +
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
                jac[0][1] * jac[1][2] * jac[2][0] - jac[0][2] * jac[1][1] * jac[2][0] -
                jac[0][0] * jac[1][2] * jac[2][1] - jac[0][1] * jac[1][0] * jac[2][2]);
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
    }
double MElement::getJacobian(double u, double v, double w, double jac[3][3])
{
  jac[0][0] = jac[0][1] = jac[0][2] = 0.;
  jac[1][0] = jac[1][1] = jac[1][2] = 0.;
  jac[2][0] = jac[2][1] = jac[2][2] = 0.;

  double gsf[1256][3];
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  getGradShapeFunctions(u, v, w, gsf);
  for (int i = 0; i < getNumShapeFunctions(); i++) {
    const MVertex *v = getShapeFunctionNode(i);
    double* gg = gsf[i];
    for (int j = 0; j < 3; j++) {
      jac[j][0] += v->x() * gg[j];
      jac[j][1] += v->y() * gg[j];
      jac[j][2] += v->z() * gg[j];
    }
  }
  return _computeDeterminantAndRegularize(this, jac);
}

double MElement::getJacobian(const fullMatrix<double> &gsf, double jac[3][3])
{
  jac[0][0] = jac[0][1] = jac[0][2] = 0.;
  jac[1][0] = jac[1][1] = jac[1][2] = 0.;
  jac[2][0] = jac[2][1] = jac[2][2] = 0.;

  for (int i = 0; i < getNumShapeFunctions(); i++) {
    const MVertex *v = getShapeFunctionNode(i);
    for (int j = 0; j < 3; j++) {
      jac[j][0] += v->x() * gsf(i, j);
      jac[j][1] += v->y() * gsf(i, j);
      jac[j][2] += v->z() * gsf(i, j);
    }
  }
  return _computeDeterminantAndRegularize(this, jac);
}

double MElement::getPrimaryJacobian(double u, double v, double w, double jac[3][3])
{
  jac[0][0] = jac[0][1] = jac[0][2] = 0.;
  jac[1][0] = jac[1][1] = jac[1][2] = 0.;
  jac[2][0] = jac[2][1] = jac[2][2] = 0.;
  double gsf[1256][3];
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  getGradShapeFunctions(u, v, w, gsf, 1);
  for(int i = 0; i < getNumPrimaryShapeFunctions(); i++) {
    const MVertex *v = getShapeFunctionNode(i);
    double* gg = gsf[i];
    for (int j = 0; j < 3; j++) {
      jac[j][0] += v->x() * gg[j];
      jac[j][1] += v->y() * gg[j];
      jac[j][2] += v->z() * gg[j];
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
    }
  }
  return _computeDeterminantAndRegularize(this, jac);
}
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
void MElement::pnt(double u, double v, double w, SPoint3 &p)
{
  double x = 0., y = 0., z = 0.;
  double sf[1256];
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  getShapeFunctions(u, v, w, sf);
  for (int j = 0; j < getNumShapeFunctions(); j++) {
    const MVertex *v = getShapeFunctionNode(j);
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
    x += sf[j] * v->x();
    y += sf[j] * v->y();
    z += sf[j] * v->z();
  p = SPoint3(x, y, z);
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
void MElement::primaryPnt(double u, double v, double w, SPoint3 &p)
{
  double x = 0., y = 0., z = 0.;
  double sf[1256];
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  getShapeFunctions(u, v, w, sf, 1);
  for (int j = 0; j < getNumPrimaryShapeFunctions(); j++) {
    const MVertex *v = getShapeFunctionNode(j);
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
    x += sf[j] * v->x();
    y += sf[j] * v->y();
    z += sf[j] * v->z();
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
}

void MElement::xyz2uvw(double xyz[3], double uvw[3])
{
  // general Newton routine for the nonlinear case (more efficient
  // routines are implemented for simplices, where the basis functions
  // are linear)
  uvw[0] = uvw[1] = uvw[2] = 0.;
  int iter = 1, maxiter = 20;
  double error = 1., tol = 1.e-6;
Gaetan Bricteux's avatar
 
Gaetan Bricteux committed

Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  while (error > tol && iter < maxiter){
    double jac[3][3];
    if(!getJacobian(uvw[0], uvw[1], uvw[2], jac)) break;
    double xn = 0., yn = 0., zn = 0.;
    double sf[1256];
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
    getShapeFunctions(uvw[0], uvw[1], uvw[2], sf);
    for (int i = 0; i < getNumShapeFunctions(); i++) {
      MVertex *v = getShapeFunctionNode(i);
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
      xn += v->x() * sf[i];
      yn += v->y() * sf[i];
      zn += v->z() * sf[i];
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
    }
    double inv[3][3];
    inv3x3(jac, inv);
    double un = uvw[0] + inv[0][0] * (xyz[0] - xn) +
Christophe Geuzaine's avatar
pp  
Christophe Geuzaine committed
      inv[1][0] * (xyz[1] - yn) + inv[2][0] * (xyz[2] - zn);
    double vn = uvw[1] + inv[0][1] * (xyz[0] - xn) +
      inv[1][1] * (xyz[1] - yn) + inv[2][1] * (xyz[2] - zn);
    double wn = uvw[2] + inv[0][2] * (xyz[0] - xn) +
      inv[1][2] * (xyz[1] - yn) + inv[2][2] * (xyz[2] - zn);
Christophe Geuzaine's avatar
Christophe Geuzaine committed
    error = sqrt(SQU(un - uvw[0]) + SQU(vn - uvw[1]) + SQU(wn - uvw[2]));
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
    uvw[0] = un;
    uvw[1] = vn;
    uvw[2] = wn;
    iter++ ;
  }
}

void MElement::movePointFromParentSpaceToElementSpace(double &u, double &v, double &w)
{
  if(!getParent()) return;
  SPoint3 p;
  getParent()->pnt(u, v, w, p);
  double xyz[3] = {p.x(), p.y(), p.z()};
  double uvwE[3];
  xyz2uvw(xyz, uvwE);
  u = uvwE[0]; v = uvwE[1]; w = uvwE[2];
}

void MElement::movePointFromElementSpaceToParentSpace(double &u, double &v, double &w)
{
  if(!getParent()) return;
  SPoint3 p;
  pnt(u, v, w, p);
  double xyz[3] = {p.x(), p.y(), p.z()};
  double uvwP[3];
  getParent()->xyz2uvw(xyz, uvwP);
  u = uvwP[0]; v = uvwP[1]; w = uvwP[2];
}

Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
double MElement::interpolate(double val[], double u, double v, double w, int stride,
                             int order)
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
{
  double sum = 0;
  int j = 0;
  double sf[1256];
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  getShapeFunctions(u, v, w, sf, order);
  for(int i = 0; i < getNumShapeFunctions(); i++){
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
    sum += val[j] * sf[i];
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
    j += stride;
  }
  return sum;
}

void MElement::interpolateGrad(double val[], double u, double v, double w, double f[],
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
                               int stride, double invjac[3][3], int order)
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
{
  double dfdu[3] = {0., 0., 0.};
  int j = 0;
  double gsf[1256][3];
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  getGradShapeFunctions(u, v, w, gsf, order);
  for(int i = 0; i < getNumShapeFunctions(); i++){
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
    dfdu[0] += val[j] * gsf[i][0];
    dfdu[1] += val[j] * gsf[i][1];
    dfdu[2] += val[j] * gsf[i][2];
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
    j += stride;
  }
  if(invjac){
    matvec(invjac, dfdu, f);
  }
  else{
    double jac[3][3], inv[3][3];
    getJacobian(u, v, w, jac);
    inv3x3(jac, inv);
    matvec(inv, dfdu, f);
  }
}

void MElement::interpolateCurl(double val[], double u, double v, double w, double f[],
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
                               int stride, int order)
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
{
  double fx[3], fy[3], fz[3], jac[3][3], inv[3][3];
  getJacobian(u, v, w, jac);
  inv3x3(jac, inv);
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  interpolateGrad(&val[0], u, v, w, fx, stride, inv, order);
  interpolateGrad(&val[1], u, v, w, fy, stride, inv, order);
  interpolateGrad(&val[2], u, v, w, fz, stride, inv, order);
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  f[0] = fz[1] - fy[2];
  f[1] = -(fz[0] - fx[2]);
  f[2] = fy[0] - fx[1];
}

double MElement::interpolateDiv(double val[], double u, double v, double w,
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
{
  double fx[3], fy[3], fz[3], jac[3][3], inv[3][3];
  getJacobian(u, v, w, jac);
  inv3x3(jac, inv);
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  interpolateGrad(&val[0], u, v, w, fx, stride, inv, order);
  interpolateGrad(&val[1], u, v, w, fy, stride, inv, order);
  interpolateGrad(&val[2], u, v, w, fz, stride, inv, order);
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  return fx[0] + fy[1] + fz[2];
}
Matti Pellika's avatar
 
Matti Pellika committed
double MElement::integrate(double val[], int pOrder, int stride, int order)
{
  int npts; IntPt *gp;
  getIntegrationPoints(pOrder, &npts, &gp);
  double sum = 0;
  for (int i = 0; i < npts; i++){
    double u = gp[i].pt[0];
    double v = gp[i].pt[1];
    double w = gp[i].pt[2];
    double weight = gp[i].weight;
    double detuvw = getJacobianDeterminant(u, v, w);
    sum += interpolate(val, u, v, w, stride, order)*weight*detuvw;
  }
  return sum;
}

Christophe Geuzaine's avatar
Christophe Geuzaine committed
static int getTriangleType (int order)
{
Matti Pellika's avatar
 
Matti Pellika committed
  switch(order) {
  case 0 : return MSH_TRI_1;
  case 1 : return MSH_TRI_3;
  case 2 : return MSH_TRI_6;
  case 3 : return MSH_TRI_10;
  case 4 : return MSH_TRI_15;
  case 5 : return MSH_TRI_21;
  case 6 : return MSH_TRI_28;
  case 7 : return MSH_TRI_36;
  case 8 : return MSH_TRI_45;
  case 9 : return MSH_TRI_55;
  case 10 : return MSH_TRI_66;
Christophe Geuzaine's avatar
Christophe Geuzaine committed
  default : Msg::Error("triangle order %i unknown", order); return 0;
Matti Pellika's avatar
 
Matti Pellika committed
  }
}
Christophe Geuzaine's avatar
Christophe Geuzaine committed

static int getQuadType (int order)
{
Matti Pellika's avatar
 
Matti Pellika committed
  switch(order) {
  case 0 : return MSH_QUA_1;
  case 1 : return MSH_QUA_4;
  case 2 : return MSH_QUA_9;
  case 3 : return MSH_QUA_16;
  case 4 : return MSH_QUA_25;
  case 5 : return MSH_QUA_36;
  case 6 : return MSH_QUA_49;
  case 7 : return MSH_QUA_64;
  case 8 : return MSH_QUA_81;
  case 9 : return MSH_QUA_100;
  case 10 : return MSH_QUA_121;
Christophe Geuzaine's avatar
Christophe Geuzaine committed
  default : Msg::Error("quad order %i unknown", order); return 0;
Matti Pellika's avatar
 
Matti Pellika committed
  }
}
Christophe Geuzaine's avatar
Christophe Geuzaine committed

static int getLineType (int order)
{
Matti Pellika's avatar
 
Matti Pellika committed
  switch(order) {
  case 0 : return MSH_LIN_1;
  case 1 : return MSH_LIN_2;
  case 2 : return MSH_LIN_3;
  case 3 : return MSH_LIN_4;
  case 4 : return MSH_LIN_5;
  case 5 : return MSH_LIN_6;
  case 6 : return MSH_LIN_7;
  case 7 : return MSH_LIN_8;
  case 8 : return MSH_LIN_9;
  case 9 : return MSH_LIN_10;
  case 10 : return MSH_LIN_11;
Christophe Geuzaine's avatar
Christophe Geuzaine committed
  default : Msg::Error("line order %i unknown", order); return 0;
Matti Pellika's avatar
 
Matti Pellika committed
  }
}

double MElement::integrateCirc(double val[], int edge, int pOrder, int order)
{
  if(edge > getNumEdges() - 1){
    Msg::Error("No edge %d for this element", edge);
    return 0;
  }
  
  std::vector<MVertex*> v;
  getEdgeVertices(edge, v);
  MElementFactory f;
  int type = getLineType(getPolynomialOrder());
  MElement* ee = f.create(type, v);
  
  double intv[3];
  for(int i = 0; i < 3; i++){
    intv[i] = ee->integrate(&val[i], pOrder, 3, order);
  }  
  delete ee;
  
  double t[3] = {v[1]->x() - v[0]->x(), v[1]->y() - v[0]->y(), v[1]->z() - v[0]->z()};
  norme(t);
  double result;
  prosca(t, intv, &result);
  return result;
}

double MElement::integrateFlux(double val[], int face, int pOrder, int order)
{
  if(face > getNumFaces() - 1){
    Msg::Error("No face %d for this element", face);
    return 0;
  }
  std::vector<MVertex*> v;
  getFaceVertices(face, v);
  MElementFactory f;
  int type = 0;
Matti Pellika's avatar
Matti Pellika committed
  if(getType() == TYPE_TRI || getType() == TYPE_TET) type = getTriangleType(getPolynomialOrder());
  else if(getType() == TYPE_QUA || getType() == TYPE_HEX) type = getQuadType(getPolynomialOrder());
  else if(getType() == TYPE_PYR && face < 4) type = getTriangleType(getPolynomialOrder());
  else if(getType() == TYPE_PYR && face >= 4) type = getQuadType(getPolynomialOrder());
  else if(getType() == TYPE_PRI && face < 2) type = getTriangleType(getPolynomialOrder());
  else if(getType() == TYPE_PRI && face >= 2) type = getQuadType(getPolynomialOrder());
Matti Pellika's avatar
 
Matti Pellika committed
  MElement* fe = f.create(type, v);

  double intv[3];
  for(int i = 0; i < 3; i++){
    intv[i] = fe->integrate(&val[i], pOrder, 3, order);
  }
  delete fe;

  double n[3];
  normal3points(v[0]->x(), v[0]->y(), v[0]->z(),
                v[1]->x(), v[1]->y(), v[1]->z(),
                v[2]->x(), v[2]->y(), v[2]->z(), n);
  double result;
  prosca(n, intv, &result);
  return result;
}

void MElement::writeMSH(FILE *fp, double version, bool binary, int num,
                        int elementary, int physical, int parentNum,
Gaetan Bricteux's avatar
Gaetan Bricteux committed
                        int dom1Num, int dom2Num, std::vector<short> *ghosts)
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  int type = getTypeForMSH();
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  if(!type) return;

  // if necessary, change the ordering of the vertices to get positive
  // volume
  setVolumePositive();
  int n = getNumVerticesForMSH();
  int par = (parentNum) ? 1 : 0;
Gaetan Bricteux's avatar
Gaetan Bricteux committed
  int dom = (dom1Num) ? 2 : 0;
Gaetan Bricteux's avatar
 
Gaetan Bricteux committed
  bool poly = (type == MSH_POLYG_ || type == MSH_POLYH_ || type == MSH_POLYG_B);
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  if(!binary){
    fprintf(fp, "%d %d", num ? num : _num, type);
    if(version < 2.0)
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
      fprintf(fp, " %d %d %d", abs(physical), elementary, n);
    else if (version < 2.2)
      fprintf(fp, " %d %d %d", abs(physical), elementary, _partition);
Gaetan Bricteux's avatar
Gaetan Bricteux committed
    else if(!_partition && !par && !dom)
      fprintf(fp, " %d %d %d", 2 + par + dom, abs(physical), elementary);
Gaetan Bricteux's avatar
Gaetan Bricteux committed
      fprintf(fp, " %d %d %d 1 %d", 4 + par + dom, abs(physical), elementary, _partition);
Gaetan Bricteux's avatar
Gaetan Bricteux committed
      fprintf(fp, " %d %d %d %d %d", 4 + numGhosts + par + dom, abs(physical),
              elementary, 1 + numGhosts, _partition);
      for(unsigned int i = 0; i < ghosts->size(); i++)
        fprintf(fp, " %d", -(*ghosts)[i]);
    }
Gaetan Bricteux's avatar
 
Gaetan Bricteux committed
    if(version >= 2.0 && par)
      fprintf(fp, " %d", parentNum);
Gaetan Bricteux's avatar
Gaetan Bricteux committed
    if(version >= 2.0 && dom)
      fprintf(fp, " %d %d", dom1Num, dom2Num);
    if(version >= 2.0 && poly)
      fprintf(fp, " %d", n);
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  }
  else{
    int numTags, numGhosts = 0;
    if(!_partition) numTags = 2;
    else if(!ghosts) numTags = 4;
    else{
      numGhosts = ghosts->size();
      numTags = 4 + numGhosts;
    }
    numTags += par;
    // we write elements in blobs of single elements; this will lead
    // to suboptimal reads, but it's much simpler when the number of
    // tags change from element to element (third-party codes can
    // still write MSH file optimized for reading speed, by grouping
    // elements with the same number of tags in blobs)
    int blob[60] = {type, 1, numTags, num ? num : _num, abs(physical), elementary,
Christophe Geuzaine's avatar
Christophe Geuzaine committed
      for(int i = 0; i < numGhosts; i++) blob[8 + i] = -(*ghosts)[i];
Gaetan Bricteux's avatar
Gaetan Bricteux committed
    if(par) blob[8 + numGhosts] = parentNum;
    if(poly) Msg::Error("Unable to write polygons/polyhedra in binary files.");
    fwrite(blob, sizeof(int), 4 + numTags, fp);
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  }

Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  if(physical < 0) revert();
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed

  int *verts = getVerticesIdForMSH();
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  if(!binary){
    for(int i = 0; i < n; i++)
      fprintf(fp, " %d", verts[i]);
    fprintf(fp, "\n");
  }
  else{
    fwrite(verts, sizeof(int), n, fp);
  }
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed

  if(physical < 0) revert();

  delete [] verts;
void MElement::writePOS(FILE *fp, bool printElementary, bool printElementNumber,
                        bool printGamma, bool printEta, bool printRho,
                        bool printDisto, double scalingFactor, int elementary)
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  const char *str = getStringForPOS();
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  if(!str) return;

Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  setVolumePositive();
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  int n = getNumVertices();
  fprintf(fp, "%s(", str);
  for(int i = 0; i < n; i++){
    if(i) fprintf(fp, ",");
    fprintf(fp, "%g,%g,%g", getVertex(i)->x() * scalingFactor,
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
            getVertex(i)->y() * scalingFactor, getVertex(i)->z() * scalingFactor);
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  }
  fprintf(fp, "){");
  bool first = true;
  if(printElementary){
    for(int i = 0; i < n; i++){
      if(first) first = false; else fprintf(fp, ",");
      fprintf(fp, "%d", elementary);
    }
  }
  if(printElementNumber){
    for(int i = 0; i < n; i++){
      if(first) first = false; else fprintf(fp, ",");
      fprintf(fp, "%d", getNum());
    }
  }
  if(printGamma){
    double gamma = gammaShapeMeasure();
    for(int i = 0; i < n; i++){
      if(first) first = false; else fprintf(fp, ",");
      fprintf(fp, "%g", gamma);
    }
  }
  if(printEta){
    double eta = etaShapeMeasure();
    for(int i = 0; i < n; i++){
      if(first) first = false; else fprintf(fp, ",");
      fprintf(fp, "%g", eta);
    }
  }
  if(printRho){
    double rho = rhoShapeMeasure();
    for(int i = 0; i < n; i++){
      if(first) first = false; else fprintf(fp, ",");
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
      fprintf(fp, "%g", rho);
  if(printDisto){
    double disto = distoShapeMeasure();
    for(int i = 0; i < n; i++){
      if(first) first = false; else fprintf(fp, ",");
      fprintf(fp, "%g", disto);
    }
  }
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  fprintf(fp, "};\n");
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
void MElement::writeSTL(FILE *fp, bool binary, double scalingFactor)
  if(getType() != TYPE_TRI && getType() != TYPE_QUA) return;
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  int qid[3] = {0, 2, 3};
  SVector3 n = getFace(0).normal();
  if(!binary){
    fprintf(fp, "facet normal %g %g %g\n", n[0], n[1], n[2]);
    fprintf(fp, "  outer loop\n");
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
    for(int j = 0; j < 3; j++)
      fprintf(fp, "    vertex %g %g %g\n",
              getVertex(j)->x() * scalingFactor,
              getVertex(j)->y() * scalingFactor,
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
              getVertex(j)->z() * scalingFactor);
    fprintf(fp, "  endloop\n");
    fprintf(fp, "endfacet\n");
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
    if(getNumVertices() == 4){
      fprintf(fp, "facet normal %g %g %g\n", n[0], n[1], n[2]);
      fprintf(fp, "  outer loop\n");
      for(int j = 0; j < 3; j++)
        fprintf(fp, "    vertex %g %g %g\n",
                getVertex(qid[j])->x() * scalingFactor,
                getVertex(qid[j])->y() * scalingFactor,
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
                getVertex(qid[j])->z() * scalingFactor);
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
      fprintf(fp, "  endloop\n");
      fprintf(fp, "endfacet\n");
    }
  }
  else{
    char data[50];
    float *coords = (float*)data;
    coords[0] = (float)n[0];
    coords[1] = (float)n[1];
    coords[2] = (float)n[2];
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
    for(int j = 0; j < 3; j++){
      coords[3 + 3 * j] = (float)(getVertex(j)->x() * scalingFactor);
      coords[3 + 3 * j + 1] = (float)(getVertex(j)->y() * scalingFactor);
      coords[3 + 3 * j + 2] = (float)(getVertex(j)->z() * scalingFactor);
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
    }
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
    data[48] = data[49] = 0;
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
    fwrite(data, sizeof(char), 50, fp);
    if(getNumVertices() == 4){
      for(int j = 0; j < 3; j++){
        coords[3 + 3 * j] = (float)(getVertex(qid[j])->x() * scalingFactor);
        coords[3 + 3 * j + 1] = (float)(getVertex(qid[j])->y() * scalingFactor);
        coords[3 + 3 * j + 2] = (float)(getVertex(qid[j])->z() * scalingFactor);
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
      }
      fwrite(data, sizeof(char), 50, fp);
    }
void MElement::writePLY2(FILE *fp)
{
  setVolumePositive();
  fprintf(fp, "3 ");
  for(int i = 0; i < getNumVertices(); i++)
    fprintf(fp, " %d", getVertex(i)->getIndex() - 1);
  fprintf(fp, "\n");
}

void MElement::writeVRML(FILE *fp)
{
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  setVolumePositive();
  for(int i = 0; i < getNumVertices(); i++)
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
    fprintf(fp, "%d,", getVertex(i)->getIndex() - 1);
  fprintf(fp, "-1,\n");
}

Christophe Geuzaine's avatar
Christophe Geuzaine committed
void MElement::writeVTK(FILE *fp, bool binary, bool bigEndian)
Christophe Geuzaine's avatar
Christophe Geuzaine committed
  if(!getTypeForVTK()) return;

  setVolumePositive();

  int n = getNumVertices();
  if(binary){
    int verts[60];
    verts[0] = n;
    for(int i = 0; i < n; i++)
      verts[i + 1] = getVertexVTK(i)->getIndex() - 1;
Christophe Geuzaine's avatar
Christophe Geuzaine committed
    // VTK always expects big endian binary data
    if(!bigEndian) SwapBytes((char*)verts, sizeof(int), n + 1);
    fwrite(verts, sizeof(int), n + 1, fp);
  }
  else{
    fprintf(fp, "%d", n);
    for(int i = 0; i < n; i++)
      fprintf(fp, " %d", getVertexVTK(i)->getIndex() - 1);
    fprintf(fp, "\n");
  }
}

Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
void MElement::writeUNV(FILE *fp, int num, int elementary, int physical)
  int type = getTypeForUNV();
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  if(!type) return;

  setVolumePositive();
  int n = getNumVertices();
  int physical_property = elementary;
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  int material_property = abs(physical);
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  int color = 7;
  fprintf(fp, "%10d%10d%10d%10d%10d%10d\n",
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
          num ? num : _num, type, physical_property, material_property, color, n);
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  if(type == 21 || type == 24) // linear beam or parabolic beam
    fprintf(fp, "%10d%10d%10d\n", 0, 0, 0);
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed

  if(physical < 0) revert();

Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  for(int k = 0; k < n; k++) {
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
    fprintf(fp, "%10d", getVertexUNV(k)->getIndex());
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
    if(k % 8 == 7)
      fprintf(fp, "\n");
  }
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  if(n - 1 % 8 != 7)
    fprintf(fp, "\n");
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed

  if(physical < 0) revert();
void MElement::writeMESH(FILE *fp, int elementTagType, int elementary,
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  setVolumePositive();
  for(int i = 0; i < getNumVertices(); i++)
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
    fprintf(fp, " %d", getVertex(i)->getIndex());
  fprintf(fp, " %d\n", (elementTagType == 3) ? _partition :
          (elementTagType == 2) ? physical : elementary);
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed

void MElement::writeIR3(FILE *fp, int elementTagType, int num, int elementary,
                        int physical)
{
  int numVert = getNumVertices();
  bool ok = setVolumePositive();
  if(getDim() == 3 && !ok) Msg::Error("Element %d has zero volume", num);
  fprintf(fp, "%d %d %d", num, (elementTagType == 3) ? _partition :
          (elementTagType == 2) ? physical : elementary, numVert);
  for(int i = 0; i < numVert; i++)
    fprintf(fp, " %d", getVertex(i)->getIndex());
  fprintf(fp, "\n");
}

void MElement::writeBDF(FILE *fp, int format, int elementTagType, int elementary,
                        int physical)
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
{
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  const char *str = getStringForBDF();
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  if(!str) return;

  setVolumePositive();
  int n = getNumVertices();
  const char *cont[4] = {"E", "F", "G", "H"};
  int ncont = 0;

  int tag =  (elementTagType == 3) ? _partition : (elementTagType == 2) ?
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  if(format == 0){ // free field format
    fprintf(fp, "%s,%d,%d", str, _num, tag);
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
    for(int i = 0; i < n; i++){
      fprintf(fp, ",%d", getVertexBDF(i)->getIndex());
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
      if(i != n - 1 && !((i + 3) % 8)){
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
        fprintf(fp, ",+%s%d\n+%s%d", cont[ncont], _num, cont[ncont], _num);
        ncont++;
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
      }
    }
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
    if(n == 2) // CBAR
      fprintf(fp, ",0.,0.,0.");
    fprintf(fp, "\n");
  }
  else{ // small or large field format
    fprintf(fp, "%-8s%-8d%-8d", str, _num, tag);
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
    for(int i = 0; i < n; i++){
      fprintf(fp, "%-8d", getVertexBDF(i)->getIndex());
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
      if(i != n - 1 && !((i + 3) % 8)){
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
        fprintf(fp, "+%s%-6d\n+%s%-6d", cont[ncont], _num, cont[ncont], _num);
        ncont++;
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
      }
    }
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
    if(n == 2) // CBAR
      fprintf(fp, "%-8s%-8s%-8s", "0.", "0.", "0.");
    fprintf(fp, "\n");
Christophe Geuzaine's avatar
 
Christophe Geuzaine committed
  }
}
Christophe Geuzaine's avatar
Christophe Geuzaine committed
void MElement::writeDIFF(FILE *fp, int num, bool binary, int physical_property)
  const char *str = getStringForDIFF();
  if(!str) return;
  int n = getNumVertices();
  if(binary){
    fprintf(fp, "%d %s %d ", num, str, physical_property);
    for(int i = 0; i < n; i++)
      fprintf(fp, " %d", getVertexDIFF(i)->getIndex());
Christophe Geuzaine's avatar
Christophe Geuzaine committed
void MElement::writeINP(FILE *fp, int num)
{
  setVolumePositive();
  fprintf(fp, "%d", num);
  for(int i = 0; i < getNumVertices(); i++)
    fprintf(fp, ", %d", getVertexINP(i)->getIndex());
  fprintf(fp, "\n");
}

Stefen Guzik's avatar
 
Stefen Guzik committed
int MElement::getInfoMSH(const int typeMSH, const char **const name)
{
  switch(typeMSH){
  case MSH_PNT    : if(name) *name = "Point";           return 1;
  case MSH_LIN_2  : if(name) *name = "Line 2";          return 2;
  case MSH_LIN_3  : if(name) *name = "Line 3";          return 2 + 1;
  case MSH_LIN_4  : if(name) *name = "Line 4";          return 2 + 2;
  case MSH_LIN_5  : if(name) *name = "Line 5";          return 2 + 3;
  case MSH_LIN_6  : if(name) *name = "Line 6";          return 2 + 4;
  case MSH_LIN_7  : if(name) *name = "Line 7";          return 2 + 5;
  case MSH_LIN_8  : if(name) *name = "Line 8";          return 2 + 6;
  case MSH_LIN_9  : if(name) *name = "Line 9";          return 2 + 7;
Gaetan Bricteux's avatar
 
Gaetan Bricteux committed
  case MSH_LIN_10 : if(name) *name = "Line 10";         return 2 + 8;
  case MSH_LIN_11 : if(name) *name = "Line 11";         return 2 + 9;
  case MSH_LIN_B  : if(name) *name = "Line Border";     return 2;
Gaetan Bricteux's avatar
Gaetan Bricteux committed
  case MSH_LIN_C  : if(name) *name = "Line Child";      return 2;
  case MSH_TRI_3  : if(name) *name = "Triangle 3";      return 3;
  case MSH_TRI_6  : if(name) *name = "Triangle 6";      return 3 + 3;
  case MSH_TRI_9  : if(name) *name = "Triangle 9";      return 3 + 6;
  case MSH_TRI_10 : if(name) *name = "Triangle 10";     return 3 + 6 + 1;
  case MSH_TRI_12 : if(name) *name = "Triangle 12";     return 3 + 9;
  case MSH_TRI_15 : if(name) *name = "Triangle 15";     return 3 + 9 + 3;
  case MSH_TRI_15I: if(name) *name = "Triangle 15I";    return 3 + 12;
  case MSH_TRI_21 : if(name) *name = "Triangle 21";     return 3 + 12 + 6;
  case MSH_TRI_28 : if(name) *name = "Triangle 28";     return 3 + 15 + 10;
  case MSH_TRI_36 : if(name) *name = "Triangle 36";     return 3 + 18 + 15;
  case MSH_TRI_45 : if(name) *name = "Triangle 45";     return 3 + 21 + 21;
  case MSH_TRI_55 : if(name) *name = "Triangle 55";     return 3 + 24 + 28;
  case MSH_TRI_66 : if(name) *name = "Triangle 66";     return 3 + 27 + 36;
  case MSH_TRI_18 : if(name) *name = "Triangle 18";     return 3 + 15;
Gaetan Bricteux's avatar
 
Gaetan Bricteux committed
  case MSH_TRI_21I: if(name) *name = "Triangle 21I";    return 3 + 18;
  case MSH_TRI_24 : if(name) *name = "Triangle 24";     return 3 + 21;
  case MSH_TRI_27 : if(name) *name = "Triangle 27";     return 3 + 24;
  case MSH_TRI_30 : if(name) *name = "Triangle 30";     return 3 + 27;
Gaetan Bricteux's avatar
 
Gaetan Bricteux committed
  case MSH_TRI_B  : if(name) *name = "Triangle Border"; return 3;
  case MSH_QUA_4  : if(name) *name = "Quadrilateral 4"; return 4;
  case MSH_QUA_8  : if(name) *name = "Quadrilateral 8"; return 4 + 4;
Jean-François Remacle's avatar
Jean-François Remacle committed
  case MSH_QUA_9  : if(name) *name = "Quadrilateral 9"; return 9;
Gaetan Bricteux's avatar
 
Gaetan Bricteux committed
  case MSH_QUA_16 : if(name) *name = "Quadrilateral 16"; return 16;
  case MSH_QUA_25 : if(name) *name = "Quadrilateral 25"; return 25;
  case MSH_QUA_36 : if(name) *name = "Quadrilateral 36"; return 36;
  case MSH_QUA_49 : if(name) *name = "Quadrilateral 49"; return 49;
  case MSH_QUA_64 : if(name) *name = "Quadrilateral 64"; return 64;
  case MSH_QUA_81 : if(name) *name = "Quadrilateral 81"; return 81;
  case MSH_QUA_100: if(name) *name = "Quadrilateral 100"; return 100;
  case MSH_QUA_121: if(name) *name = "Quadrilateral 121"; return 121;
Jean-François Remacle's avatar
Jean-François Remacle committed
  case MSH_QUA_12 : if(name) *name = "Quadrilateral 12"; return 12;
Gaetan Bricteux's avatar
 
Gaetan Bricteux committed
  case MSH_QUA_16I: if(name) *name = "Quadrilateral 16I"; return 16;
Jean-François Remacle's avatar
Jean-François Remacle committed
  case MSH_QUA_20 : if(name) *name = "Quadrilateral 20"; return 20;
  case MSH_POLYG_ : if(name) *name = "Polygon";         return 0;
Gaetan Bricteux's avatar
 
Gaetan Bricteux committed
  case MSH_POLYG_B: if(name) *name = "Polygon Border";  return 0;
  case MSH_TET_4  : if(name) *name = "Tetrahedron 4";   return 4;
  case MSH_TET_10 : if(name) *name = "Tetrahedron 10";  return 4 + 6;
  case MSH_TET_20 : if(name) *name = "Tetrahedron 20";  return 4 + 12 + 4;
  case MSH_TET_34 : if(name) *name = "Tetrahedron 34";  return 4 + 18 + 12 + 0;
  case MSH_TET_35 : if(name) *name = "Tetrahedron 35";  return 4 + 18 + 12 + 1;
  case MSH_TET_52 : if(name) *name = "Tetrahedron 52";  return 4 + 24 + 24 + 0;