xref: /petsc/src/dm/field/impls/ds/dmfieldds.c (revision 1baa6e3354bfe224b33a0c158f482508792a8a6e)
151a454edSToby Isaac #include <petsc/private/dmfieldimpl.h> /*I "petscdmfield.h" I*/
20145028aSToby Isaac #include <petsc/private/petscfeimpl.h> /*I "petscdmfield.h" I*/
351a454edSToby Isaac #include <petscfe.h>
451a454edSToby Isaac #include <petscdmplex.h>
551a454edSToby Isaac #include <petscds.h>
651a454edSToby Isaac 
751a454edSToby Isaac typedef struct _n_DMField_DS
851a454edSToby Isaac {
951a454edSToby Isaac   PetscInt    fieldNum;
1051a454edSToby Isaac   Vec         vec;
1151a454edSToby Isaac   PetscInt    height;
1251a454edSToby Isaac   PetscObject *disc;
1351a454edSToby Isaac   PetscBool   multifieldVec;
1451a454edSToby Isaac }
1551a454edSToby Isaac DMField_DS;
1651a454edSToby Isaac 
1751a454edSToby Isaac static PetscErrorCode DMFieldDestroy_DS(DMField field)
1851a454edSToby Isaac {
1951a454edSToby Isaac   DMField_DS     *dsfield;
2051a454edSToby Isaac   PetscInt       i;
2151a454edSToby Isaac 
2251a454edSToby Isaac   PetscFunctionBegin;
2351a454edSToby Isaac   dsfield = (DMField_DS *) field->data;
249566063dSJacob Faibussowitsch   PetscCall(VecDestroy(&dsfield->vec));
2551a454edSToby Isaac   for (i = 0; i < dsfield->height; i++) {
269566063dSJacob Faibussowitsch     PetscCall(PetscObjectDereference(dsfield->disc[i]));
2751a454edSToby Isaac   }
289566063dSJacob Faibussowitsch   PetscCall(PetscFree(dsfield->disc));
299566063dSJacob Faibussowitsch   PetscCall(PetscFree(dsfield));
3051a454edSToby Isaac   PetscFunctionReturn(0);
3151a454edSToby Isaac }
3251a454edSToby Isaac 
3351a454edSToby Isaac static PetscErrorCode DMFieldView_DS(DMField field,PetscViewer viewer)
3451a454edSToby Isaac {
3551a454edSToby Isaac   DMField_DS     *dsfield = (DMField_DS *) field->data;
3651a454edSToby Isaac   PetscBool      iascii;
3751a454edSToby Isaac   PetscObject    disc;
3851a454edSToby Isaac 
3951a454edSToby Isaac   PetscFunctionBegin;
409566063dSJacob Faibussowitsch   PetscCall(PetscObjectTypeCompare((PetscObject)viewer,PETSCVIEWERASCII,&iascii));
4151a454edSToby Isaac   disc = dsfield->disc[0];
4251a454edSToby Isaac   if (iascii) {
4363a3b9bcSJacob Faibussowitsch     PetscCall(PetscViewerASCIIPrintf(viewer, "PetscDS field %" PetscInt_FMT "\n",dsfield->fieldNum));
449566063dSJacob Faibussowitsch     PetscCall(PetscViewerASCIIPushTab(viewer));
459566063dSJacob Faibussowitsch     PetscCall(PetscObjectView(disc,viewer));
469566063dSJacob Faibussowitsch     PetscCall(PetscViewerASCIIPopTab(viewer));
4751a454edSToby Isaac   }
489566063dSJacob Faibussowitsch   PetscCall(PetscViewerASCIIPushTab(viewer));
4928b400f6SJacob Faibussowitsch   PetscCheck(!dsfield->multifieldVec,PetscObjectComm((PetscObject)field),PETSC_ERR_SUP,"View of subfield not implemented yet");
509566063dSJacob Faibussowitsch   PetscCall(VecView(dsfield->vec,viewer));
519566063dSJacob Faibussowitsch   PetscCall(PetscViewerASCIIPopTab(viewer));
5251a454edSToby Isaac   PetscFunctionReturn(0);
5351a454edSToby Isaac }
5451a454edSToby Isaac 
5551a454edSToby Isaac static PetscErrorCode DMFieldDSGetHeightDisc(DMField field, PetscInt height, PetscObject *disc)
5651a454edSToby Isaac {
5751a454edSToby Isaac   DMField_DS     *dsfield = (DMField_DS *) field->data;
5851a454edSToby Isaac 
5951a454edSToby Isaac   PetscFunctionBegin;
6051a454edSToby Isaac   if (!dsfield->disc[height]) {
6151a454edSToby Isaac     PetscClassId   id;
6251a454edSToby Isaac 
639566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(dsfield->disc[0],&id));
6451a454edSToby Isaac     if (id == PETSCFE_CLASSID) {
6551a454edSToby Isaac       PetscFE fe = (PetscFE) dsfield->disc[0];
6651a454edSToby Isaac 
679566063dSJacob Faibussowitsch       PetscCall(PetscFECreateHeightTrace(fe,height,(PetscFE *)&dsfield->disc[height]));
6851a454edSToby Isaac     }
6951a454edSToby Isaac   }
7051a454edSToby Isaac   *disc = dsfield->disc[height];
7151a454edSToby Isaac   PetscFunctionReturn(0);
7251a454edSToby Isaac }
7351a454edSToby Isaac 
7462bd480fSMatthew G. Knepley /* y[m,c] = A[m,n,c] . b[n] */
7551a454edSToby Isaac #define DMFieldDSdot(y,A,b,m,n,c,cast)                                           \
7651a454edSToby Isaac   do {                                                                           \
7751a454edSToby Isaac     PetscInt _i, _j, _k;                                                         \
7851a454edSToby Isaac     for (_i = 0; _i < (m); _i++) {                                               \
7951a454edSToby Isaac       for (_k = 0; _k < (c); _k++) {                                             \
8051a454edSToby Isaac         (y)[_i * (c) + _k] = 0.;                                                 \
8151a454edSToby Isaac       }                                                                          \
8251a454edSToby Isaac       for (_j = 0; _j < (n); _j++) {                                             \
8351a454edSToby Isaac         for (_k = 0; _k < (c); _k++) {                                           \
8451a454edSToby Isaac           (y)[_i * (c) + _k] += (A)[(_i * (n) + _j) * (c) + _k] * cast((b)[_j]); \
8551a454edSToby Isaac         }                                                                        \
8651a454edSToby Isaac       }                                                                          \
8751a454edSToby Isaac     }                                                                            \
8851a454edSToby Isaac   } while (0)
8951a454edSToby Isaac 
90ef0bb6c7SMatthew G. Knepley /* TODO: Reorganize interface so that I can reuse a tabulation rather than mallocing each time */
9151a454edSToby Isaac static PetscErrorCode DMFieldEvaluateFE_DS(DMField field, IS pointIS, PetscQuadrature quad, PetscDataType type, void *B, void *D, void *H)
9251a454edSToby Isaac {
9351a454edSToby Isaac   DMField_DS      *dsfield = (DMField_DS *) field->data;
9451a454edSToby Isaac   DM              dm;
9551a454edSToby Isaac   PetscObject     disc;
9651a454edSToby Isaac   PetscClassId    classid;
9751a454edSToby Isaac   PetscInt        nq, nc, dim, meshDim, numCells;
9851a454edSToby Isaac   PetscSection    section;
9951a454edSToby Isaac   const PetscReal *qpoints;
10051a454edSToby Isaac   PetscBool       isStride;
10151a454edSToby Isaac   const PetscInt  *points = NULL;
10251a454edSToby Isaac   PetscInt        sfirst = -1, stride = -1;
10351a454edSToby Isaac 
10451a454edSToby Isaac   PetscFunctionBeginHot;
10551a454edSToby Isaac   dm   = field->dm;
10651a454edSToby Isaac   nc   = field->numComponents;
1079566063dSJacob Faibussowitsch   PetscCall(PetscQuadratureGetData(quad,&dim,NULL,&nq,&qpoints,NULL));
1089566063dSJacob Faibussowitsch   PetscCall(DMFieldDSGetHeightDisc(field,dsfield->height - 1 - dim,&disc));
1099566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm,&meshDim));
1109566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm,&section));
1119566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetField(section,dsfield->fieldNum,&section));
1129566063dSJacob Faibussowitsch   PetscCall(PetscObjectGetClassId(disc,&classid));
11351a454edSToby Isaac   /* TODO: batch */
1149566063dSJacob Faibussowitsch   PetscCall(PetscObjectTypeCompare((PetscObject)pointIS,ISSTRIDE,&isStride));
1159566063dSJacob Faibussowitsch   PetscCall(ISGetLocalSize(pointIS,&numCells));
116*1baa6e33SBarry Smith   if (isStride) PetscCall(ISStrideGetInfo(pointIS,&sfirst,&stride));
117*1baa6e33SBarry Smith   else PetscCall(ISGetIndices(pointIS,&points));
11851a454edSToby Isaac   if (classid == PETSCFE_CLASSID) {
11951a454edSToby Isaac     PetscFE      fe = (PetscFE) disc;
12051a454edSToby Isaac     PetscInt     feDim, i;
121ef0bb6c7SMatthew G. Knepley     PetscInt          K = H ? 2 : (D ? 1 : (B ? 0 : -1));
122ef0bb6c7SMatthew G. Knepley     PetscTabulation   T;
12351a454edSToby Isaac 
1249566063dSJacob Faibussowitsch     PetscCall(PetscFEGetDimension(fe,&feDim));
1259566063dSJacob Faibussowitsch     PetscCall(PetscFECreateTabulation(fe,1,nq,qpoints,K,&T));
12651a454edSToby Isaac     for (i = 0; i < numCells; i++) {
12751a454edSToby Isaac       PetscInt     c = isStride ? (sfirst + i * stride) : points[i];
1282710589cSToby Isaac       PetscInt     closureSize;
1292710589cSToby Isaac       PetscScalar *elem = NULL;
13051a454edSToby Isaac 
1319566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(dm,section,dsfield->vec,c,&closureSize,&elem));
13251a454edSToby Isaac       if (B) {
13362bd480fSMatthew G. Knepley         /* field[c] = T[q,b,c] . coef[b], so v[c] = T[q,b,c] . coords[b] */
13451a454edSToby Isaac         if (type == PETSC_SCALAR) {
13551a454edSToby Isaac           PetscScalar *cB = &((PetscScalar *) B)[nc * nq * i];
13651a454edSToby Isaac 
137ef0bb6c7SMatthew G. Knepley           DMFieldDSdot(cB,T->T[0],elem,nq,feDim,nc,(PetscScalar));
13851a454edSToby Isaac         } else {
13951a454edSToby Isaac           PetscReal *cB = &((PetscReal *) B)[nc * nq * i];
14051a454edSToby Isaac 
141ef0bb6c7SMatthew G. Knepley           DMFieldDSdot(cB,T->T[0],elem,nq,feDim,nc,PetscRealPart);
14251a454edSToby Isaac         }
14351a454edSToby Isaac       }
14451a454edSToby Isaac       if (D) {
14551a454edSToby Isaac         if (type == PETSC_SCALAR) {
14651a454edSToby Isaac           PetscScalar *cD = &((PetscScalar *) D)[nc * nq * dim * i];
14751a454edSToby Isaac 
148ef0bb6c7SMatthew G. Knepley           DMFieldDSdot(cD,T->T[1],elem,nq,feDim,(nc * dim),(PetscScalar));
14951a454edSToby Isaac         } else {
15051a454edSToby Isaac           PetscReal *cD = &((PetscReal *) D)[nc * nq * dim * i];
15151a454edSToby Isaac 
152ef0bb6c7SMatthew G. Knepley           DMFieldDSdot(cD,T->T[1],elem,nq,feDim,(nc * dim),PetscRealPart);
15351a454edSToby Isaac         }
15451a454edSToby Isaac       }
15551a454edSToby Isaac       if (H) {
15651a454edSToby Isaac         if (type == PETSC_SCALAR) {
15751a454edSToby Isaac           PetscScalar *cH = &((PetscScalar *) H)[nc * nq * dim * dim * i];
15851a454edSToby Isaac 
159ef0bb6c7SMatthew G. Knepley           DMFieldDSdot(cH,T->T[2],elem,nq,feDim,(nc * dim * dim),(PetscScalar));
16051a454edSToby Isaac         } else {
16151a454edSToby Isaac           PetscReal *cH = &((PetscReal *) H)[nc * nq * dim * dim * i];
16251a454edSToby Isaac 
163ef0bb6c7SMatthew G. Knepley           DMFieldDSdot(cH,T->T[2],elem,nq,feDim,(nc * dim * dim),PetscRealPart);
16451a454edSToby Isaac         }
16551a454edSToby Isaac       }
1669566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(dm,section,dsfield->vec,c,&closureSize,&elem));
16751a454edSToby Isaac     }
1689566063dSJacob Faibussowitsch     PetscCall(PetscTabulationDestroy(&T));
1692da392ccSBarry Smith   } else SETERRQ(PetscObjectComm((PetscObject)field),PETSC_ERR_SUP,"Not implemented");
17051a454edSToby Isaac   if (!isStride) {
1719566063dSJacob Faibussowitsch     PetscCall(ISRestoreIndices(pointIS,&points));
17251a454edSToby Isaac   }
17351a454edSToby Isaac   PetscFunctionReturn(0);
17451a454edSToby Isaac }
17551a454edSToby Isaac 
176a6216909SToby Isaac static PetscErrorCode DMFieldEvaluate_DS(DMField field, Vec points, PetscDataType datatype, void *B, void *D, void *H)
177a6216909SToby Isaac {
178a6216909SToby Isaac   DMField_DS        *dsfield = (DMField_DS *) field->data;
179a6216909SToby Isaac   PetscSF            cellSF = NULL;
180a6216909SToby Isaac   const PetscSFNode *cells;
181a6216909SToby Isaac   PetscInt           c, nFound, numCells, feDim, nc;
182a6216909SToby Isaac   const PetscInt    *cellDegrees;
183a6216909SToby Isaac   const PetscScalar *pointsArray;
184a6216909SToby Isaac   PetscScalar       *cellPoints;
185a6216909SToby Isaac   PetscInt           gatherSize, gatherMax;
186a6216909SToby Isaac   PetscInt           dim, dimR, offset;
187a6216909SToby Isaac   MPI_Datatype       pointType;
188a6216909SToby Isaac   PetscObject        cellDisc;
189a6216909SToby Isaac   PetscFE            cellFE;
190a6216909SToby Isaac   PetscClassId       discID;
191a6216909SToby Isaac   PetscReal         *coordsReal, *coordsRef;
192a6216909SToby Isaac   PetscSection       section;
193a6216909SToby Isaac   PetscScalar       *cellBs = NULL, *cellDs = NULL, *cellHs = NULL;
194a6216909SToby Isaac   PetscReal         *cellBr = NULL, *cellDr = NULL, *cellHr = NULL;
1954cbe5319SToby Isaac   PetscReal         *v, *J, *invJ, *detJ;
196a6216909SToby Isaac 
197a6216909SToby Isaac   PetscFunctionBegin;
198a6216909SToby Isaac   nc   = field->numComponents;
1999566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(field->dm,&section));
2009566063dSJacob Faibussowitsch   PetscCall(DMFieldDSGetHeightDisc(field,0,&cellDisc));
2019566063dSJacob Faibussowitsch   PetscCall(PetscObjectGetClassId(cellDisc, &discID));
20208401ef6SPierre Jolivet   PetscCheck(discID == PETSCFE_CLASSID,PETSC_COMM_SELF,PETSC_ERR_PLIB, "Discretization type not supported");
203a6216909SToby Isaac   cellFE = (PetscFE) cellDisc;
2049566063dSJacob Faibussowitsch   PetscCall(PetscFEGetDimension(cellFE,&feDim));
2059566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateDim(field->dm, &dim));
2069566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(field->dm, &dimR));
2079566063dSJacob Faibussowitsch   PetscCall(DMLocatePoints(field->dm, points, DM_POINTLOCATION_NONE, &cellSF));
2089566063dSJacob Faibussowitsch   PetscCall(PetscSFGetGraph(cellSF, &numCells, &nFound, NULL, &cells));
209a6216909SToby Isaac   for (c = 0; c < nFound; c++) {
21063a3b9bcSJacob Faibussowitsch     PetscCheck(cells[c].index >= 0,PetscObjectComm((PetscObject)points),PETSC_ERR_ARG_WRONG, "Point %" PetscInt_FMT " could not be located", c);
211a6216909SToby Isaac   }
2129566063dSJacob Faibussowitsch   PetscCall(PetscSFComputeDegreeBegin(cellSF,&cellDegrees));
2139566063dSJacob Faibussowitsch   PetscCall(PetscSFComputeDegreeEnd(cellSF,&cellDegrees));
214a6216909SToby Isaac   for (c = 0, gatherSize = 0, gatherMax = 0; c < numCells; c++) {
215a6216909SToby Isaac     gatherMax = PetscMax(gatherMax,cellDegrees[c]);
216a6216909SToby Isaac     gatherSize += cellDegrees[c];
217a6216909SToby Isaac   }
2189566063dSJacob Faibussowitsch   PetscCall(PetscMalloc3(gatherSize*dim,&cellPoints,gatherMax*dim,&coordsReal,gatherMax*dimR,&coordsRef));
2199566063dSJacob Faibussowitsch   PetscCall(PetscMalloc4(gatherMax*dimR,&v,gatherMax*dimR*dimR,&J,gatherMax*dimR*dimR,&invJ,gatherMax,&detJ));
220*1baa6e33SBarry Smith   if (datatype == PETSC_SCALAR) PetscCall(PetscMalloc3(B ? nc * gatherSize : 0, &cellBs, D ? nc * dim * gatherSize : 0, &cellDs, H ? nc * dim * dim * gatherSize : 0, &cellHs));
221*1baa6e33SBarry Smith   else PetscCall(PetscMalloc3(B ? nc * gatherSize : 0, &cellBr, D ? nc * dim * gatherSize : 0, &cellDr, H ? nc * dim * dim * gatherSize : 0, &cellHr));
222a6216909SToby Isaac 
2239566063dSJacob Faibussowitsch   PetscCallMPI(MPI_Type_contiguous(dim,MPIU_SCALAR,&pointType));
2249566063dSJacob Faibussowitsch   PetscCallMPI(MPI_Type_commit(&pointType));
2259566063dSJacob Faibussowitsch   PetscCall(VecGetArrayRead(points,&pointsArray));
2269566063dSJacob Faibussowitsch   PetscCall(PetscSFGatherBegin(cellSF, pointType, pointsArray, cellPoints));
2279566063dSJacob Faibussowitsch   PetscCall(PetscSFGatherEnd(cellSF, pointType, pointsArray, cellPoints));
2289566063dSJacob Faibussowitsch   PetscCall(VecRestoreArrayRead(points,&pointsArray));
229a6216909SToby Isaac   for (c = 0, offset = 0; c < numCells; c++) {
230a6216909SToby Isaac     PetscInt nq = cellDegrees[c], p;
231a6216909SToby Isaac 
232a6216909SToby Isaac     if (nq) {
233ef0bb6c7SMatthew G. Knepley       PetscInt          K = H ? 2 : (D ? 1 : (B ? 0 : -1));
234ef0bb6c7SMatthew G. Knepley       PetscTabulation   T;
235a6216909SToby Isaac       PetscInt     closureSize;
236a6216909SToby Isaac       PetscScalar *elem = NULL;
2374cbe5319SToby Isaac       PetscReal   *quadPoints;
2384cbe5319SToby Isaac       PetscQuadrature quad;
2394cbe5319SToby Isaac       PetscInt d, e, f, g;
240a6216909SToby Isaac 
2414d1a973fSToby Isaac       for (p = 0; p < dim * nq; p++) coordsReal[p] = PetscRealPart(cellPoints[dim * offset + p]);
2429566063dSJacob Faibussowitsch       PetscCall(DMPlexCoordinatesToReference(field->dm, c, nq, coordsReal, coordsRef));
2439566063dSJacob Faibussowitsch       PetscCall(PetscFECreateTabulation(cellFE,1,nq,coordsRef,K,&T));
2449566063dSJacob Faibussowitsch       PetscCall(PetscQuadratureCreate(PETSC_COMM_SELF, &quad));
2459566063dSJacob Faibussowitsch       PetscCall(PetscMalloc1(dimR * nq, &quadPoints));
2464cbe5319SToby Isaac       for (p = 0; p < dimR * nq; p++) quadPoints[p] = coordsRef[p];
2479566063dSJacob Faibussowitsch       PetscCall(PetscQuadratureSetData(quad, dimR, 0, nq, quadPoints, NULL));
2489566063dSJacob Faibussowitsch       PetscCall(DMPlexComputeCellGeometryFEM(field->dm, c, quad, v, J, invJ, detJ));
2499566063dSJacob Faibussowitsch       PetscCall(PetscQuadratureDestroy(&quad));
2509566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(field->dm,section,dsfield->vec,c,&closureSize,&elem));
251a6216909SToby Isaac       if (B) {
252a6216909SToby Isaac         if (datatype == PETSC_SCALAR) {
253a6216909SToby Isaac           PetscScalar *cB = &cellBs[nc * offset];
254a6216909SToby Isaac 
255ef0bb6c7SMatthew G. Knepley           DMFieldDSdot(cB,T->T[0],elem,nq,feDim,nc,(PetscScalar));
256a6216909SToby Isaac         } else {
257a6216909SToby Isaac           PetscReal *cB = &cellBr[nc * offset];
258a6216909SToby Isaac 
259ef0bb6c7SMatthew G. Knepley           DMFieldDSdot(cB,T->T[0],elem,nq,feDim,nc,PetscRealPart);
260a6216909SToby Isaac         }
261a6216909SToby Isaac       }
262a6216909SToby Isaac       if (D) {
263a6216909SToby Isaac         if (datatype == PETSC_SCALAR) {
264a6216909SToby Isaac           PetscScalar *cD = &cellDs[nc * dim * offset];
265a6216909SToby Isaac 
266ef0bb6c7SMatthew G. Knepley           DMFieldDSdot(cD,T->T[1],elem,nq,feDim,(nc * dim),(PetscScalar));
2674cbe5319SToby Isaac           for (p = 0; p < nq; p++) {
2684cbe5319SToby Isaac             for (g = 0; g < nc; g++) {
2694d1a973fSToby Isaac               PetscScalar vs[3];
2704d1a973fSToby Isaac 
2714cbe5319SToby Isaac               for (d = 0; d < dimR; d++) {
2724d1a973fSToby Isaac                 vs[d] = 0.;
2734cbe5319SToby Isaac                 for (e = 0; e < dimR; e++) {
2744d1a973fSToby Isaac                   vs[d] += invJ[dimR * dimR * p + e * dimR + d] * cD[(nc * p + g) * dimR + e];
2754cbe5319SToby Isaac                 }
2764cbe5319SToby Isaac               }
2774cbe5319SToby Isaac               for (d = 0; d < dimR; d++) {
2784d1a973fSToby Isaac                 cD[(nc * p + g) * dimR + d] = vs[d];
2794cbe5319SToby Isaac               }
2804cbe5319SToby Isaac             }
2814cbe5319SToby Isaac           }
282a6216909SToby Isaac         } else {
283a6216909SToby Isaac           PetscReal *cD = &cellDr[nc * dim * offset];
284a6216909SToby Isaac 
285ef0bb6c7SMatthew G. Knepley           DMFieldDSdot(cD,T->T[1],elem,nq,feDim,(nc * dim),PetscRealPart);
2864cbe5319SToby Isaac           for (p = 0; p < nq; p++) {
2874cbe5319SToby Isaac             for (g = 0; g < nc; g++) {
2884cbe5319SToby Isaac               for (d = 0; d < dimR; d++) {
2894cbe5319SToby Isaac                 v[d] = 0.;
2904cbe5319SToby Isaac                 for (e = 0; e < dimR; e++) {
2914cbe5319SToby Isaac                   v[d] += invJ[dimR * dimR * p + e * dimR + d] * cD[(nc * p + g) * dimR + e];
2924cbe5319SToby Isaac                 }
2934cbe5319SToby Isaac               }
2944cbe5319SToby Isaac               for (d = 0; d < dimR; d++) {
2954cbe5319SToby Isaac                 cD[(nc * p + g) * dimR + d] = v[d];
2964cbe5319SToby Isaac               }
2974cbe5319SToby Isaac             }
2984cbe5319SToby Isaac           }
299a6216909SToby Isaac         }
300a6216909SToby Isaac       }
301a6216909SToby Isaac       if (H) {
302a6216909SToby Isaac         if (datatype == PETSC_SCALAR) {
303a6216909SToby Isaac           PetscScalar *cH = &cellHs[nc * dim * dim * offset];
304a6216909SToby Isaac 
305ef0bb6c7SMatthew G. Knepley           DMFieldDSdot(cH,T->T[2],elem,nq,feDim,(nc * dim * dim),(PetscScalar));
3064cbe5319SToby Isaac           for (p = 0; p < nq; p++) {
3074cbe5319SToby Isaac             for (g = 0; g < nc * dimR; g++) {
3084d1a973fSToby Isaac               PetscScalar vs[3];
3094d1a973fSToby Isaac 
3104cbe5319SToby Isaac               for (d = 0; d < dimR; d++) {
3114d1a973fSToby Isaac                 vs[d] = 0.;
3124cbe5319SToby Isaac                 for (e = 0; e < dimR; e++) {
3134d1a973fSToby Isaac                   vs[d] += invJ[dimR * dimR * p + e * dimR + d] * cH[(nc * dimR * p + g) * dimR + e];
3144cbe5319SToby Isaac                 }
3154cbe5319SToby Isaac               }
3164cbe5319SToby Isaac               for (d = 0; d < dimR; d++) {
3174d1a973fSToby Isaac                 cH[(nc * dimR * p + g) * dimR + d] = vs[d];
3184cbe5319SToby Isaac               }
3194cbe5319SToby Isaac             }
3204cbe5319SToby Isaac             for (g = 0; g < nc; g++) {
3214cbe5319SToby Isaac               for (f = 0; f < dimR; f++) {
3224d1a973fSToby Isaac                 PetscScalar vs[3];
3234d1a973fSToby Isaac 
3244cbe5319SToby Isaac                 for (d = 0; d < dimR; d++) {
3254d1a973fSToby Isaac                   vs[d] = 0.;
3264cbe5319SToby Isaac                   for (e = 0; e < dimR; e++) {
3274d1a973fSToby Isaac                     vs[d] += invJ[dimR * dimR * p + e * dimR + d] * cH[((nc * p + g) * dimR + e) * dimR + f];
3284cbe5319SToby Isaac                   }
3294cbe5319SToby Isaac                 }
3304cbe5319SToby Isaac                 for (d = 0; d < dimR; d++) {
3314d1a973fSToby Isaac                   cH[((nc * p + g) * dimR + d) * dimR + f] = vs[d];
3324cbe5319SToby Isaac                 }
3334cbe5319SToby Isaac               }
3344cbe5319SToby Isaac             }
3354cbe5319SToby Isaac           }
336a6216909SToby Isaac         } else {
337a6216909SToby Isaac           PetscReal *cH = &cellHr[nc * dim * dim * offset];
338a6216909SToby Isaac 
339ef0bb6c7SMatthew G. Knepley           DMFieldDSdot(cH,T->T[2],elem,nq,feDim,(nc * dim * dim),PetscRealPart);
3404cbe5319SToby Isaac           for (p = 0; p < nq; p++) {
3414cbe5319SToby Isaac             for (g = 0; g < nc * dimR; g++) {
3424cbe5319SToby Isaac               for (d = 0; d < dimR; d++) {
3434cbe5319SToby Isaac                 v[d] = 0.;
3444cbe5319SToby Isaac                 for (e = 0; e < dimR; e++) {
3454cbe5319SToby Isaac                   v[d] += invJ[dimR * dimR * p + e * dimR + d] * cH[(nc * dimR * p + g) * dimR + e];
3464cbe5319SToby Isaac                 }
3474cbe5319SToby Isaac               }
3484cbe5319SToby Isaac               for (d = 0; d < dimR; d++) {
3494cbe5319SToby Isaac                 cH[(nc * dimR * p + g) * dimR + d] = v[d];
3504cbe5319SToby Isaac               }
3514cbe5319SToby Isaac             }
3524cbe5319SToby Isaac             for (g = 0; g < nc; g++) {
3534cbe5319SToby Isaac               for (f = 0; f < dimR; f++) {
3544cbe5319SToby Isaac                 for (d = 0; d < dimR; d++) {
3554cbe5319SToby Isaac                   v[d] = 0.;
3564cbe5319SToby Isaac                   for (e = 0; e < dimR; e++) {
3574cbe5319SToby Isaac                     v[d] += invJ[dimR * dimR * p + e * dimR + d] * cH[((nc * p + g) * dimR + e) * dimR + f];
3584cbe5319SToby Isaac                   }
3594cbe5319SToby Isaac                 }
3604cbe5319SToby Isaac                 for (d = 0; d < dimR; d++) {
3614cbe5319SToby Isaac                   cH[((nc * p + g) * dimR + d) * dimR + f] = v[d];
3624cbe5319SToby Isaac                 }
3634cbe5319SToby Isaac               }
3644cbe5319SToby Isaac             }
3654cbe5319SToby Isaac           }
366a6216909SToby Isaac         }
367a6216909SToby Isaac       }
3689566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(field->dm,section,dsfield->vec,c,&closureSize,&elem));
3699566063dSJacob Faibussowitsch       PetscCall(PetscTabulationDestroy(&T));
370a6216909SToby Isaac     }
371a6216909SToby Isaac     offset += nq;
372a6216909SToby Isaac   }
373a6216909SToby Isaac   {
374a6216909SToby Isaac     MPI_Datatype origtype;
3754cbe5319SToby Isaac 
376a6216909SToby Isaac     if (datatype == PETSC_SCALAR) {
377a6216909SToby Isaac       origtype = MPIU_SCALAR;
378a6216909SToby Isaac     } else {
379a6216909SToby Isaac       origtype = MPIU_REAL;
380a6216909SToby Isaac     }
381a6216909SToby Isaac     if (B) {
382a6216909SToby Isaac       MPI_Datatype Btype;
383a6216909SToby Isaac 
3849566063dSJacob Faibussowitsch       PetscCallMPI(MPI_Type_contiguous(nc, origtype, &Btype));
3859566063dSJacob Faibussowitsch       PetscCallMPI(MPI_Type_commit(&Btype));
3869566063dSJacob Faibussowitsch       PetscCall(PetscSFScatterBegin(cellSF,Btype,(datatype == PETSC_SCALAR) ? (void *) cellBs : (void *) cellBr, B));
3879566063dSJacob Faibussowitsch       PetscCall(PetscSFScatterEnd(cellSF,Btype,(datatype == PETSC_SCALAR) ? (void *) cellBs : (void *) cellBr, B));
3889566063dSJacob Faibussowitsch       PetscCallMPI(MPI_Type_free(&Btype));
389a6216909SToby Isaac     }
390a6216909SToby Isaac     if (D) {
391a6216909SToby Isaac       MPI_Datatype Dtype;
392a6216909SToby Isaac 
3939566063dSJacob Faibussowitsch       PetscCallMPI(MPI_Type_contiguous(nc * dim, origtype, &Dtype));
3949566063dSJacob Faibussowitsch       PetscCallMPI(MPI_Type_commit(&Dtype));
3959566063dSJacob Faibussowitsch       PetscCall(PetscSFScatterBegin(cellSF,Dtype,(datatype == PETSC_SCALAR) ? (void *) cellDs : (void *) cellDr, D));
3969566063dSJacob Faibussowitsch       PetscCall(PetscSFScatterEnd(cellSF,Dtype,(datatype == PETSC_SCALAR) ? (void *) cellDs : (void *) cellDr, D));
3979566063dSJacob Faibussowitsch       PetscCallMPI(MPI_Type_free(&Dtype));
398a6216909SToby Isaac     }
399a6216909SToby Isaac     if (H) {
400a6216909SToby Isaac       MPI_Datatype Htype;
401a6216909SToby Isaac 
4029566063dSJacob Faibussowitsch       PetscCallMPI(MPI_Type_contiguous(nc * dim * dim, origtype, &Htype));
4039566063dSJacob Faibussowitsch       PetscCallMPI(MPI_Type_commit(&Htype));
4049566063dSJacob Faibussowitsch       PetscCall(PetscSFScatterBegin(cellSF,Htype,(datatype == PETSC_SCALAR) ? (void *) cellHs : (void *) cellHr, H));
4059566063dSJacob Faibussowitsch       PetscCall(PetscSFScatterEnd(cellSF,Htype,(datatype == PETSC_SCALAR) ? (void *) cellHs : (void *) cellHr, H));
4069566063dSJacob Faibussowitsch       PetscCallMPI(MPI_Type_free(&Htype));
407a6216909SToby Isaac     }
408a6216909SToby Isaac   }
4099566063dSJacob Faibussowitsch   PetscCall(PetscFree4(v,J,invJ,detJ));
4109566063dSJacob Faibussowitsch   PetscCall(PetscFree3(cellBr, cellDr, cellHr));
4119566063dSJacob Faibussowitsch   PetscCall(PetscFree3(cellBs, cellDs, cellHs));
4129566063dSJacob Faibussowitsch   PetscCall(PetscFree3(cellPoints,coordsReal,coordsRef));
4139566063dSJacob Faibussowitsch   PetscCallMPI(MPI_Type_free(&pointType));
4149566063dSJacob Faibussowitsch   PetscCall(PetscSFDestroy(&cellSF));
415a6216909SToby Isaac   PetscFunctionReturn(0);
416a6216909SToby Isaac }
417a6216909SToby Isaac 
418805e7170SToby Isaac static PetscErrorCode DMFieldEvaluateFV_DS(DMField field, IS pointIS, PetscDataType type, void *B, void *D, void *H)
419805e7170SToby Isaac {
420805e7170SToby Isaac   DMField_DS      *dsfield = (DMField_DS *) field->data;
421805e7170SToby Isaac   PetscInt         h, imin;
422805e7170SToby Isaac   PetscInt         dim;
423805e7170SToby Isaac   PetscClassId     id;
424805e7170SToby Isaac   PetscQuadrature  quad = NULL;
425b7260050SToby Isaac   PetscInt         maxDegree;
426805e7170SToby Isaac   PetscFEGeom      *geom;
427805e7170SToby Isaac   PetscInt         Nq, Nc, dimC, qNc, N;
428805e7170SToby Isaac   PetscInt         numPoints;
429805e7170SToby Isaac   void            *qB = NULL, *qD = NULL, *qH = NULL;
430805e7170SToby Isaac   const PetscReal *weights;
431805e7170SToby Isaac   MPI_Datatype     mpitype = type == PETSC_SCALAR ? MPIU_SCALAR : MPIU_REAL;
432805e7170SToby Isaac   PetscObject      disc;
433805e7170SToby Isaac   DMField          coordField;
434805e7170SToby Isaac 
435805e7170SToby Isaac   PetscFunctionBegin;
436805e7170SToby Isaac   Nc = field->numComponents;
4379566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateDim(field->dm, &dimC));
4389566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(field->dm, &dim));
4399566063dSJacob Faibussowitsch   PetscCall(ISGetLocalSize(pointIS, &numPoints));
4409566063dSJacob Faibussowitsch   PetscCall(ISGetMinMax(pointIS,&imin,NULL));
441805e7170SToby Isaac   for (h = 0; h < dsfield->height; h++) {
442805e7170SToby Isaac     PetscInt hEnd;
443805e7170SToby Isaac 
4449566063dSJacob Faibussowitsch     PetscCall(DMPlexGetHeightStratum(field->dm,h,NULL,&hEnd));
445805e7170SToby Isaac     if (imin < hEnd) break;
446805e7170SToby Isaac   }
447805e7170SToby Isaac   dim -= h;
4489566063dSJacob Faibussowitsch   PetscCall(DMFieldDSGetHeightDisc(field,h,&disc));
4499566063dSJacob Faibussowitsch   PetscCall(PetscObjectGetClassId(disc,&id));
45008401ef6SPierre Jolivet   PetscCheck(id == PETSCFE_CLASSID,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Discretization not supported");
4519566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateField(field->dm, &coordField));
4529566063dSJacob Faibussowitsch   PetscCall(DMFieldGetDegree(coordField, pointIS, NULL, &maxDegree));
453b7260050SToby Isaac   if (maxDegree <= 1) {
4549566063dSJacob Faibussowitsch     PetscCall(DMFieldCreateDefaultQuadrature(coordField, pointIS, &quad));
455805e7170SToby Isaac   }
4569566063dSJacob Faibussowitsch   if (!quad) PetscCall(DMFieldCreateDefaultQuadrature(field, pointIS, &quad));
45728b400f6SJacob Faibussowitsch   PetscCheck(quad,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Could not determine quadrature for cell averages");
4589566063dSJacob Faibussowitsch   PetscCall(DMFieldCreateFEGeom(coordField,pointIS,quad,PETSC_FALSE,&geom));
4599566063dSJacob Faibussowitsch   PetscCall(PetscQuadratureGetData(quad, NULL, &qNc, &Nq, NULL, &weights));
46008401ef6SPierre Jolivet   PetscCheck(qNc == 1,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Expected scalar quadrature components");
461805e7170SToby Isaac   N = numPoints * Nq * Nc;
4629566063dSJacob Faibussowitsch   if (B) PetscCall(DMGetWorkArray(field->dm, N, mpitype, &qB));
4639566063dSJacob Faibussowitsch   if (D) PetscCall(DMGetWorkArray(field->dm, N * dimC, mpitype, &qD));
4649566063dSJacob Faibussowitsch   if (H) PetscCall(DMGetWorkArray(field->dm, N * dimC * dimC, mpitype, &qH));
4659566063dSJacob Faibussowitsch   PetscCall(DMFieldEvaluateFE(field,pointIS,quad,type,qB,qD,qH));
466805e7170SToby Isaac   if (B) {
467805e7170SToby Isaac     PetscInt i, j, k;
468805e7170SToby Isaac 
469805e7170SToby Isaac     if (type == PETSC_SCALAR) {
470805e7170SToby Isaac       PetscScalar * sB  = (PetscScalar *) B;
471805e7170SToby Isaac       PetscScalar * sqB = (PetscScalar *) qB;
472805e7170SToby Isaac 
473805e7170SToby Isaac       for (i = 0; i < numPoints; i++) {
474805e7170SToby Isaac         PetscReal vol = 0.;
475805e7170SToby Isaac 
476805e7170SToby Isaac         for (j = 0; j < Nc; j++) {sB[i * Nc + j] = 0.;}
477805e7170SToby Isaac         for (k = 0; k < Nq; k++) {
478805e7170SToby Isaac           vol += geom->detJ[i * Nq + k] * weights[k];
479805e7170SToby Isaac           for (j = 0; j < Nc; j++) {
480805e7170SToby Isaac             sB[i * Nc + j] += geom->detJ[i * Nq + k] * weights[k] * sqB[ (i * Nq + k) * Nc + j];
481805e7170SToby Isaac           }
482805e7170SToby Isaac         }
48362bd480fSMatthew G. Knepley         for (k = 0; k < Nc; k++) sB[i * Nc + k] /= vol;
484805e7170SToby Isaac       }
485805e7170SToby Isaac     } else {
486805e7170SToby Isaac       PetscReal * rB  = (PetscReal *) B;
487805e7170SToby Isaac       PetscReal * rqB = (PetscReal *) qB;
488805e7170SToby Isaac 
489805e7170SToby Isaac       for (i = 0; i < numPoints; i++) {
490805e7170SToby Isaac         PetscReal vol = 0.;
491805e7170SToby Isaac 
492805e7170SToby Isaac         for (j = 0; j < Nc; j++) {rB[i * Nc + j] = 0.;}
493805e7170SToby Isaac         for (k = 0; k < Nq; k++) {
494805e7170SToby Isaac           vol += geom->detJ[i * Nq + k] * weights[k];
495805e7170SToby Isaac           for (j = 0; j < Nc; j++) {
496805e7170SToby Isaac             rB[i * Nc + j] += weights[k] * rqB[ (i * Nq + k) * Nc + j];
497805e7170SToby Isaac           }
498805e7170SToby Isaac         }
499805e7170SToby Isaac         for (k = 0; k < Nc; k++) rB[i * Nc + k] /= vol;
500805e7170SToby Isaac       }
501805e7170SToby Isaac     }
502805e7170SToby Isaac   }
503805e7170SToby Isaac   if (D) {
504805e7170SToby Isaac     PetscInt i, j, k, l, m;
505805e7170SToby Isaac 
506805e7170SToby Isaac     if (type == PETSC_SCALAR) {
507805e7170SToby Isaac       PetscScalar * sD  = (PetscScalar *) D;
508805e7170SToby Isaac       PetscScalar * sqD = (PetscScalar *) qD;
509805e7170SToby Isaac 
510805e7170SToby Isaac       for (i = 0; i < numPoints; i++) {
511805e7170SToby Isaac         PetscReal vol = 0.;
512805e7170SToby Isaac 
513805e7170SToby Isaac         for (j = 0; j < Nc * dimC; j++) {sD[i * Nc * dimC + j] = 0.;}
514805e7170SToby Isaac         for (k = 0; k < Nq; k++) {
515805e7170SToby Isaac           vol += geom->detJ[i * Nq + k] * weights[k];
516805e7170SToby Isaac           for (j = 0; j < Nc; j++) {
517805e7170SToby Isaac             PetscScalar pD[3] = {0.,0.,0.};
518805e7170SToby Isaac 
519805e7170SToby Isaac             for (l = 0; l < dimC; l++) {
520805e7170SToby Isaac               for (m = 0; m < dim; m++) {
521805e7170SToby Isaac                 pD[l] += geom->invJ[((i * Nq + k) * dimC + m) * dimC + l] * sqD[((i * Nq + k) * Nc + j) * dim + m];
522805e7170SToby Isaac               }
523805e7170SToby Isaac             }
524805e7170SToby Isaac             for (l = 0; l < dimC; l++) {
525805e7170SToby Isaac               sD[(i * Nc + j) * dimC + l] += geom->detJ[i * Nq + k] * weights[k] * pD[l];
526805e7170SToby Isaac             }
527805e7170SToby Isaac           }
528805e7170SToby Isaac         }
529805e7170SToby Isaac         for (k = 0; k < Nc * dimC; k++) sD[i * Nc * dimC + k] /= vol;
530805e7170SToby Isaac       }
531805e7170SToby Isaac     } else {
532805e7170SToby Isaac       PetscReal * rD  = (PetscReal *) D;
533805e7170SToby Isaac       PetscReal * rqD = (PetscReal *) qD;
534805e7170SToby Isaac 
535805e7170SToby Isaac       for (i = 0; i < numPoints; i++) {
536805e7170SToby Isaac         PetscReal vol = 0.;
537805e7170SToby Isaac 
538805e7170SToby Isaac         for (j = 0; j < Nc * dimC; j++) {rD[i * Nc * dimC + j] = 0.;}
539805e7170SToby Isaac         for (k = 0; k < Nq; k++) {
540805e7170SToby Isaac           vol += geom->detJ[i * Nq + k] * weights[k];
541805e7170SToby Isaac           for (j = 0; j < Nc; j++) {
542805e7170SToby Isaac             PetscReal pD[3] = {0.,0.,0.};
543805e7170SToby Isaac 
544805e7170SToby Isaac             for (l = 0; l < dimC; l++) {
545805e7170SToby Isaac               for (m = 0; m < dim; m++) {
546805e7170SToby Isaac                 pD[l] += geom->invJ[((i * Nq + k) * dimC + m) * dimC + l] * rqD[((i * Nq + k) * Nc + j) * dim + m];
547805e7170SToby Isaac               }
548805e7170SToby Isaac             }
549805e7170SToby Isaac             for (l = 0; l < dimC; l++) {
550805e7170SToby Isaac               rD[(i * Nc + j) * dimC + l] += geom->detJ[i * Nq + k] * weights[k] * pD[l];
551805e7170SToby Isaac             }
552805e7170SToby Isaac           }
553805e7170SToby Isaac         }
554805e7170SToby Isaac         for (k = 0; k < Nc * dimC; k++) rD[i * Nc * dimC + k] /= vol;
555805e7170SToby Isaac       }
556805e7170SToby Isaac     }
557805e7170SToby Isaac   }
558805e7170SToby Isaac   if (H) {
559805e7170SToby Isaac     PetscInt i, j, k, l, m, q, r;
560805e7170SToby Isaac 
561805e7170SToby Isaac     if (type == PETSC_SCALAR) {
562805e7170SToby Isaac       PetscScalar * sH  = (PetscScalar *) H;
563805e7170SToby Isaac       PetscScalar * sqH = (PetscScalar *) qH;
564805e7170SToby Isaac 
565805e7170SToby Isaac       for (i = 0; i < numPoints; i++) {
566805e7170SToby Isaac         PetscReal vol = 0.;
567805e7170SToby Isaac 
568805e7170SToby Isaac         for (j = 0; j < Nc * dimC * dimC; j++) {sH[i * Nc * dimC * dimC + j] = 0.;}
569805e7170SToby Isaac         for (k = 0; k < Nq; k++) {
5704d1a973fSToby Isaac           const PetscReal *invJ = &geom->invJ[(i * Nq + k) * dimC * dimC];
571805e7170SToby Isaac 
572805e7170SToby Isaac           vol += geom->detJ[i * Nq + k] * weights[k];
573805e7170SToby Isaac           for (j = 0; j < Nc; j++) {
574805e7170SToby Isaac             PetscScalar pH[3][3] = {{0.,0.,0.},{0.,0.,0.},{0.,0.,0.}};
575805e7170SToby Isaac             const PetscScalar *spH = &sqH[((i * Nq + k) * Nc + j) * dimC * dimC];
576805e7170SToby Isaac 
577805e7170SToby Isaac             for (l = 0; l < dimC; l++) {
578805e7170SToby Isaac               for (m = 0; m < dimC; m++) {
579805e7170SToby Isaac                 for (q = 0; q < dim; q++) {
580805e7170SToby Isaac                   for (r = 0; r < dim; r++) {
581805e7170SToby Isaac                     pH[l][m] += invJ[q * dimC + l] * invJ[r * dimC + m] * spH[q * dim + r];
582805e7170SToby Isaac                   }
583805e7170SToby Isaac                 }
584805e7170SToby Isaac               }
585805e7170SToby Isaac             }
586805e7170SToby Isaac             for (l = 0; l < dimC; l++) {
587805e7170SToby Isaac               for (m = 0; m < dimC; m++) {
588805e7170SToby Isaac                 sH[(i * Nc + j) * dimC * dimC + l * dimC + m] += geom->detJ[i * Nq + k] * weights[k] * pH[l][m];
589805e7170SToby Isaac               }
590805e7170SToby Isaac             }
591805e7170SToby Isaac           }
592805e7170SToby Isaac         }
593805e7170SToby Isaac         for (k = 0; k < Nc * dimC * dimC; k++) sH[i * Nc * dimC * dimC + k] /= vol;
594805e7170SToby Isaac       }
595805e7170SToby Isaac     } else {
596805e7170SToby Isaac       PetscReal * rH  = (PetscReal *) H;
597805e7170SToby Isaac       PetscReal * rqH = (PetscReal *) qH;
598805e7170SToby Isaac 
599805e7170SToby Isaac       for (i = 0; i < numPoints; i++) {
600805e7170SToby Isaac         PetscReal vol = 0.;
601805e7170SToby Isaac 
602805e7170SToby Isaac         for (j = 0; j < Nc * dimC * dimC; j++) {rH[i * Nc * dimC * dimC + j] = 0.;}
603805e7170SToby Isaac         for (k = 0; k < Nq; k++) {
604805e7170SToby Isaac           const PetscReal *invJ = &geom->invJ[(i * Nq + k) * dimC * dimC];
605805e7170SToby Isaac 
606805e7170SToby Isaac           vol += geom->detJ[i * Nq + k] * weights[k];
607805e7170SToby Isaac           for (j = 0; j < Nc; j++) {
608805e7170SToby Isaac             PetscReal pH[3][3] = {{0.,0.,0.},{0.,0.,0.},{0.,0.,0.}};
609805e7170SToby Isaac             const PetscReal *rpH = &rqH[((i * Nq + k) * Nc + j) * dimC * dimC];
610805e7170SToby Isaac 
611805e7170SToby Isaac             for (l = 0; l < dimC; l++) {
612805e7170SToby Isaac               for (m = 0; m < dimC; m++) {
613805e7170SToby Isaac                 for (q = 0; q < dim; q++) {
614805e7170SToby Isaac                   for (r = 0; r < dim; r++) {
615805e7170SToby Isaac                     pH[l][m] += invJ[q * dimC + l] * invJ[r * dimC + m] * rpH[q * dim + r];
616805e7170SToby Isaac                   }
617805e7170SToby Isaac                 }
618805e7170SToby Isaac               }
619805e7170SToby Isaac             }
620805e7170SToby Isaac             for (l = 0; l < dimC; l++) {
621805e7170SToby Isaac               for (m = 0; m < dimC; m++) {
622805e7170SToby Isaac                 rH[(i * Nc + j) * dimC * dimC + l * dimC + m] += geom->detJ[i * Nq + k] * weights[k] * pH[l][m];
623805e7170SToby Isaac               }
624805e7170SToby Isaac             }
625805e7170SToby Isaac           }
626805e7170SToby Isaac         }
627805e7170SToby Isaac         for (k = 0; k < Nc * dimC * dimC; k++) rH[i * Nc * dimC * dimC + k] /= vol;
628805e7170SToby Isaac       }
629805e7170SToby Isaac     }
630805e7170SToby Isaac   }
6319566063dSJacob Faibussowitsch   if (B) PetscCall(DMRestoreWorkArray(field->dm, N, mpitype, &qB));
6329566063dSJacob Faibussowitsch   if (D) PetscCall(DMRestoreWorkArray(field->dm, N * dimC, mpitype, &qD));
6339566063dSJacob Faibussowitsch   if (H) PetscCall(DMRestoreWorkArray(field->dm, N * dimC * dimC, mpitype, &qH));
6349566063dSJacob Faibussowitsch   PetscCall(PetscFEGeomDestroy(&geom));
6359566063dSJacob Faibussowitsch   PetscCall(PetscQuadratureDestroy(&quad));
636805e7170SToby Isaac   PetscFunctionReturn(0);
637805e7170SToby Isaac }
638805e7170SToby Isaac 
639b7260050SToby Isaac static PetscErrorCode DMFieldGetDegree_DS(DMField field, IS pointIS, PetscInt *minDegree, PetscInt *maxDegree)
64051a454edSToby Isaac {
64151a454edSToby Isaac   DMField_DS     *dsfield;
64251a454edSToby Isaac   PetscObject    disc;
643741db25dSToby Isaac   PetscInt       h, imin, imax;
64451a454edSToby Isaac   PetscClassId   id;
64551a454edSToby Isaac 
64651a454edSToby Isaac   PetscFunctionBegin;
64751a454edSToby Isaac   dsfield = (DMField_DS *) field->data;
6489566063dSJacob Faibussowitsch   PetscCall(ISGetMinMax(pointIS,&imin,&imax));
649741db25dSToby Isaac   if (imin >= imax) {
65051aa0bf7SToby Isaac     h = 0;
65151aa0bf7SToby Isaac   } else {
652f99c8401SToby Isaac     for (h = 0; h < dsfield->height; h++) {
65351a454edSToby Isaac       PetscInt hEnd;
65451a454edSToby Isaac 
6559566063dSJacob Faibussowitsch       PetscCall(DMPlexGetHeightStratum(field->dm,h,NULL,&hEnd));
65651a454edSToby Isaac       if (imin < hEnd) break;
65751a454edSToby Isaac     }
65851aa0bf7SToby Isaac   }
6599566063dSJacob Faibussowitsch   PetscCall(DMFieldDSGetHeightDisc(field,h,&disc));
6609566063dSJacob Faibussowitsch   PetscCall(PetscObjectGetClassId(disc,&id));
66151a454edSToby Isaac   if (id == PETSCFE_CLASSID) {
66251a454edSToby Isaac     PetscFE    fe = (PetscFE) disc;
66351a454edSToby Isaac     PetscSpace sp;
66451a454edSToby Isaac 
6659566063dSJacob Faibussowitsch     PetscCall(PetscFEGetBasisSpace(fe, &sp));
6669566063dSJacob Faibussowitsch     PetscCall(PetscSpaceGetDegree(sp, minDegree, maxDegree));
66751a454edSToby Isaac   }
66851a454edSToby Isaac   PetscFunctionReturn(0);
66951a454edSToby Isaac }
67051a454edSToby Isaac 
671a2aba86cSMatthew G. Knepley PetscErrorCode DMFieldGetFVQuadrature_Internal(DMField field, IS pointIS, PetscQuadrature *quad)
672a2aba86cSMatthew G. Knepley {
673a2aba86cSMatthew G. Knepley   DM              dm = field->dm;
674a2aba86cSMatthew G. Knepley   const PetscInt *points;
675a2aba86cSMatthew G. Knepley   DMPolytopeType  ct;
676a2aba86cSMatthew G. Knepley   PetscInt        dim, n;
677a2aba86cSMatthew G. Knepley   PetscBool       isplex;
678a2aba86cSMatthew G. Knepley 
679a2aba86cSMatthew G. Knepley   PetscFunctionBegin;
6809566063dSJacob Faibussowitsch   PetscCall(PetscObjectTypeCompare((PetscObject) dm, DMPLEX, &isplex));
6819566063dSJacob Faibussowitsch   PetscCall(ISGetLocalSize(pointIS, &n));
682a2aba86cSMatthew G. Knepley   if (isplex && n) {
6839566063dSJacob Faibussowitsch     PetscCall(DMGetDimension(dm, &dim));
6849566063dSJacob Faibussowitsch     PetscCall(ISGetIndices(pointIS, &points));
6859566063dSJacob Faibussowitsch     PetscCall(DMPlexGetCellType(dm, points[0], &ct));
686a2aba86cSMatthew G. Knepley     switch (ct) {
687a2aba86cSMatthew G. Knepley       case DM_POLYTOPE_TRIANGLE:
688a2aba86cSMatthew G. Knepley       case DM_POLYTOPE_TETRAHEDRON:
6899566063dSJacob Faibussowitsch         PetscCall(PetscDTStroudConicalQuadrature(dim, 1, 1, -1.0, 1.0, quad));break;
6909566063dSJacob Faibussowitsch       default: PetscCall(PetscDTGaussTensorQuadrature(dim, 1, 1, -1.0, 1.0, quad));
691a2aba86cSMatthew G. Knepley     }
6929566063dSJacob Faibussowitsch     PetscCall(ISRestoreIndices(pointIS, &points));
693*1baa6e33SBarry Smith   } else PetscCall(DMFieldCreateDefaultQuadrature(field, pointIS, quad));
694a2aba86cSMatthew G. Knepley   PetscFunctionReturn(0);
695a2aba86cSMatthew G. Knepley }
696a2aba86cSMatthew G. Knepley 
69751a454edSToby Isaac static PetscErrorCode DMFieldCreateDefaultQuadrature_DS(DMField field, IS pointIS, PetscQuadrature *quad)
69851a454edSToby Isaac {
6991fdf1f07SMatthew G. Knepley   PetscInt       h, dim, imax, imin, cellHeight;
70051a454edSToby Isaac   DM             dm;
70151a454edSToby Isaac   DMField_DS     *dsfield;
70251a454edSToby Isaac   PetscObject    disc;
70351a454edSToby Isaac   PetscFE        fe;
70451a454edSToby Isaac   PetscClassId   id;
70551a454edSToby Isaac 
70651a454edSToby Isaac   PetscFunctionBegin;
70751a454edSToby Isaac   dm = field->dm;
70851a454edSToby Isaac   dsfield = (DMField_DS *) field->data;
7099566063dSJacob Faibussowitsch   PetscCall(ISGetMinMax(pointIS,&imin,&imax));
7109566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm,&dim));
71151a454edSToby Isaac   for (h = 0; h <= dim; h++) {
71251a454edSToby Isaac     PetscInt hStart, hEnd;
71351a454edSToby Isaac 
7149566063dSJacob Faibussowitsch     PetscCall(DMPlexGetHeightStratum(dm,h,&hStart,&hEnd));
7156c041b70SSatish Balay     if (imax >= hStart && imin < hEnd) break;
71651a454edSToby Isaac   }
7179566063dSJacob Faibussowitsch   PetscCall(DMPlexGetVTKCellHeight(dm, &cellHeight));
7181fdf1f07SMatthew G. Knepley   h -= cellHeight;
71951a454edSToby Isaac   *quad = NULL;
720f99c8401SToby Isaac   if (h < dsfield->height) {
7219566063dSJacob Faibussowitsch     PetscCall(DMFieldDSGetHeightDisc(field,h,&disc));
7229566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(disc,&id));
72351a454edSToby Isaac     if (id != PETSCFE_CLASSID) PetscFunctionReturn(0);
72451a454edSToby Isaac     fe = (PetscFE) disc;
7259566063dSJacob Faibussowitsch     PetscCall(PetscFEGetQuadrature(fe,quad));
7269566063dSJacob Faibussowitsch     PetscCall(PetscObjectReference((PetscObject)*quad));
72751a454edSToby Isaac   }
72851a454edSToby Isaac   PetscFunctionReturn(0);
72951a454edSToby Isaac }
73051a454edSToby Isaac 
7310145028aSToby Isaac static PetscErrorCode DMFieldComputeFaceData_DS(DMField field, IS pointIS, PetscQuadrature quad, PetscFEGeom *geom)
7320145028aSToby Isaac {
7330145028aSToby Isaac   const PetscInt *points;
7340145028aSToby Isaac   PetscInt        p, dim, dE, numFaces, Nq;
735b7260050SToby Isaac   PetscInt        maxDegree;
7360145028aSToby Isaac   DMLabel         depthLabel;
7370145028aSToby Isaac   IS              cellIS;
7380145028aSToby Isaac   DM              dm = field->dm;
7390145028aSToby Isaac 
7400145028aSToby Isaac   PetscFunctionBegin;
7410145028aSToby Isaac   dim = geom->dim;
7420145028aSToby Isaac   dE  = geom->dimEmbed;
7439566063dSJacob Faibussowitsch   PetscCall(DMPlexGetDepthLabel(dm, &depthLabel));
7449566063dSJacob Faibussowitsch   PetscCall(DMLabelGetStratumIS(depthLabel, dim + 1, &cellIS));
7459566063dSJacob Faibussowitsch   PetscCall(DMFieldGetDegree(field,cellIS,NULL,&maxDegree));
7469566063dSJacob Faibussowitsch   PetscCall(ISGetIndices(pointIS, &points));
7470145028aSToby Isaac   numFaces = geom->numCells;
7480145028aSToby Isaac   Nq = geom->numPoints;
749f15274beSMatthew Knepley   /* First, set local faces and flip normals so that they are outward for the first supporting cell */
750f15274beSMatthew Knepley   for (p = 0; p < numFaces; p++) {
751f15274beSMatthew Knepley     PetscInt        point = points[p];
752f15274beSMatthew Knepley     PetscInt        suppSize, s, coneSize, c, numChildren;
753f15274beSMatthew Knepley     const PetscInt *supp, *cone, *ornt;
754f15274beSMatthew Knepley 
7559566063dSJacob Faibussowitsch     PetscCall(DMPlexGetTreeChildren(dm, point, &numChildren, NULL));
75628b400f6SJacob Faibussowitsch     PetscCheck(!numChildren,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Face data not valid for facets with children");
7579566063dSJacob Faibussowitsch     PetscCall(DMPlexGetSupportSize(dm, point, &suppSize));
75863a3b9bcSJacob Faibussowitsch     PetscCheck(suppSize <= 2,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Point %" PetscInt_FMT " has %" PetscInt_FMT " support, expected at most 2", point, suppSize);
759f15274beSMatthew Knepley     if (!suppSize) continue;
7609566063dSJacob Faibussowitsch     PetscCall(DMPlexGetSupport(dm, point, &supp));
761f15274beSMatthew Knepley     for (s = 0; s < suppSize; ++s) {
7629566063dSJacob Faibussowitsch       PetscCall(DMPlexGetConeSize(dm, supp[s], &coneSize));
7639566063dSJacob Faibussowitsch       PetscCall(DMPlexGetCone(dm, supp[s], &cone));
764f15274beSMatthew Knepley       for (c = 0; c < coneSize; ++c) if (cone[c] == point) break;
76563a3b9bcSJacob Faibussowitsch       PetscCheck(c != coneSize,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Invalid connectivity: point %" PetscInt_FMT " not found in cone of support point %" PetscInt_FMT, point, supp[s]);
766f15274beSMatthew Knepley       geom->face[p][s] = c;
767f15274beSMatthew Knepley     }
7689566063dSJacob Faibussowitsch     PetscCall(DMPlexGetConeOrientation(dm, supp[0], &ornt));
769f15274beSMatthew Knepley     if (ornt[geom->face[p][0]] < 0) {
770f15274beSMatthew Knepley       PetscInt Np = geom->numPoints, q, dE = geom->dimEmbed, d;
771f15274beSMatthew Knepley 
772f15274beSMatthew Knepley       for (q = 0; q < Np; ++q) for (d = 0; d < dE; ++d) geom->n[(p*Np + q)*dE + d] = -geom->n[(p*Np + q)*dE + d];
773f15274beSMatthew Knepley     }
774f15274beSMatthew Knepley   }
775b7260050SToby Isaac   if (maxDegree <= 1) {
7760145028aSToby Isaac     PetscInt        numCells, offset, *cells;
7770145028aSToby Isaac     PetscFEGeom     *cellGeom;
7780145028aSToby Isaac     IS              suppIS;
7790145028aSToby Isaac 
7800145028aSToby Isaac     for (p = 0, numCells = 0; p < numFaces; p++) {
7810145028aSToby Isaac       PetscInt        point = points[p];
7820145028aSToby Isaac       PetscInt        numSupp, numChildren;
7830145028aSToby Isaac 
7849566063dSJacob Faibussowitsch       PetscCall(DMPlexGetTreeChildren(dm, point, &numChildren, NULL));
78528b400f6SJacob Faibussowitsch       PetscCheck(!numChildren,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Face data not valid for facets with children");
7869566063dSJacob Faibussowitsch       PetscCall(DMPlexGetSupportSize(dm, point,&numSupp));
78763a3b9bcSJacob Faibussowitsch       PetscCheck(numSupp <= 2,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Point %" PetscInt_FMT " has %" PetscInt_FMT " support, expected at most 2", point, numSupp);
7880145028aSToby Isaac       numCells += numSupp;
7890145028aSToby Isaac     }
7909566063dSJacob Faibussowitsch     PetscCall(PetscMalloc1(numCells, &cells));
7910145028aSToby Isaac     for (p = 0, offset = 0; p < numFaces; p++) {
7920145028aSToby Isaac       PetscInt        point = points[p];
7930145028aSToby Isaac       PetscInt        numSupp, s;
7940145028aSToby Isaac       const PetscInt *supp;
7950145028aSToby Isaac 
7969566063dSJacob Faibussowitsch       PetscCall(DMPlexGetSupportSize(dm, point,&numSupp));
7979566063dSJacob Faibussowitsch       PetscCall(DMPlexGetSupport(dm, point, &supp));
7980145028aSToby Isaac       for (s = 0; s < numSupp; s++, offset++) {
7990145028aSToby Isaac         cells[offset] = supp[s];
8000145028aSToby Isaac       }
8010145028aSToby Isaac     }
8029566063dSJacob Faibussowitsch     PetscCall(ISCreateGeneral(PETSC_COMM_SELF,numCells,cells,PETSC_USE_POINTER, &suppIS));
8039566063dSJacob Faibussowitsch     PetscCall(DMFieldCreateFEGeom(field,suppIS,quad,PETSC_FALSE,&cellGeom));
8040145028aSToby Isaac     for (p = 0, offset = 0; p < numFaces; p++) {
8050145028aSToby Isaac       PetscInt        point = points[p];
8060145028aSToby Isaac       PetscInt        numSupp, s, q;
8070145028aSToby Isaac       const PetscInt *supp;
8080145028aSToby Isaac 
8099566063dSJacob Faibussowitsch       PetscCall(DMPlexGetSupportSize(dm, point,&numSupp));
8109566063dSJacob Faibussowitsch       PetscCall(DMPlexGetSupport(dm, point, &supp));
8110145028aSToby Isaac       for (s = 0; s < numSupp; s++, offset++) {
8120145028aSToby Isaac         for (q = 0; q < Nq * dE * dE; q++) {
81341418987SMatthew G. Knepley           geom->suppJ[s][p * Nq * dE * dE + q]    = cellGeom->J[offset * Nq * dE * dE + q];
8140145028aSToby Isaac           geom->suppInvJ[s][p * Nq * dE * dE + q] = cellGeom->invJ[offset * Nq * dE * dE + q];
8150145028aSToby Isaac         }
81641418987SMatthew G. Knepley         for (q = 0; q < Nq; q++) geom->suppDetJ[s][p * Nq + q] = cellGeom->detJ[offset * Nq + q];
8170145028aSToby Isaac       }
8180145028aSToby Isaac     }
8199566063dSJacob Faibussowitsch     PetscCall(PetscFEGeomDestroy(&cellGeom));
8209566063dSJacob Faibussowitsch     PetscCall(ISDestroy(&suppIS));
8219566063dSJacob Faibussowitsch     PetscCall(PetscFree(cells));
8220145028aSToby Isaac   } else {
8230145028aSToby Isaac     PetscObject          faceDisc, cellDisc;
8240145028aSToby Isaac     PetscClassId         faceId, cellId;
8250145028aSToby Isaac     PetscDualSpace       dsp;
8260145028aSToby Isaac     DM                   K;
827ba2698f1SMatthew G. Knepley     DMPolytopeType       ct;
8280145028aSToby Isaac     PetscInt           (*co)[2][3];
8290145028aSToby Isaac     PetscInt             coneSize;
8300145028aSToby Isaac     PetscInt           **counts;
8310145028aSToby Isaac     PetscInt             f, i, o, q, s;
8320145028aSToby Isaac     const PetscInt      *coneK;
833ba2698f1SMatthew G. Knepley     PetscInt             eStart, minOrient, maxOrient, numOrient;
8340145028aSToby Isaac     PetscInt            *orients;
8350145028aSToby Isaac     PetscReal          **orientPoints;
8360145028aSToby Isaac     PetscReal           *cellPoints;
8370145028aSToby Isaac     PetscReal           *dummyWeights;
8380145028aSToby Isaac     PetscQuadrature      cellQuad = NULL;
8390145028aSToby Isaac 
8409566063dSJacob Faibussowitsch     PetscCall(DMFieldDSGetHeightDisc(field, 1, &faceDisc));
8419566063dSJacob Faibussowitsch     PetscCall(DMFieldDSGetHeightDisc(field, 0, &cellDisc));
8429566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(faceDisc,&faceId));
8439566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(cellDisc,&cellId));
8441dca8a05SBarry Smith     PetscCheck(faceId == PETSCFE_CLASSID && cellId == PETSCFE_CLASSID,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Not supported");
8459566063dSJacob Faibussowitsch     PetscCall(PetscFEGetDualSpace((PetscFE)cellDisc, &dsp));
8469566063dSJacob Faibussowitsch     PetscCall(PetscDualSpaceGetDM(dsp, &K));
8479566063dSJacob Faibussowitsch     PetscCall(DMPlexGetHeightStratum(K, 1, &eStart, NULL));
8489566063dSJacob Faibussowitsch     PetscCall(DMPlexGetCellType(K, eStart, &ct));
8499566063dSJacob Faibussowitsch     PetscCall(DMPlexGetConeSize(K,0,&coneSize));
8509566063dSJacob Faibussowitsch     PetscCall(DMPlexGetCone(K,0,&coneK));
8519566063dSJacob Faibussowitsch     PetscCall(PetscMalloc2(numFaces, &co, coneSize, &counts));
8529566063dSJacob Faibussowitsch     PetscCall(PetscMalloc1(dE*Nq, &cellPoints));
8539566063dSJacob Faibussowitsch     PetscCall(PetscMalloc1(Nq, &dummyWeights));
8549566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureCreate(PETSC_COMM_SELF, &cellQuad));
8559566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureSetData(cellQuad, dE, 1, Nq, cellPoints, dummyWeights));
8560145028aSToby Isaac     minOrient = PETSC_MAX_INT;
8570145028aSToby Isaac     maxOrient = PETSC_MIN_INT;
8580145028aSToby Isaac     for (p = 0; p < numFaces; p++) { /* record the orientation of the facet wrt the support cells */
8590145028aSToby Isaac       PetscInt        point = points[p];
8600145028aSToby Isaac       PetscInt        numSupp, numChildren;
8610145028aSToby Isaac       const PetscInt *supp;
8620145028aSToby Isaac 
8639566063dSJacob Faibussowitsch       PetscCall(DMPlexGetTreeChildren(dm, point, &numChildren, NULL));
86428b400f6SJacob Faibussowitsch       PetscCheck(!numChildren,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Face data not valid for facets with children");
8659566063dSJacob Faibussowitsch       PetscCall(DMPlexGetSupportSize(dm, point,&numSupp));
86663a3b9bcSJacob Faibussowitsch       PetscCheck(numSupp <= 2,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Point %" PetscInt_FMT " has %" PetscInt_FMT " support, expected at most 2", point, numSupp);
8679566063dSJacob Faibussowitsch       PetscCall(DMPlexGetSupport(dm, point, &supp));
8680145028aSToby Isaac       for (s = 0; s < numSupp; s++) {
8690145028aSToby Isaac         PetscInt        cell = supp[s];
8700145028aSToby Isaac         PetscInt        numCone;
8710145028aSToby Isaac         const PetscInt *cone, *orient;
8720145028aSToby Isaac 
8739566063dSJacob Faibussowitsch         PetscCall(DMPlexGetConeSize(dm, cell, &numCone));
87408401ef6SPierre Jolivet         PetscCheck(numCone == coneSize,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Support point does not match reference element");
8759566063dSJacob Faibussowitsch         PetscCall(DMPlexGetCone(dm, cell, &cone));
8769566063dSJacob Faibussowitsch         PetscCall(DMPlexGetConeOrientation(dm, cell, &orient));
8770145028aSToby Isaac         for (f = 0; f < coneSize; f++) {
8780145028aSToby Isaac           if (cone[f] == point) break;
8790145028aSToby Isaac         }
8800145028aSToby Isaac         co[p][s][0] = f;
8810145028aSToby Isaac         co[p][s][1] = orient[f];
8820145028aSToby Isaac         co[p][s][2] = cell;
8830145028aSToby Isaac         minOrient = PetscMin(minOrient, orient[f]);
884cd93b0e1SMatthew G. Knepley         maxOrient = PetscMax(maxOrient, orient[f]);
8850145028aSToby Isaac       }
8860145028aSToby Isaac       for (; s < 2; s++) {
8870145028aSToby Isaac         co[p][s][0] = -1;
8880145028aSToby Isaac         co[p][s][1] = -1;
8890145028aSToby Isaac         co[p][s][2] = -1;
8900145028aSToby Isaac       }
8910145028aSToby Isaac     }
8920145028aSToby Isaac     numOrient = maxOrient + 1 - minOrient;
8939566063dSJacob Faibussowitsch     PetscCall(DMPlexGetCone(K,0,&coneK));
8940145028aSToby Isaac     /* count all (face,orientation) doubles that appear */
8959566063dSJacob Faibussowitsch     PetscCall(PetscCalloc2(numOrient,&orients,numOrient,&orientPoints));
8969566063dSJacob Faibussowitsch     for (f = 0; f < coneSize; f++) PetscCall(PetscCalloc1(numOrient+1, &counts[f]));
8970145028aSToby Isaac     for (p = 0; p < numFaces; p++) {
8980145028aSToby Isaac       for (s = 0; s < 2; s++) {
8990145028aSToby Isaac         if (co[p][s][0] >= 0) {
9000145028aSToby Isaac           counts[co[p][s][0]][co[p][s][1] - minOrient]++;
9010145028aSToby Isaac           orients[co[p][s][1] - minOrient]++;
9020145028aSToby Isaac         }
9030145028aSToby Isaac       }
9040145028aSToby Isaac     }
9050145028aSToby Isaac     for (o = 0; o < numOrient; o++) {
9060145028aSToby Isaac       if (orients[o]) {
9070145028aSToby Isaac         PetscInt orient = o + minOrient;
9080145028aSToby Isaac         PetscInt q;
9090145028aSToby Isaac 
9109566063dSJacob Faibussowitsch         PetscCall(PetscMalloc1(Nq * dim, &orientPoints[o]));
9110145028aSToby Isaac         /* rotate the quadrature points appropriately */
912ba2698f1SMatthew G. Knepley         switch (ct) {
913ba2698f1SMatthew G. Knepley         case DM_POLYTOPE_POINT: break;
914ba2698f1SMatthew G. Knepley         case DM_POLYTOPE_SEGMENT:
9150145028aSToby Isaac           if (orient == -2 || orient == 1) {
9160145028aSToby Isaac             for (q = 0; q < Nq; q++) {
9170145028aSToby Isaac               orientPoints[o][q] = -geom->xi[q];
9180145028aSToby Isaac             }
9190145028aSToby Isaac           } else {
9200145028aSToby Isaac             for (q = 0; q < Nq; q++) {
9210145028aSToby Isaac               orientPoints[o][q] = geom->xi[q];
9220145028aSToby Isaac             }
9230145028aSToby Isaac           }
9240145028aSToby Isaac           break;
925ba2698f1SMatthew G. Knepley         case DM_POLYTOPE_TRIANGLE:
9260145028aSToby Isaac           for (q = 0; q < Nq; q++) {
9270145028aSToby Isaac             PetscReal lambda[3];
9280145028aSToby Isaac             PetscReal lambdao[3];
9290145028aSToby Isaac 
9300145028aSToby Isaac             /* convert to barycentric */
9310145028aSToby Isaac             lambda[0] = - (geom->xi[2 * q] + geom->xi[2 * q + 1]) / 2.;
9320145028aSToby Isaac             lambda[1] = (geom->xi[2 * q] + 1.) / 2.;
9330145028aSToby Isaac             lambda[2] = (geom->xi[2 * q + 1] + 1.) / 2.;
9340145028aSToby Isaac             if (orient >= 0) {
9350145028aSToby Isaac               for (i = 0; i < 3; i++) {
9360145028aSToby Isaac                 lambdao[i] = lambda[(orient + i) % 3];
9370145028aSToby Isaac               }
9380145028aSToby Isaac             } else {
9390145028aSToby Isaac               for (i = 0; i < 3; i++) {
9400145028aSToby Isaac                 lambdao[i] = lambda[(-(orient + i) + 3) % 3];
9410145028aSToby Isaac               }
9420145028aSToby Isaac             }
9430145028aSToby Isaac             /* convert to coordinates */
9440145028aSToby Isaac             orientPoints[o][2 * q + 0] = -(lambdao[0] + lambdao[2]) + lambdao[1];
9450145028aSToby Isaac             orientPoints[o][2 * q + 1] = -(lambdao[0] + lambdao[1]) + lambdao[2];
9460145028aSToby Isaac           }
9470145028aSToby Isaac           break;
948ba2698f1SMatthew G. Knepley         case DM_POLYTOPE_QUADRILATERAL:
9490145028aSToby Isaac           for (q = 0; q < Nq; q++) {
9500145028aSToby Isaac             PetscReal xi[2], xio[2];
9510145028aSToby Isaac             PetscInt oabs = (orient >= 0) ? orient : -(orient + 1);
9520145028aSToby Isaac 
9530145028aSToby Isaac             xi[0] = geom->xi[2 * q];
9540145028aSToby Isaac             xi[1] = geom->xi[2 * q + 1];
9550145028aSToby Isaac             switch (oabs) {
9560145028aSToby Isaac             case 1:
9570145028aSToby Isaac               xio[0] = xi[1];
9580145028aSToby Isaac               xio[1] = -xi[0];
9590145028aSToby Isaac               break;
9600145028aSToby Isaac             case 2:
9610145028aSToby Isaac               xio[0] = -xi[0];
9620145028aSToby Isaac               xio[1] = -xi[1];
9630145028aSToby Isaac             case 3:
9640145028aSToby Isaac               xio[0] = -xi[1];
9650145028aSToby Isaac               xio[1] = xi[0];
966aa1371cbSToby Isaac             case 0:
967aa1371cbSToby Isaac             default:
968aa1371cbSToby Isaac               xio[0] = xi[0];
969aa1371cbSToby Isaac               xio[1] = xi[1];
970aa1371cbSToby Isaac               break;
9710145028aSToby Isaac             }
9720145028aSToby Isaac             if (orient < 0) {
9730145028aSToby Isaac               xio[0] = -xio[0];
9740145028aSToby Isaac             }
9750145028aSToby Isaac             orientPoints[o][2 * q + 0] = xio[0];
9760145028aSToby Isaac             orientPoints[o][2 * q + 1] = xio[1];
9770145028aSToby Isaac           }
9780145028aSToby Isaac           break;
97998921bdaSJacob Faibussowitsch         default: SETERRQ(PETSC_COMM_SELF,PETSC_ERR_SUP,"Cell type %s not yet supported", DMPolytopeTypes[ct]);
9800145028aSToby Isaac         }
9810145028aSToby Isaac       }
9820145028aSToby Isaac     }
9830145028aSToby Isaac     for (f = 0; f < coneSize; f++) {
9840145028aSToby Isaac       PetscInt face = coneK[f];
9854d1a973fSToby Isaac       PetscReal v0[3];
9862d89661fSMatthew G. Knepley       PetscReal J[9], detJ;
9870145028aSToby Isaac       PetscInt numCells, offset;
9880145028aSToby Isaac       PetscInt *cells;
9890145028aSToby Isaac       IS suppIS;
9900145028aSToby Isaac 
9919566063dSJacob Faibussowitsch       PetscCall(DMPlexComputeCellGeometryFEM(K, face, NULL, v0, J, NULL, &detJ));
9920145028aSToby Isaac       for (o = 0; o <= numOrient; o++) {
9930145028aSToby Isaac         PetscFEGeom *cellGeom;
9940145028aSToby Isaac 
9950145028aSToby Isaac         if (!counts[f][o]) continue;
9960145028aSToby Isaac         /* If this (face,orientation) double appears,
9970145028aSToby Isaac          * convert the face quadrature points into volume quadrature points */
9980145028aSToby Isaac         for (q = 0; q < Nq; q++) {
9990145028aSToby Isaac           PetscReal xi0[3] = {-1., -1., -1.};
10000145028aSToby Isaac 
10010145028aSToby Isaac           CoordinatesRefToReal(dE, dim, xi0, v0, J, &orientPoints[o][dim * q + 0], &cellPoints[dE * q + 0]);
10020145028aSToby Isaac         }
10030145028aSToby Isaac         for (p = 0, numCells = 0; p < numFaces; p++) {
10040145028aSToby Isaac           for (s = 0; s < 2; s++) {
10050145028aSToby Isaac             if (co[p][s][0] == f && co[p][s][1] == o + minOrient) numCells++;
10060145028aSToby Isaac           }
10070145028aSToby Isaac         }
10089566063dSJacob Faibussowitsch         PetscCall(PetscMalloc1(numCells, &cells));
10090145028aSToby Isaac         for (p = 0, offset = 0; p < numFaces; p++) {
10100145028aSToby Isaac           for (s = 0; s < 2; s++) {
10110145028aSToby Isaac             if (co[p][s][0] == f && co[p][s][1] == o + minOrient) {
10120145028aSToby Isaac               cells[offset++] = co[p][s][2];
10130145028aSToby Isaac             }
10140145028aSToby Isaac           }
10150145028aSToby Isaac         }
10169566063dSJacob Faibussowitsch         PetscCall(ISCreateGeneral(PETSC_COMM_SELF,numCells,cells,PETSC_USE_POINTER, &suppIS));
10179566063dSJacob Faibussowitsch         PetscCall(DMFieldCreateFEGeom(field,suppIS,cellQuad,PETSC_FALSE,&cellGeom));
10180145028aSToby Isaac         for (p = 0, offset = 0; p < numFaces; p++) {
10190145028aSToby Isaac           for (s = 0; s < 2; s++) {
10200145028aSToby Isaac             if (co[p][s][0] == f && co[p][s][1] == o + minOrient) {
10210145028aSToby Isaac               for (q = 0; q < Nq * dE * dE; q++) {
102241418987SMatthew G. Knepley                 geom->suppJ[s][p * Nq * dE * dE + q]    = cellGeom->J[offset * Nq * dE * dE + q];
10230145028aSToby Isaac                 geom->suppInvJ[s][p * Nq * dE * dE + q] = cellGeom->invJ[offset * Nq * dE * dE + q];
10240145028aSToby Isaac               }
102541418987SMatthew G. Knepley               for (q = 0; q < Nq; q++) geom->suppDetJ[s][p * Nq + q] = cellGeom->detJ[offset * Nq + q];
10260145028aSToby Isaac               offset++;
10270145028aSToby Isaac             }
10280145028aSToby Isaac           }
10290145028aSToby Isaac         }
10309566063dSJacob Faibussowitsch         PetscCall(PetscFEGeomDestroy(&cellGeom));
10319566063dSJacob Faibussowitsch         PetscCall(ISDestroy(&suppIS));
10329566063dSJacob Faibussowitsch         PetscCall(PetscFree(cells));
10330145028aSToby Isaac       }
10340145028aSToby Isaac     }
10350145028aSToby Isaac     for (o = 0; o < numOrient; o++) {
10360145028aSToby Isaac       if (orients[o]) {
10379566063dSJacob Faibussowitsch         PetscCall(PetscFree(orientPoints[o]));
10380145028aSToby Isaac       }
10390145028aSToby Isaac     }
10409566063dSJacob Faibussowitsch     PetscCall(PetscFree2(orients,orientPoints));
10419566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureDestroy(&cellQuad));
10429566063dSJacob Faibussowitsch     for (f = 0; f < coneSize; f++) PetscCall(PetscFree(counts[f]));
10439566063dSJacob Faibussowitsch     PetscCall(PetscFree2(co,counts));
10440145028aSToby Isaac   }
10459566063dSJacob Faibussowitsch   PetscCall(ISRestoreIndices(pointIS, &points));
10469566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&cellIS));
10470145028aSToby Isaac   PetscFunctionReturn(0);
10480145028aSToby Isaac }
10490145028aSToby Isaac 
105051a454edSToby Isaac static PetscErrorCode DMFieldInitialize_DS(DMField field)
105151a454edSToby Isaac {
105251a454edSToby Isaac   PetscFunctionBegin;
105351a454edSToby Isaac   field->ops->destroy                 = DMFieldDestroy_DS;
105451a454edSToby Isaac   field->ops->evaluate                = DMFieldEvaluate_DS;
105551a454edSToby Isaac   field->ops->evaluateFE              = DMFieldEvaluateFE_DS;
1056805e7170SToby Isaac   field->ops->evaluateFV              = DMFieldEvaluateFV_DS;
1057b7260050SToby Isaac   field->ops->getDegree               = DMFieldGetDegree_DS;
105851a454edSToby Isaac   field->ops->createDefaultQuadrature = DMFieldCreateDefaultQuadrature_DS;
105951a454edSToby Isaac   field->ops->view                    = DMFieldView_DS;
10600145028aSToby Isaac   field->ops->computeFaceData         = DMFieldComputeFaceData_DS;
106151a454edSToby Isaac   PetscFunctionReturn(0);
106251a454edSToby Isaac }
106351a454edSToby Isaac 
106451a454edSToby Isaac PETSC_INTERN PetscErrorCode DMFieldCreate_DS(DMField field)
106551a454edSToby Isaac {
106651a454edSToby Isaac   DMField_DS     *dsfield;
106751a454edSToby Isaac 
106851a454edSToby Isaac   PetscFunctionBegin;
10699566063dSJacob Faibussowitsch   PetscCall(PetscNewLog(field,&dsfield));
107051a454edSToby Isaac   field->data = dsfield;
10719566063dSJacob Faibussowitsch   PetscCall(DMFieldInitialize_DS(field));
107251a454edSToby Isaac   PetscFunctionReturn(0);
107351a454edSToby Isaac }
107451a454edSToby Isaac 
107551a454edSToby Isaac PetscErrorCode DMFieldCreateDS(DM dm, PetscInt fieldNum, Vec vec,DMField *field)
107651a454edSToby Isaac {
107751a454edSToby Isaac   DMField        b;
107851a454edSToby Isaac   DMField_DS     *dsfield;
107951a454edSToby Isaac   PetscObject    disc = NULL;
108051a454edSToby Isaac   PetscBool      isContainer = PETSC_FALSE;
108151a454edSToby Isaac   PetscClassId   id = -1;
108251a454edSToby Isaac   PetscInt       numComponents = -1, dsNumFields;
108351a454edSToby Isaac   PetscSection   section;
108451a454edSToby Isaac 
108551a454edSToby Isaac   PetscFunctionBegin;
10869566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm,&section));
10879566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetFieldComponents(section,fieldNum,&numComponents));
10889566063dSJacob Faibussowitsch   PetscCall(DMGetNumFields(dm,&dsNumFields));
10899566063dSJacob Faibussowitsch   if (dsNumFields) PetscCall(DMGetField(dm,fieldNum,NULL,&disc));
109051a454edSToby Isaac   if (disc) {
10919566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(disc,&id));
109251a454edSToby Isaac     isContainer = (id == PETSC_CONTAINER_CLASSID) ? PETSC_TRUE : PETSC_FALSE;
109351a454edSToby Isaac   }
109451a454edSToby Isaac   if (!disc || isContainer) {
109551a454edSToby Isaac     MPI_Comm       comm = PetscObjectComm((PetscObject) dm);
109651a454edSToby Isaac     PetscFE        fe;
10972df84da0SMatthew G. Knepley     DMPolytopeType ct, locct = DM_POLYTOPE_UNKNOWN;
10982df84da0SMatthew G. Knepley     PetscInt       dim, cStart, cEnd, cellHeight;
109951a454edSToby Isaac 
11009566063dSJacob Faibussowitsch     PetscCall(DMPlexGetVTKCellHeight(dm, &cellHeight));
11019566063dSJacob Faibussowitsch     PetscCall(DMGetDimension(dm, &dim));
11029566063dSJacob Faibussowitsch     PetscCall(DMPlexGetHeightStratum(dm, cellHeight, &cStart, &cEnd));
11039566063dSJacob Faibussowitsch     if (cEnd > cStart) PetscCall(DMPlexGetCellType(dm, cStart, &locct));
11049566063dSJacob Faibussowitsch     PetscCallMPI(MPI_Allreduce(&locct, &ct, 1, MPI_INT, MPI_MIN, comm));
11059566063dSJacob Faibussowitsch     PetscCall(PetscFECreateLagrangeByCell(PETSC_COMM_SELF, dim, numComponents, ct, 1, PETSC_DETERMINE, &fe));
11069566063dSJacob Faibussowitsch     PetscCall(PetscFEViewFromOptions(fe, NULL, "-field_fe_view"));
110751a454edSToby Isaac     disc = (PetscObject) fe;
1108*1baa6e33SBarry Smith   } else PetscCall(PetscObjectReference(disc));
11099566063dSJacob Faibussowitsch   PetscCall(PetscObjectGetClassId(disc,&id));
111051a454edSToby Isaac   if (id == PETSCFE_CLASSID) {
111151a454edSToby Isaac     PetscFE fe = (PetscFE) disc;
111251a454edSToby Isaac 
11139566063dSJacob Faibussowitsch     PetscCall(PetscFEGetNumComponents(fe,&numComponents));
11142da392ccSBarry Smith   } else SETERRQ(PetscObjectComm((PetscObject)dm),PETSC_ERR_SUP,"Not implemented");
11159566063dSJacob Faibussowitsch   PetscCall(DMFieldCreate(dm,numComponents,DMFIELD_VERTEX,&b));
11169566063dSJacob Faibussowitsch   PetscCall(DMFieldSetType(b,DMFIELDDS));
111751a454edSToby Isaac   dsfield = (DMField_DS *) b->data;
111851a454edSToby Isaac   dsfield->fieldNum = fieldNum;
11199566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm,&dsfield->height));
1120f99c8401SToby Isaac   dsfield->height++;
11219566063dSJacob Faibussowitsch   PetscCall(PetscCalloc1(dsfield->height,&dsfield->disc));
112251a454edSToby Isaac   dsfield->disc[0] = disc;
11239566063dSJacob Faibussowitsch   PetscCall(PetscObjectReference((PetscObject)vec));
112451a454edSToby Isaac   dsfield->vec = vec;
112551a454edSToby Isaac   *field = b;
112651a454edSToby Isaac 
112751a454edSToby Isaac   PetscFunctionReturn(0);
112851a454edSToby Isaac }
1129