56 "Coordinate dimension should be at least 3 for a 3D geometry.");
74 const int MaxIterations = 51;
85 ScaledTol *= Tol * Tol;
92 while (cnt++ < MaxIterations)
97 var[4] = Lcoords[0] * Lcoords[1];
98 var[5] = Lcoords[1] * Lcoords[2];
99 var[6] = Lcoords[0] * Lcoords[2];
100 var[7] = var[4] * Lcoords[2];
109 tmp[0] = coords[0] - xmap;
110 tmp[1] = coords[1] - ymap;
111 tmp[2] = coords[2] - zmap;
113 res = tmp[0] * tmp[0] + tmp[1] * tmp[1] + tmp[2] * tmp[2];
160 Lcoords[0] +=
Vmath::Dot(3, mat->GetPtr(), 1, tmp, 1);
161 Lcoords[1] +=
Vmath::Dot(3, mat->GetPtr() + 3, 1, tmp, 1);
162 Lcoords[2] +=
Vmath::Dot(3, mat->GetPtr() + 6, 1, tmp, 1);
164 if (!(std::isfinite(Lcoords[0]) && std::isfinite(Lcoords[1]) &&
165 std::isfinite(Lcoords[2])) ||
166 fabs(Lcoords[0]) > LcoordDiv || fabs(Lcoords[1]) > LcoordDiv ||
167 fabs(Lcoords[2]) > LcoordDiv)
169 std::ostringstream ss;
170 ss <<
"Iteration has diverged in NewtonIterationForLocCoord in "
178 if (cnt >= MaxIterations)
180 std::ostringstream ss;
182 ss <<
"Reached MaxIterations (" << MaxIterations
183 <<
") in Newton iteration ";
185 WARNINGL1(cnt < MaxIterations, ss.str());
219 NekDouble derx_1, derx_2, derx_3, dery_1, dery_2, dery_3, derz_1, derz_2,
223 NekDouble init0 = Lcoords[0], init1 = Lcoords[1], init2 = Lcoords[2];
236 m_xmap->PhysDeriv(ptsx, DxD1, DxD2, DxD3);
237 m_xmap->PhysDeriv(ptsy, DyD1, DyD2, DyD3);
238 m_xmap->PhysDeriv(ptsz, DzD1, DzD2, DzD3);
246 while (cnt++ < MaxIterations)
249 m_xmap->LocCoordToLocCollapsed(Lcoords, eta);
250 I[0] =
m_xmap->GetBasis(0)->GetI(eta);
251 I[1] =
m_xmap->GetBasis(1)->GetI(eta + 1);
252 I[2] =
m_xmap->GetBasis(2)->GetI(eta + 2);
255 xmap =
m_xmap->PhysEvaluate(I, ptsx);
256 ymap =
m_xmap->PhysEvaluate(I, ptsy);
257 zmap =
m_xmap->PhysEvaluate(I, ptsz);
259 F1 = coords[0] - xmap;
260 F2 = coords[1] - ymap;
261 F3 = coords[2] - zmap;
263 if (F1 * F1 + F2 * F2 + F3 * F3 < ScaledTol)
265 resid =
sqrt(F1 * F1 + F2 * F2 + F3 * F3);
270 derx_1 =
m_xmap->PhysEvaluate(I, DxD1);
271 derx_2 =
m_xmap->PhysEvaluate(I, DxD2);
272 derx_3 =
m_xmap->PhysEvaluate(I, DxD3);
273 dery_1 =
m_xmap->PhysEvaluate(I, DyD1);
274 dery_2 =
m_xmap->PhysEvaluate(I, DyD2);
275 dery_3 =
m_xmap->PhysEvaluate(I, DyD3);
276 derz_1 =
m_xmap->PhysEvaluate(I, DzD1);
277 derz_2 =
m_xmap->PhysEvaluate(I, DzD2);
278 derz_3 =
m_xmap->PhysEvaluate(I, DzD3);
280 jac = derx_1 * (dery_2 * derz_3 - dery_3 * derz_2) -
281 derx_2 * (dery_1 * derz_3 - dery_3 * derz_1) +
282 derx_3 * (dery_1 * derz_2 - dery_2 * derz_1);
288 ((dery_2 * derz_3 - dery_3 * derz_2) * (coords[0] - xmap) -
289 (derx_2 * derz_3 - derx_3 * derz_2) * (coords[1] - ymap) +
290 (derx_2 * dery_3 - derx_3 * dery_2) * (coords[2] - zmap)) /
295 ((dery_1 * derz_3 - dery_3 * derz_1) * (coords[0] - xmap) -
296 (derx_1 * derz_3 - derx_3 * derz_1) * (coords[1] - ymap) +
297 (derx_1 * dery_3 - derx_3 * dery_1) * (coords[2] - zmap)) /
302 ((dery_1 * derz_2 - dery_2 * derz_1) * (coords[0] - xmap) -
303 (derx_1 * derz_2 - derx_2 * derz_1) * (coords[1] - ymap) +
304 (derx_1 * dery_2 - derx_2 * dery_1) * (coords[2] - zmap)) /
307 if (!(std::isfinite(Lcoords[0]) && std::isfinite(Lcoords[1]) &&
308 std::isfinite(Lcoords[2])))
311 std::ostringstream ss;
312 ss <<
"nan or inf found in NewtonIterationForLocCoord in element "
317 if (fabs(Lcoords[0]) > LcoordDiv || fabs(Lcoords[1]) > LcoordDiv ||
318 fabs(Lcoords[2]) > LcoordDiv)
324 m_xmap->LocCoordToLocCollapsed(Lcoords, eta);
327 I[0] =
m_xmap->GetBasis(0)->GetI(eta);
328 I[1] =
m_xmap->GetBasis(1)->GetI(eta + 1);
329 I[2] =
m_xmap->GetBasis(2)->GetI(eta + 2);
331 xmap =
m_xmap->PhysEvaluate(I, ptsx);
332 ymap =
m_xmap->PhysEvaluate(I, ptsy);
333 zmap =
m_xmap->PhysEvaluate(I, ptsz);
334 F1 = coords[0] - xmap;
335 F2 = coords[1] - ymap;
336 F3 = coords[2] - zmap;
337 dist =
sqrt(F1 * F1 + F2 * F2 + F3 * F3);
344 if (cnt >= MaxIterations)
347 m_xmap->LocCoordToLocCollapsed(Lcoords, collCoords);
350 if ((collCoords[0] >= -1.0 && collCoords[0] <= 1.0) &&
351 (collCoords[1] >= -1.0 && collCoords[1] <= 1.0) &&
352 (collCoords[2] >= -1.0 && collCoords[2] <= 1.0))
354 std::ostringstream ss;
356 ss <<
"Reached MaxIterations (" << MaxIterations
357 <<
") in Newton iteration ";
358 ss <<
"Init value (" << setprecision(4) << init0 <<
"," << init1
359 <<
"," << init2 <<
") ";
360 ss <<
"Fin value (" << Lcoords[0] <<
"," << Lcoords[1] <<
","
361 << Lcoords[2] <<
") ";
362 ss <<
"Resid = " << resid <<
" Tolerance = " <<
sqrt(ScaledTol);
364 WARNINGL1(cnt < MaxIterations, ss.str());
372 NekDouble dist = std::numeric_limits<double>::max();
374 tmpcoords[0] = coords[0];
375 tmpcoords[1] = coords[1];
376 tmpcoords[2] = coords[2];
401 int npts =
m_xmap->GetTotPoints();
424 int qa = za.size(), qb = zb.size();
427 eta[2] = zc[min_i / (qa * qb)];
428 min_i = min_i % (qa * qb);
429 eta[1] = zb[min_i / qa];
430 eta[0] = za[min_i % qa];
431 m_xmap->LocCollapsedToLocCoord(eta, Lcoords);
460 int nFaceCoeffs =
m_faces[i]->GetXmap()->GetNcoeffs();
467 m_xmap->GetTraceToElementMap(
474 m_xmap->GetTraceToElementMap(
485 for (k = 0; k < nFaceCoeffs; k++)
508 return m_xmap->PhysEvaluate(Lcoord, tmp);
543 "Edge ID must be between 0 and " +
544 boost::lexical_cast<string>(
m_edges.size() - 1));
550 ASSERTL2((i >= 0) && (i <= 5),
"Edge id must be between 0 and 4");
557 "Edge ID must be between 0 and " +
558 boost::lexical_cast<string>(
m_edges.size() - 1));
565 "Face ID must be between 0 and " +
566 boost::lexical_cast<string>(
m_faces.size() - 1));
574 for (
int i = 0; i < 3; ++i)
576 for (
int j = 0; j < 3; ++j)
584 for (
int i = 0; i < 3; ++i)
587 for (
int j = 0; j < 3; ++j)
#define WARNINGL1(condition, msg)
#define ASSERTL0(condition, msg)
#define ASSERTL1(condition, msg)
Assert Level 1 – Debugging which is used whether in FULLDEBUG or DEBUG compilation mode....
#define ASSERTL2(condition, msg)
Assert Level 2 – Debugging which is used FULLDEBUG compilation mode. This level assert is designed to...
static std::shared_ptr< DataType > AllocateSharedPtr(const Args &...args)
Allocate a shared pointer from the memory pool.
Geometry2DSharedPtr v_GetFace(int i) const override
Returns face i of this object.
int v_GetNumFaces() const override
Get the number of faces of this object.
NekDouble v_GetLocCoords(const Array< OneD, const NekDouble > &coords, Array< OneD, NekDouble > &Lcoords) override
Determine the local collapsed coordinates that correspond to a given Cartesian coordinate for this ge...
int v_AllLeftCheck(const Array< OneD, const NekDouble > &gloCoord) override
int v_GetNumEdges() const override
Get the number of edges of this object.
std::vector< StdRegions::Orientation > m_forient
void v_CalculateInverseIsoParam() override
void v_FillGeom() override
Put all quadrature information into face/edge structure and backward transform.
NekDouble v_GetCoord(const int i, const Array< OneD, const NekDouble > &Lcoord) override
Given local collapsed coordinate Lcoord return the value of physical coordinate in direction i.
PointGeomSharedPtr v_GetVertex(int i) const override
void NewtonIterationForLocCoord(const Array< OneD, const NekDouble > &coords, const Array< OneD, const NekDouble > &ptsx, const Array< OneD, const NekDouble > &ptsy, const Array< OneD, const NekDouble > &ptsz, Array< OneD, NekDouble > &Lcoords, NekDouble &dist)
Geometry1DSharedPtr v_GetEdge(int i) const override
Returns edge i of this object.
StdRegions::Orientation v_GetForient(const int i) const override
Returns the orientation of face i with respect to the ordering of faces in the standard element.
int v_GetShapeDim() const override
Get the object's shape dimension.
StdRegions::Orientation v_GetEorient(const int i) const override
Returns the orientation of edge i with respect to the ordering of edges in the standard element.
std::vector< StdRegions::Orientation > m_eorient
int v_GetNumVerts() const override
Get the number of vertices of this object.
Base class for shape geometry information.
GeomState m_state
Enumeration to dictate whether coefficients are filled.
Array< OneD, Array< OneD, NekDouble > > m_isoParameter
Array< OneD, Array< OneD, NekDouble > > m_invIsoParam
bool ClampLocCoords(Array< OneD, NekDouble > &locCoord, NekDouble tol=std::numeric_limits< NekDouble >::epsilon())
Clamp local coords to be within standard regions [-1, 1]^dim.
int GetGlobalID(void) const
Get the ID of this object.
Array< OneD, Array< OneD, NekDouble > > m_coeffs
Array containing expansion coefficients of m_xmap.
GeomFactorsSharedPtr GetMetricInfo()
Get the geometric factors for this object.
StdRegions::StdExpansionSharedPtr m_xmap
mapping containing isoparametric transformation.
StdRegions::StdExpansionSharedPtr GetXmap() const
Return the mapping object Geometry::m_xmap that represents the coordinate transformation from standar...
GeomFactorsSharedPtr m_geomFactors
Geometric factors.
int m_coordim
Coordinate dimension of this geometry object.
static const unsigned int kNewtonIterations
@ eRegular
Geometry is straight-sided with constant geometric factors.
std::shared_ptr< PointGeom > PointGeomSharedPtr
std::shared_ptr< Geometry2D > Geometry2DSharedPtr
@ ePtsFilled
Geometric information has been generated.
std::shared_ptr< Geometry1D > Geometry1DSharedPtr
std::shared_ptr< DNekMat > DNekMatSharedPtr
void Vmul(int n, const T *x, const int incx, const T *y, const int incy, T *z, const int incz)
Multiply vector z = x*y.
void Vvtvp(int n, const T *w, const int incw, const T *x, const int incx, const T *y, const int incy, T *z, const int incz)
vvtvp (vector times vector plus vector): z = w*x + y
T Vsum(int n, const T *x, const int incx)
Subtract return sum(x)
T Dot(int n, const T *w, const T *x)
dot product
int Imin(int n, const T *x, const int incx)
Return the index of the minimum element in x.
void Sadd(int n, const T alpha, const T *x, const int incx, T *y, const int incy)
Add vector y = alpha + x.
void Vcopy(int n, const T *x, const int incx, T *y, const int incy)
scalarT< T > sqrt(scalarT< T > in)