xref: /petsc/src/dm/field/impls/ds/dmfieldds.c (revision 2f613bf53f46f9356e00a2ca2bd69453be72fc31)
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   PetscErrorCode ierr;
2251a454edSToby Isaac 
2351a454edSToby Isaac   PetscFunctionBegin;
2451a454edSToby Isaac   dsfield = (DMField_DS *) field->data;
2551a454edSToby Isaac   ierr = VecDestroy(&dsfield->vec);CHKERRQ(ierr);
2651a454edSToby Isaac   for (i = 0; i < dsfield->height; i++) {
2751a454edSToby Isaac     ierr = PetscObjectDereference(dsfield->disc[i]);CHKERRQ(ierr);
2851a454edSToby Isaac   }
2951a454edSToby Isaac   ierr = PetscFree(dsfield->disc);CHKERRQ(ierr);
3051a454edSToby Isaac   ierr = PetscFree(dsfield);CHKERRQ(ierr);
3151a454edSToby Isaac   PetscFunctionReturn(0);
3251a454edSToby Isaac }
3351a454edSToby Isaac 
3451a454edSToby Isaac static PetscErrorCode DMFieldView_DS(DMField field,PetscViewer viewer)
3551a454edSToby Isaac {
3651a454edSToby Isaac   DMField_DS     *dsfield = (DMField_DS *) field->data;
3751a454edSToby Isaac   PetscBool      iascii;
3851a454edSToby Isaac   PetscObject    disc;
3951a454edSToby Isaac   PetscErrorCode ierr;
4051a454edSToby Isaac 
4151a454edSToby Isaac   PetscFunctionBegin;
4251a454edSToby Isaac   ierr = PetscObjectTypeCompare((PetscObject)viewer,PETSCVIEWERASCII,&iascii);CHKERRQ(ierr);
4351a454edSToby Isaac   disc = dsfield->disc[0];
4451a454edSToby Isaac   if (iascii) {
45*2f613bf5SBarry Smith     ierr = PetscViewerASCIIPrintf(viewer, "PetscDS field %D\n",dsfield->fieldNum);CHKERRQ(ierr);
4651a454edSToby Isaac     ierr = PetscViewerASCIIPushTab(viewer);CHKERRQ(ierr);
4751a454edSToby Isaac     ierr = PetscObjectView(disc,viewer);CHKERRQ(ierr);
4851a454edSToby Isaac     ierr = PetscViewerASCIIPopTab(viewer);CHKERRQ(ierr);
4951a454edSToby Isaac   }
5051a454edSToby Isaac   ierr = PetscViewerASCIIPushTab(viewer);CHKERRQ(ierr);
512f7452b8SBarry Smith   if (dsfield->multifieldVec) SETERRQ(PetscObjectComm((PetscObject)field),PETSC_ERR_SUP,"View of subfield not implemented yet");
5251a454edSToby Isaac   ierr = VecView(dsfield->vec,viewer);CHKERRQ(ierr);
5351a454edSToby Isaac   ierr = PetscViewerASCIIPopTab(viewer);CHKERRQ(ierr);
5451a454edSToby Isaac   PetscFunctionReturn(0);
5551a454edSToby Isaac }
5651a454edSToby Isaac 
5751a454edSToby Isaac static PetscErrorCode DMFieldDSGetHeightDisc(DMField field, PetscInt height, PetscObject *disc)
5851a454edSToby Isaac {
5951a454edSToby Isaac   DMField_DS     *dsfield = (DMField_DS *) field->data;
6051a454edSToby Isaac   PetscErrorCode ierr;
6151a454edSToby Isaac 
6251a454edSToby Isaac   PetscFunctionBegin;
6351a454edSToby Isaac   if (!dsfield->disc[height]) {
6451a454edSToby Isaac     PetscClassId   id;
6551a454edSToby Isaac 
6651a454edSToby Isaac     ierr = PetscObjectGetClassId(dsfield->disc[0],&id);CHKERRQ(ierr);
6751a454edSToby Isaac     if (id == PETSCFE_CLASSID) {
6851a454edSToby Isaac       PetscFE fe = (PetscFE) dsfield->disc[0];
6951a454edSToby Isaac 
7051a454edSToby Isaac       ierr = PetscFECreateHeightTrace(fe,height,(PetscFE *)&dsfield->disc[height]);CHKERRQ(ierr);
7151a454edSToby Isaac     }
7251a454edSToby Isaac   }
7351a454edSToby Isaac   *disc = dsfield->disc[height];
7451a454edSToby Isaac   PetscFunctionReturn(0);
7551a454edSToby Isaac }
7651a454edSToby Isaac 
7762bd480fSMatthew G. Knepley /* y[m,c] = A[m,n,c] . b[n] */
7851a454edSToby Isaac #define DMFieldDSdot(y,A,b,m,n,c,cast)                                           \
7951a454edSToby Isaac   do {                                                                           \
8051a454edSToby Isaac     PetscInt _i, _j, _k;                                                         \
8151a454edSToby Isaac     for (_i = 0; _i < (m); _i++) {                                               \
8251a454edSToby Isaac       for (_k = 0; _k < (c); _k++) {                                             \
8351a454edSToby Isaac         (y)[_i * (c) + _k] = 0.;                                                 \
8451a454edSToby Isaac       }                                                                          \
8551a454edSToby Isaac       for (_j = 0; _j < (n); _j++) {                                             \
8651a454edSToby Isaac         for (_k = 0; _k < (c); _k++) {                                           \
8751a454edSToby Isaac           (y)[_i * (c) + _k] += (A)[(_i * (n) + _j) * (c) + _k] * cast((b)[_j]); \
8851a454edSToby Isaac         }                                                                        \
8951a454edSToby Isaac       }                                                                          \
9051a454edSToby Isaac     }                                                                            \
9151a454edSToby Isaac   } while (0)
9251a454edSToby Isaac 
93ef0bb6c7SMatthew G. Knepley /* TODO: Reorganize interface so that I can reuse a tabulation rather than mallocing each time */
9451a454edSToby Isaac static PetscErrorCode DMFieldEvaluateFE_DS(DMField field, IS pointIS, PetscQuadrature quad, PetscDataType type, void *B, void *D, void *H)
9551a454edSToby Isaac {
9651a454edSToby Isaac   DMField_DS      *dsfield = (DMField_DS *) field->data;
9751a454edSToby Isaac   DM              dm;
9851a454edSToby Isaac   PetscObject     disc;
9951a454edSToby Isaac   PetscClassId    classid;
10051a454edSToby Isaac   PetscInt        nq, nc, dim, meshDim, numCells;
10151a454edSToby Isaac   PetscSection    section;
10251a454edSToby Isaac   const PetscReal *qpoints;
10351a454edSToby Isaac   PetscBool       isStride;
10451a454edSToby Isaac   const PetscInt  *points = NULL;
10551a454edSToby Isaac   PetscInt        sfirst = -1, stride = -1;
10651a454edSToby Isaac   PetscErrorCode  ierr;
10751a454edSToby Isaac 
10851a454edSToby Isaac   PetscFunctionBeginHot;
10951a454edSToby Isaac   dm   = field->dm;
11051a454edSToby Isaac   nc   = field->numComponents;
11151a454edSToby Isaac   ierr = PetscQuadratureGetData(quad,&dim,NULL,&nq,&qpoints,NULL);CHKERRQ(ierr);
112f99c8401SToby Isaac   ierr = DMFieldDSGetHeightDisc(field,dsfield->height - 1 - dim,&disc);CHKERRQ(ierr);
11351a454edSToby Isaac   ierr = DMGetDimension(dm,&meshDim);CHKERRQ(ierr);
11492fd8e1eSJed Brown   ierr = DMGetLocalSection(dm,&section);CHKERRQ(ierr);
11551a454edSToby Isaac   ierr = PetscSectionGetField(section,dsfield->fieldNum,&section);CHKERRQ(ierr);
11651a454edSToby Isaac   ierr = PetscObjectGetClassId(disc,&classid);CHKERRQ(ierr);
11751a454edSToby Isaac   /* TODO: batch */
11851a454edSToby Isaac   ierr = PetscObjectTypeCompare((PetscObject)pointIS,ISSTRIDE,&isStride);CHKERRQ(ierr);
11951a454edSToby Isaac   ierr = ISGetLocalSize(pointIS,&numCells);CHKERRQ(ierr);
12051a454edSToby Isaac   if (isStride) {
12151a454edSToby Isaac     ierr = ISStrideGetInfo(pointIS,&sfirst,&stride);CHKERRQ(ierr);
12251a454edSToby Isaac   } else {
12351a454edSToby Isaac     ierr = ISGetIndices(pointIS,&points);CHKERRQ(ierr);
12451a454edSToby Isaac   }
12551a454edSToby Isaac   if (classid == PETSCFE_CLASSID) {
12651a454edSToby Isaac     PetscFE      fe = (PetscFE) disc;
12751a454edSToby Isaac     PetscInt     feDim, i;
128ef0bb6c7SMatthew G. Knepley     PetscInt          K = H ? 2 : (D ? 1 : (B ? 0 : -1));
129ef0bb6c7SMatthew G. Knepley     PetscTabulation   T;
13051a454edSToby Isaac 
13151a454edSToby Isaac     ierr = PetscFEGetDimension(fe,&feDim);CHKERRQ(ierr);
132ef0bb6c7SMatthew G. Knepley     ierr = PetscFECreateTabulation(fe,1,nq,qpoints,K,&T);CHKERRQ(ierr);
13351a454edSToby Isaac     for (i = 0; i < numCells; i++) {
13451a454edSToby Isaac       PetscInt     c = isStride ? (sfirst + i * stride) : points[i];
1352710589cSToby Isaac       PetscInt     closureSize;
1362710589cSToby Isaac       PetscScalar *elem = NULL;
13751a454edSToby Isaac 
13851a454edSToby Isaac       ierr = DMPlexVecGetClosure(dm,section,dsfield->vec,c,&closureSize,&elem);CHKERRQ(ierr);
13951a454edSToby Isaac       if (B) {
14062bd480fSMatthew G. Knepley         /* field[c] = T[q,b,c] . coef[b], so v[c] = T[q,b,c] . coords[b] */
14151a454edSToby Isaac         if (type == PETSC_SCALAR) {
14251a454edSToby Isaac           PetscScalar *cB = &((PetscScalar *) B)[nc * nq * i];
14351a454edSToby Isaac 
144ef0bb6c7SMatthew G. Knepley           DMFieldDSdot(cB,T->T[0],elem,nq,feDim,nc,(PetscScalar));
14551a454edSToby Isaac         } else {
14651a454edSToby Isaac           PetscReal *cB = &((PetscReal *) B)[nc * nq * i];
14751a454edSToby Isaac 
148ef0bb6c7SMatthew G. Knepley           DMFieldDSdot(cB,T->T[0],elem,nq,feDim,nc,PetscRealPart);
14951a454edSToby Isaac         }
15051a454edSToby Isaac       }
15151a454edSToby Isaac       if (D) {
15251a454edSToby Isaac         if (type == PETSC_SCALAR) {
15351a454edSToby Isaac           PetscScalar *cD = &((PetscScalar *) D)[nc * nq * dim * i];
15451a454edSToby Isaac 
155ef0bb6c7SMatthew G. Knepley           DMFieldDSdot(cD,T->T[1],elem,nq,feDim,(nc * dim),(PetscScalar));
15651a454edSToby Isaac         } else {
15751a454edSToby Isaac           PetscReal *cD = &((PetscReal *) D)[nc * nq * dim * i];
15851a454edSToby Isaac 
159ef0bb6c7SMatthew G. Knepley           DMFieldDSdot(cD,T->T[1],elem,nq,feDim,(nc * dim),PetscRealPart);
16051a454edSToby Isaac         }
16151a454edSToby Isaac       }
16251a454edSToby Isaac       if (H) {
16351a454edSToby Isaac         if (type == PETSC_SCALAR) {
16451a454edSToby Isaac           PetscScalar *cH = &((PetscScalar *) H)[nc * nq * dim * dim * i];
16551a454edSToby Isaac 
166ef0bb6c7SMatthew G. Knepley           DMFieldDSdot(cH,T->T[2],elem,nq,feDim,(nc * dim * dim),(PetscScalar));
16751a454edSToby Isaac         } else {
16851a454edSToby Isaac           PetscReal *cH = &((PetscReal *) H)[nc * nq * dim * dim * i];
16951a454edSToby Isaac 
170ef0bb6c7SMatthew G. Knepley           DMFieldDSdot(cH,T->T[2],elem,nq,feDim,(nc * dim * dim),PetscRealPart);
17151a454edSToby Isaac         }
17251a454edSToby Isaac       }
1732710589cSToby Isaac       ierr = DMPlexVecRestoreClosure(dm,section,dsfield->vec,c,&closureSize,&elem);CHKERRQ(ierr);
17451a454edSToby Isaac     }
175ef0bb6c7SMatthew G. Knepley     ierr = PetscTabulationDestroy(&T);CHKERRQ(ierr);
1762da392ccSBarry Smith   } else SETERRQ(PetscObjectComm((PetscObject)field),PETSC_ERR_SUP,"Not implemented");
17751a454edSToby Isaac   if (!isStride) {
17851a454edSToby Isaac     ierr = ISRestoreIndices(pointIS,&points);CHKERRQ(ierr);
17951a454edSToby Isaac   }
18051a454edSToby Isaac   PetscFunctionReturn(0);
18151a454edSToby Isaac }
18251a454edSToby Isaac 
183a6216909SToby Isaac static PetscErrorCode DMFieldEvaluate_DS(DMField field, Vec points, PetscDataType datatype, void *B, void *D, void *H)
184a6216909SToby Isaac {
185a6216909SToby Isaac   DMField_DS        *dsfield = (DMField_DS *) field->data;
186a6216909SToby Isaac   PetscSF            cellSF = NULL;
187a6216909SToby Isaac   const PetscSFNode *cells;
188a6216909SToby Isaac   PetscInt           c, nFound, numCells, feDim, nc;
189a6216909SToby Isaac   const PetscInt    *cellDegrees;
190a6216909SToby Isaac   const PetscScalar *pointsArray;
191a6216909SToby Isaac   PetscScalar       *cellPoints;
192a6216909SToby Isaac   PetscInt           gatherSize, gatherMax;
193a6216909SToby Isaac   PetscInt           dim, dimR, offset;
194a6216909SToby Isaac   MPI_Datatype       pointType;
195a6216909SToby Isaac   PetscObject        cellDisc;
196a6216909SToby Isaac   PetscFE            cellFE;
197a6216909SToby Isaac   PetscClassId       discID;
198a6216909SToby Isaac   PetscReal         *coordsReal, *coordsRef;
199a6216909SToby Isaac   PetscSection       section;
200a6216909SToby Isaac   PetscScalar       *cellBs = NULL, *cellDs = NULL, *cellHs = NULL;
201a6216909SToby Isaac   PetscReal         *cellBr = NULL, *cellDr = NULL, *cellHr = NULL;
2024cbe5319SToby Isaac   PetscReal         *v, *J, *invJ, *detJ;
203a6216909SToby Isaac   PetscErrorCode     ierr;
204a6216909SToby Isaac 
205a6216909SToby Isaac   PetscFunctionBegin;
206a6216909SToby Isaac   nc   = field->numComponents;
20792fd8e1eSJed Brown   ierr = DMGetLocalSection(field->dm,&section);CHKERRQ(ierr);
208a6216909SToby Isaac   ierr = DMFieldDSGetHeightDisc(field,0,&cellDisc);CHKERRQ(ierr);
209a6216909SToby Isaac   ierr = PetscObjectGetClassId(cellDisc, &discID);CHKERRQ(ierr);
210a6216909SToby Isaac   if (discID != PETSCFE_CLASSID) SETERRQ(PETSC_COMM_SELF,PETSC_ERR_PLIB, "Discretization type not supported\n");
211a6216909SToby Isaac   cellFE = (PetscFE) cellDisc;
212a6216909SToby Isaac   ierr = PetscFEGetDimension(cellFE,&feDim);CHKERRQ(ierr);
213a6216909SToby Isaac   ierr = DMGetCoordinateDim(field->dm, &dim);CHKERRQ(ierr);
214a6216909SToby Isaac   ierr = DMGetDimension(field->dm, &dimR);CHKERRQ(ierr);
215a6216909SToby Isaac   ierr = DMLocatePoints(field->dm, points, DM_POINTLOCATION_NONE, &cellSF);CHKERRQ(ierr);
216a6216909SToby Isaac   ierr = PetscSFGetGraph(cellSF, &numCells, &nFound, NULL, &cells);CHKERRQ(ierr);
217a6216909SToby Isaac   for (c = 0; c < nFound; c++) {
218a6216909SToby Isaac     if (cells[c].index < 0) SETERRQ1(PetscObjectComm((PetscObject)points),PETSC_ERR_ARG_WRONG, "Point %D could not be located\n", c);
219a6216909SToby Isaac   }
220a6216909SToby Isaac   ierr = PetscSFComputeDegreeBegin(cellSF,&cellDegrees);CHKERRQ(ierr);
221a6216909SToby Isaac   ierr = PetscSFComputeDegreeEnd(cellSF,&cellDegrees);CHKERRQ(ierr);
222a6216909SToby Isaac   for (c = 0, gatherSize = 0, gatherMax = 0; c < numCells; c++) {
223a6216909SToby Isaac     gatherMax = PetscMax(gatherMax,cellDegrees[c]);
224a6216909SToby Isaac     gatherSize += cellDegrees[c];
225a6216909SToby Isaac   }
226a6216909SToby Isaac   ierr = PetscMalloc3(gatherSize*dim,&cellPoints,gatherMax*dim,&coordsReal,gatherMax*dimR,&coordsRef);CHKERRQ(ierr);
2274cbe5319SToby Isaac   ierr = PetscMalloc4(gatherMax*dimR,&v,gatherMax*dimR*dimR,&J,gatherMax*dimR*dimR,&invJ,gatherMax,&detJ);CHKERRQ(ierr);
228a6216909SToby Isaac   if (datatype == PETSC_SCALAR) {
229a6216909SToby Isaac     ierr = PetscMalloc3(B ? nc * gatherSize : 0, &cellBs, D ? nc * dim * gatherSize : 0, &cellDs, H ? nc * dim * dim * gatherSize : 0, &cellHs);CHKERRQ(ierr);
230a6216909SToby Isaac   } else {
231a6216909SToby Isaac     ierr = PetscMalloc3(B ? nc * gatherSize : 0, &cellBr, D ? nc * dim * gatherSize : 0, &cellDr, H ? nc * dim * dim * gatherSize : 0, &cellHr);CHKERRQ(ierr);
232a6216909SToby Isaac   }
233a6216909SToby Isaac 
234ffc4695bSBarry Smith   ierr = MPI_Type_contiguous(dim,MPIU_SCALAR,&pointType);CHKERRMPI(ierr);
235ffc4695bSBarry Smith   ierr = MPI_Type_commit(&pointType);CHKERRMPI(ierr);
236a6216909SToby Isaac   ierr = VecGetArrayRead(points,&pointsArray);CHKERRQ(ierr);
237a6216909SToby Isaac   ierr = PetscSFGatherBegin(cellSF, pointType, pointsArray, cellPoints);CHKERRQ(ierr);
238a6216909SToby Isaac   ierr = PetscSFGatherEnd(cellSF, pointType, pointsArray, cellPoints);CHKERRQ(ierr);
239a6216909SToby Isaac   ierr = VecRestoreArrayRead(points,&pointsArray);CHKERRQ(ierr);
240a6216909SToby Isaac   for (c = 0, offset = 0; c < numCells; c++) {
241a6216909SToby Isaac     PetscInt nq = cellDegrees[c], p;
242a6216909SToby Isaac 
243a6216909SToby Isaac     if (nq) {
244ef0bb6c7SMatthew G. Knepley       PetscInt          K = H ? 2 : (D ? 1 : (B ? 0 : -1));
245ef0bb6c7SMatthew G. Knepley       PetscTabulation   T;
246a6216909SToby Isaac       PetscInt     closureSize;
247a6216909SToby Isaac       PetscScalar *elem = NULL;
2484cbe5319SToby Isaac       PetscReal   *quadPoints;
2494cbe5319SToby Isaac       PetscQuadrature quad;
2504cbe5319SToby Isaac       PetscInt d, e, f, g;
251a6216909SToby Isaac 
2524d1a973fSToby Isaac       for (p = 0; p < dim * nq; p++) coordsReal[p] = PetscRealPart(cellPoints[dim * offset + p]);
253a6216909SToby Isaac       ierr = DMPlexCoordinatesToReference(field->dm, c, nq, coordsReal, coordsRef);CHKERRQ(ierr);
254ef0bb6c7SMatthew G. Knepley       ierr = PetscFECreateTabulation(cellFE,1,nq,coordsRef,K,&T);CHKERRQ(ierr);
2554cbe5319SToby Isaac       ierr = PetscQuadratureCreate(PETSC_COMM_SELF, &quad);CHKERRQ(ierr);
2564cbe5319SToby Isaac       ierr = PetscMalloc1(dimR * nq, &quadPoints);CHKERRQ(ierr);
2574cbe5319SToby Isaac       for (p = 0; p < dimR * nq; p++) quadPoints[p] = coordsRef[p];
2584cbe5319SToby Isaac       ierr = PetscQuadratureSetData(quad, dimR, 0, nq, quadPoints, NULL);CHKERRQ(ierr);
2594cbe5319SToby Isaac       ierr = DMPlexComputeCellGeometryFEM(field->dm, c, quad, v, J, invJ, detJ);CHKERRQ(ierr);
2604cbe5319SToby Isaac       ierr = PetscQuadratureDestroy(&quad);CHKERRQ(ierr);
261a6216909SToby Isaac       ierr = DMPlexVecGetClosure(field->dm,section,dsfield->vec,c,&closureSize,&elem);CHKERRQ(ierr);
262a6216909SToby Isaac       if (B) {
263a6216909SToby Isaac         if (datatype == PETSC_SCALAR) {
264a6216909SToby Isaac           PetscScalar *cB = &cellBs[nc * offset];
265a6216909SToby Isaac 
266ef0bb6c7SMatthew G. Knepley           DMFieldDSdot(cB,T->T[0],elem,nq,feDim,nc,(PetscScalar));
267a6216909SToby Isaac         } else {
268a6216909SToby Isaac           PetscReal *cB = &cellBr[nc * offset];
269a6216909SToby Isaac 
270ef0bb6c7SMatthew G. Knepley           DMFieldDSdot(cB,T->T[0],elem,nq,feDim,nc,PetscRealPart);
271a6216909SToby Isaac         }
272a6216909SToby Isaac       }
273a6216909SToby Isaac       if (D) {
274a6216909SToby Isaac         if (datatype == PETSC_SCALAR) {
275a6216909SToby Isaac           PetscScalar *cD = &cellDs[nc * dim * offset];
276a6216909SToby Isaac 
277ef0bb6c7SMatthew G. Knepley           DMFieldDSdot(cD,T->T[1],elem,nq,feDim,(nc * dim),(PetscScalar));
2784cbe5319SToby Isaac           for (p = 0; p < nq; p++) {
2794cbe5319SToby Isaac             for (g = 0; g < nc; g++) {
2804d1a973fSToby Isaac               PetscScalar vs[3];
2814d1a973fSToby Isaac 
2824cbe5319SToby Isaac               for (d = 0; d < dimR; d++) {
2834d1a973fSToby Isaac                 vs[d] = 0.;
2844cbe5319SToby Isaac                 for (e = 0; e < dimR; e++) {
2854d1a973fSToby Isaac                   vs[d] += invJ[dimR * dimR * p + e * dimR + d] * cD[(nc * p + g) * dimR + e];
2864cbe5319SToby Isaac                 }
2874cbe5319SToby Isaac               }
2884cbe5319SToby Isaac               for (d = 0; d < dimR; d++) {
2894d1a973fSToby Isaac                 cD[(nc * p + g) * dimR + d] = vs[d];
2904cbe5319SToby Isaac               }
2914cbe5319SToby Isaac             }
2924cbe5319SToby Isaac           }
293a6216909SToby Isaac         } else {
294a6216909SToby Isaac           PetscReal *cD = &cellDr[nc * dim * offset];
295a6216909SToby Isaac 
296ef0bb6c7SMatthew G. Knepley           DMFieldDSdot(cD,T->T[1],elem,nq,feDim,(nc * dim),PetscRealPart);
2974cbe5319SToby Isaac           for (p = 0; p < nq; p++) {
2984cbe5319SToby Isaac             for (g = 0; g < nc; g++) {
2994cbe5319SToby Isaac               for (d = 0; d < dimR; d++) {
3004cbe5319SToby Isaac                 v[d] = 0.;
3014cbe5319SToby Isaac                 for (e = 0; e < dimR; e++) {
3024cbe5319SToby Isaac                   v[d] += invJ[dimR * dimR * p + e * dimR + d] * cD[(nc * p + g) * dimR + e];
3034cbe5319SToby Isaac                 }
3044cbe5319SToby Isaac               }
3054cbe5319SToby Isaac               for (d = 0; d < dimR; d++) {
3064cbe5319SToby Isaac                 cD[(nc * p + g) * dimR + d] = v[d];
3074cbe5319SToby Isaac               }
3084cbe5319SToby Isaac             }
3094cbe5319SToby Isaac           }
310a6216909SToby Isaac         }
311a6216909SToby Isaac       }
312a6216909SToby Isaac       if (H) {
313a6216909SToby Isaac         if (datatype == PETSC_SCALAR) {
314a6216909SToby Isaac           PetscScalar *cH = &cellHs[nc * dim * dim * offset];
315a6216909SToby Isaac 
316ef0bb6c7SMatthew G. Knepley           DMFieldDSdot(cH,T->T[2],elem,nq,feDim,(nc * dim * dim),(PetscScalar));
3174cbe5319SToby Isaac           for (p = 0; p < nq; p++) {
3184cbe5319SToby Isaac             for (g = 0; g < nc * dimR; g++) {
3194d1a973fSToby Isaac               PetscScalar vs[3];
3204d1a973fSToby Isaac 
3214cbe5319SToby Isaac               for (d = 0; d < dimR; d++) {
3224d1a973fSToby Isaac                 vs[d] = 0.;
3234cbe5319SToby Isaac                 for (e = 0; e < dimR; e++) {
3244d1a973fSToby Isaac                   vs[d] += invJ[dimR * dimR * p + e * dimR + d] * cH[(nc * dimR * p + g) * dimR + e];
3254cbe5319SToby Isaac                 }
3264cbe5319SToby Isaac               }
3274cbe5319SToby Isaac               for (d = 0; d < dimR; d++) {
3284d1a973fSToby Isaac                 cH[(nc * dimR * p + g) * dimR + d] = vs[d];
3294cbe5319SToby Isaac               }
3304cbe5319SToby Isaac             }
3314cbe5319SToby Isaac             for (g = 0; g < nc; g++) {
3324cbe5319SToby Isaac               for (f = 0; f < dimR; f++) {
3334d1a973fSToby Isaac                 PetscScalar vs[3];
3344d1a973fSToby Isaac 
3354cbe5319SToby Isaac                 for (d = 0; d < dimR; d++) {
3364d1a973fSToby Isaac                   vs[d] = 0.;
3374cbe5319SToby Isaac                   for (e = 0; e < dimR; e++) {
3384d1a973fSToby Isaac                     vs[d] += invJ[dimR * dimR * p + e * dimR + d] * cH[((nc * p + g) * dimR + e) * dimR + f];
3394cbe5319SToby Isaac                   }
3404cbe5319SToby Isaac                 }
3414cbe5319SToby Isaac                 for (d = 0; d < dimR; d++) {
3424d1a973fSToby Isaac                   cH[((nc * p + g) * dimR + d) * dimR + f] = vs[d];
3434cbe5319SToby Isaac                 }
3444cbe5319SToby Isaac               }
3454cbe5319SToby Isaac             }
3464cbe5319SToby Isaac           }
347a6216909SToby Isaac         } else {
348a6216909SToby Isaac           PetscReal *cH = &cellHr[nc * dim * dim * offset];
349a6216909SToby Isaac 
350ef0bb6c7SMatthew G. Knepley           DMFieldDSdot(cH,T->T[2],elem,nq,feDim,(nc * dim * dim),PetscRealPart);
3514cbe5319SToby Isaac           for (p = 0; p < nq; p++) {
3524cbe5319SToby Isaac             for (g = 0; g < nc * dimR; g++) {
3534cbe5319SToby Isaac               for (d = 0; d < dimR; d++) {
3544cbe5319SToby Isaac                 v[d] = 0.;
3554cbe5319SToby Isaac                 for (e = 0; e < dimR; e++) {
3564cbe5319SToby Isaac                   v[d] += invJ[dimR * dimR * p + e * dimR + d] * cH[(nc * dimR * p + g) * dimR + e];
3574cbe5319SToby Isaac                 }
3584cbe5319SToby Isaac               }
3594cbe5319SToby Isaac               for (d = 0; d < dimR; d++) {
3604cbe5319SToby Isaac                 cH[(nc * dimR * p + g) * dimR + d] = v[d];
3614cbe5319SToby Isaac               }
3624cbe5319SToby Isaac             }
3634cbe5319SToby Isaac             for (g = 0; g < nc; g++) {
3644cbe5319SToby Isaac               for (f = 0; f < dimR; f++) {
3654cbe5319SToby Isaac                 for (d = 0; d < dimR; d++) {
3664cbe5319SToby Isaac                   v[d] = 0.;
3674cbe5319SToby Isaac                   for (e = 0; e < dimR; e++) {
3684cbe5319SToby Isaac                     v[d] += invJ[dimR * dimR * p + e * dimR + d] * cH[((nc * p + g) * dimR + e) * dimR + f];
3694cbe5319SToby Isaac                   }
3704cbe5319SToby Isaac                 }
3714cbe5319SToby Isaac                 for (d = 0; d < dimR; d++) {
3724cbe5319SToby Isaac                   cH[((nc * p + g) * dimR + d) * dimR + f] = v[d];
3734cbe5319SToby Isaac                 }
3744cbe5319SToby Isaac               }
3754cbe5319SToby Isaac             }
3764cbe5319SToby Isaac           }
377a6216909SToby Isaac         }
378a6216909SToby Isaac       }
379a6216909SToby Isaac       ierr = DMPlexVecRestoreClosure(field->dm,section,dsfield->vec,c,&closureSize,&elem);CHKERRQ(ierr);
380ef0bb6c7SMatthew G. Knepley       ierr = PetscTabulationDestroy(&T);CHKERRQ(ierr);
381a6216909SToby Isaac     }
382a6216909SToby Isaac     offset += nq;
383a6216909SToby Isaac   }
384a6216909SToby Isaac   {
385a6216909SToby Isaac     MPI_Datatype origtype;
3864cbe5319SToby Isaac 
387a6216909SToby Isaac     if (datatype == PETSC_SCALAR) {
388a6216909SToby Isaac       origtype = MPIU_SCALAR;
389a6216909SToby Isaac     } else {
390a6216909SToby Isaac       origtype = MPIU_REAL;
391a6216909SToby Isaac     }
392a6216909SToby Isaac     if (B) {
393a6216909SToby Isaac       MPI_Datatype Btype;
394a6216909SToby Isaac 
395ffc4695bSBarry Smith       ierr = MPI_Type_contiguous(nc, origtype, &Btype);CHKERRMPI(ierr);
396ffc4695bSBarry Smith       ierr = MPI_Type_commit(&Btype);CHKERRMPI(ierr);
3974d1a973fSToby Isaac       ierr = PetscSFScatterBegin(cellSF,Btype,(datatype == PETSC_SCALAR) ? (void *) cellBs : (void *) cellBr, B);CHKERRQ(ierr);
3984d1a973fSToby Isaac       ierr = PetscSFScatterEnd(cellSF,Btype,(datatype == PETSC_SCALAR) ? (void *) cellBs : (void *) cellBr, B);CHKERRQ(ierr);
399ffc4695bSBarry Smith       ierr = MPI_Type_free(&Btype);CHKERRMPI(ierr);
400a6216909SToby Isaac     }
401a6216909SToby Isaac     if (D) {
402a6216909SToby Isaac       MPI_Datatype Dtype;
403a6216909SToby Isaac 
404ffc4695bSBarry Smith       ierr = MPI_Type_contiguous(nc * dim, origtype, &Dtype);CHKERRMPI(ierr);
405ffc4695bSBarry Smith       ierr = MPI_Type_commit(&Dtype);CHKERRMPI(ierr);
4064d1a973fSToby Isaac       ierr = PetscSFScatterBegin(cellSF,Dtype,(datatype == PETSC_SCALAR) ? (void *) cellDs : (void *) cellDr, D);CHKERRQ(ierr);
4074d1a973fSToby Isaac       ierr = PetscSFScatterEnd(cellSF,Dtype,(datatype == PETSC_SCALAR) ? (void *) cellDs : (void *) cellDr, D);CHKERRQ(ierr);
408ffc4695bSBarry Smith       ierr = MPI_Type_free(&Dtype);CHKERRMPI(ierr);
409a6216909SToby Isaac     }
410a6216909SToby Isaac     if (H) {
411a6216909SToby Isaac       MPI_Datatype Htype;
412a6216909SToby Isaac 
413ffc4695bSBarry Smith       ierr = MPI_Type_contiguous(nc * dim * dim, origtype, &Htype);CHKERRMPI(ierr);
414ffc4695bSBarry Smith       ierr = MPI_Type_commit(&Htype);CHKERRMPI(ierr);
4154d1a973fSToby Isaac       ierr = PetscSFScatterBegin(cellSF,Htype,(datatype == PETSC_SCALAR) ? (void *) cellHs : (void *) cellHr, H);CHKERRQ(ierr);
4164d1a973fSToby Isaac       ierr = PetscSFScatterEnd(cellSF,Htype,(datatype == PETSC_SCALAR) ? (void *) cellHs : (void *) cellHr, H);CHKERRQ(ierr);
417ffc4695bSBarry Smith       ierr = MPI_Type_free(&Htype);CHKERRMPI(ierr);
418a6216909SToby Isaac     }
419a6216909SToby Isaac   }
4204cbe5319SToby Isaac   ierr = PetscFree4(v,J,invJ,detJ);CHKERRQ(ierr);
421a6216909SToby Isaac   ierr = PetscFree3(cellBr, cellDr, cellHr);CHKERRQ(ierr);
422a6216909SToby Isaac   ierr = PetscFree3(cellBs, cellDs, cellHs);CHKERRQ(ierr);
423a6216909SToby Isaac   ierr = PetscFree3(cellPoints,coordsReal,coordsRef);CHKERRQ(ierr);
424ffc4695bSBarry Smith   ierr = MPI_Type_free(&pointType);CHKERRMPI(ierr);
425a6216909SToby Isaac   ierr = PetscSFDestroy(&cellSF);CHKERRQ(ierr);
426a6216909SToby Isaac   PetscFunctionReturn(0);
427a6216909SToby Isaac }
428a6216909SToby Isaac 
429805e7170SToby Isaac static PetscErrorCode DMFieldEvaluateFV_DS(DMField field, IS pointIS, PetscDataType type, void *B, void *D, void *H)
430805e7170SToby Isaac {
431805e7170SToby Isaac   DMField_DS      *dsfield = (DMField_DS *) field->data;
432805e7170SToby Isaac   PetscInt         h, imin;
433805e7170SToby Isaac   PetscInt         dim;
434805e7170SToby Isaac   PetscClassId     id;
435805e7170SToby Isaac   PetscQuadrature  quad = NULL;
436b7260050SToby Isaac   PetscInt         maxDegree;
437805e7170SToby Isaac   PetscFEGeom      *geom;
438805e7170SToby Isaac   PetscInt         Nq, Nc, dimC, qNc, N;
439805e7170SToby Isaac   PetscInt         numPoints;
440805e7170SToby Isaac   void            *qB = NULL, *qD = NULL, *qH = NULL;
441805e7170SToby Isaac   const PetscReal *weights;
442805e7170SToby Isaac   MPI_Datatype     mpitype = type == PETSC_SCALAR ? MPIU_SCALAR : MPIU_REAL;
443805e7170SToby Isaac   PetscObject      disc;
444805e7170SToby Isaac   DMField          coordField;
445805e7170SToby Isaac   PetscErrorCode   ierr;
446805e7170SToby Isaac 
447805e7170SToby Isaac   PetscFunctionBegin;
448805e7170SToby Isaac   Nc = field->numComponents;
449805e7170SToby Isaac   ierr = DMGetCoordinateDim(field->dm, &dimC);CHKERRQ(ierr);
450805e7170SToby Isaac   ierr = DMGetDimension(field->dm, &dim);CHKERRQ(ierr);
451c4e6da2cSBarry Smith   ierr = ISGetLocalSize(pointIS, &numPoints);CHKERRQ(ierr);
452805e7170SToby Isaac   ierr = ISGetMinMax(pointIS,&imin,NULL);CHKERRQ(ierr);
453805e7170SToby Isaac   for (h = 0; h < dsfield->height; h++) {
454805e7170SToby Isaac     PetscInt hEnd;
455805e7170SToby Isaac 
456805e7170SToby Isaac     ierr = DMPlexGetHeightStratum(field->dm,h,NULL,&hEnd);CHKERRQ(ierr);
457805e7170SToby Isaac     if (imin < hEnd) break;
458805e7170SToby Isaac   }
459805e7170SToby Isaac   dim -= h;
460805e7170SToby Isaac   ierr = DMFieldDSGetHeightDisc(field,h,&disc);CHKERRQ(ierr);
461805e7170SToby Isaac   ierr = PetscObjectGetClassId(disc,&id);CHKERRQ(ierr);
462805e7170SToby Isaac   if (id != PETSCFE_CLASSID) SETERRQ(PETSC_COMM_SELF, PETSC_ERR_PLIB, "Discretization not supported\n");
463805e7170SToby Isaac   ierr = DMGetCoordinateField(field->dm, &coordField);CHKERRQ(ierr);
464b7260050SToby Isaac   ierr = DMFieldGetDegree(coordField, pointIS, NULL, &maxDegree);CHKERRQ(ierr);
465b7260050SToby Isaac   if (maxDegree <= 1) {
466805e7170SToby Isaac     ierr = DMFieldCreateDefaultQuadrature(coordField, pointIS, &quad);CHKERRQ(ierr);
467805e7170SToby Isaac   }
468805e7170SToby Isaac   if (!quad) {ierr = DMFieldCreateDefaultQuadrature(field, pointIS, &quad);CHKERRQ(ierr);}
469805e7170SToby Isaac   if (!quad) SETERRQ(PETSC_COMM_SELF, PETSC_ERR_PLIB, "Could not determine quadrature for cell averages\n");
470805e7170SToby Isaac   ierr = DMFieldCreateFEGeom(coordField,pointIS,quad,PETSC_FALSE,&geom);CHKERRQ(ierr);
471805e7170SToby Isaac   ierr = PetscQuadratureGetData(quad, NULL, &qNc, &Nq, NULL, &weights);CHKERRQ(ierr);
472805e7170SToby Isaac   if (qNc != 1) SETERRQ(PETSC_COMM_SELF, PETSC_ERR_PLIB, "Expected scalar quadrature components\n");
473805e7170SToby Isaac   N = numPoints * Nq * Nc;
47460d4fc61SSatish Balay   if (B) {ierr = DMGetWorkArray(field->dm, N, mpitype, &qB);CHKERRQ(ierr);}
47560d4fc61SSatish Balay   if (D) {ierr = DMGetWorkArray(field->dm, N * dimC, mpitype, &qD);CHKERRQ(ierr);}
47660d4fc61SSatish Balay   if (H) {ierr = DMGetWorkArray(field->dm, N * dimC * dimC, mpitype, &qH);CHKERRQ(ierr);}
477805e7170SToby Isaac   ierr = DMFieldEvaluateFE(field,pointIS,quad,type,qB,qD,qH);CHKERRQ(ierr);
478805e7170SToby Isaac   if (B) {
479805e7170SToby Isaac     PetscInt i, j, k;
480805e7170SToby Isaac 
481805e7170SToby Isaac     if (type == PETSC_SCALAR) {
482805e7170SToby Isaac       PetscScalar * sB  = (PetscScalar *) B;
483805e7170SToby Isaac       PetscScalar * sqB = (PetscScalar *) qB;
484805e7170SToby Isaac 
485805e7170SToby Isaac       for (i = 0; i < numPoints; i++) {
486805e7170SToby Isaac         PetscReal vol = 0.;
487805e7170SToby Isaac 
488805e7170SToby Isaac         for (j = 0; j < Nc; j++) {sB[i * Nc + j] = 0.;}
489805e7170SToby Isaac         for (k = 0; k < Nq; k++) {
490805e7170SToby Isaac           vol += geom->detJ[i * Nq + k] * weights[k];
491805e7170SToby Isaac           for (j = 0; j < Nc; j++) {
492805e7170SToby Isaac             sB[i * Nc + j] += geom->detJ[i * Nq + k] * weights[k] * sqB[ (i * Nq + k) * Nc + j];
493805e7170SToby Isaac           }
494805e7170SToby Isaac         }
49562bd480fSMatthew G. Knepley         for (k = 0; k < Nc; k++) sB[i * Nc + k] /= vol;
496805e7170SToby Isaac       }
497805e7170SToby Isaac     } else {
498805e7170SToby Isaac       PetscReal * rB  = (PetscReal *) B;
499805e7170SToby Isaac       PetscReal * rqB = (PetscReal *) qB;
500805e7170SToby Isaac 
501805e7170SToby Isaac       for (i = 0; i < numPoints; i++) {
502805e7170SToby Isaac         PetscReal vol = 0.;
503805e7170SToby Isaac 
504805e7170SToby Isaac         for (j = 0; j < Nc; j++) {rB[i * Nc + j] = 0.;}
505805e7170SToby Isaac         for (k = 0; k < Nq; k++) {
506805e7170SToby Isaac           vol += geom->detJ[i * Nq + k] * weights[k];
507805e7170SToby Isaac           for (j = 0; j < Nc; j++) {
508805e7170SToby Isaac             rB[i * Nc + j] += weights[k] * rqB[ (i * Nq + k) * Nc + j];
509805e7170SToby Isaac           }
510805e7170SToby Isaac         }
511805e7170SToby Isaac         for (k = 0; k < Nc; k++) rB[i * Nc + k] /= vol;
512805e7170SToby Isaac       }
513805e7170SToby Isaac     }
514805e7170SToby Isaac   }
515805e7170SToby Isaac   if (D) {
516805e7170SToby Isaac     PetscInt i, j, k, l, m;
517805e7170SToby Isaac 
518805e7170SToby Isaac     if (type == PETSC_SCALAR) {
519805e7170SToby Isaac       PetscScalar * sD  = (PetscScalar *) D;
520805e7170SToby Isaac       PetscScalar * sqD = (PetscScalar *) qD;
521805e7170SToby Isaac 
522805e7170SToby Isaac       for (i = 0; i < numPoints; i++) {
523805e7170SToby Isaac         PetscReal vol = 0.;
524805e7170SToby Isaac 
525805e7170SToby Isaac         for (j = 0; j < Nc * dimC; j++) {sD[i * Nc * dimC + j] = 0.;}
526805e7170SToby Isaac         for (k = 0; k < Nq; k++) {
527805e7170SToby Isaac           vol += geom->detJ[i * Nq + k] * weights[k];
528805e7170SToby Isaac           for (j = 0; j < Nc; j++) {
529805e7170SToby Isaac             PetscScalar pD[3] = {0.,0.,0.};
530805e7170SToby Isaac 
531805e7170SToby Isaac             for (l = 0; l < dimC; l++) {
532805e7170SToby Isaac               for (m = 0; m < dim; m++) {
533805e7170SToby Isaac                 pD[l] += geom->invJ[((i * Nq + k) * dimC + m) * dimC + l] * sqD[((i * Nq + k) * Nc + j) * dim + m];
534805e7170SToby Isaac               }
535805e7170SToby Isaac             }
536805e7170SToby Isaac             for (l = 0; l < dimC; l++) {
537805e7170SToby Isaac               sD[(i * Nc + j) * dimC + l] += geom->detJ[i * Nq + k] * weights[k] * pD[l];
538805e7170SToby Isaac             }
539805e7170SToby Isaac           }
540805e7170SToby Isaac         }
541805e7170SToby Isaac         for (k = 0; k < Nc * dimC; k++) sD[i * Nc * dimC + k] /= vol;
542805e7170SToby Isaac       }
543805e7170SToby Isaac     } else {
544805e7170SToby Isaac       PetscReal * rD  = (PetscReal *) D;
545805e7170SToby Isaac       PetscReal * rqD = (PetscReal *) qD;
546805e7170SToby Isaac 
547805e7170SToby Isaac       for (i = 0; i < numPoints; i++) {
548805e7170SToby Isaac         PetscReal vol = 0.;
549805e7170SToby Isaac 
550805e7170SToby Isaac         for (j = 0; j < Nc * dimC; j++) {rD[i * Nc * dimC + j] = 0.;}
551805e7170SToby Isaac         for (k = 0; k < Nq; k++) {
552805e7170SToby Isaac           vol += geom->detJ[i * Nq + k] * weights[k];
553805e7170SToby Isaac           for (j = 0; j < Nc; j++) {
554805e7170SToby Isaac             PetscReal pD[3] = {0.,0.,0.};
555805e7170SToby Isaac 
556805e7170SToby Isaac             for (l = 0; l < dimC; l++) {
557805e7170SToby Isaac               for (m = 0; m < dim; m++) {
558805e7170SToby Isaac                 pD[l] += geom->invJ[((i * Nq + k) * dimC + m) * dimC + l] * rqD[((i * Nq + k) * Nc + j) * dim + m];
559805e7170SToby Isaac               }
560805e7170SToby Isaac             }
561805e7170SToby Isaac             for (l = 0; l < dimC; l++) {
562805e7170SToby Isaac               rD[(i * Nc + j) * dimC + l] += geom->detJ[i * Nq + k] * weights[k] * pD[l];
563805e7170SToby Isaac             }
564805e7170SToby Isaac           }
565805e7170SToby Isaac         }
566805e7170SToby Isaac         for (k = 0; k < Nc * dimC; k++) rD[i * Nc * dimC + k] /= vol;
567805e7170SToby Isaac       }
568805e7170SToby Isaac     }
569805e7170SToby Isaac   }
570805e7170SToby Isaac   if (H) {
571805e7170SToby Isaac     PetscInt i, j, k, l, m, q, r;
572805e7170SToby Isaac 
573805e7170SToby Isaac     if (type == PETSC_SCALAR) {
574805e7170SToby Isaac       PetscScalar * sH  = (PetscScalar *) H;
575805e7170SToby Isaac       PetscScalar * sqH = (PetscScalar *) qH;
576805e7170SToby Isaac 
577805e7170SToby Isaac       for (i = 0; i < numPoints; i++) {
578805e7170SToby Isaac         PetscReal vol = 0.;
579805e7170SToby Isaac 
580805e7170SToby Isaac         for (j = 0; j < Nc * dimC * dimC; j++) {sH[i * Nc * dimC * dimC + j] = 0.;}
581805e7170SToby Isaac         for (k = 0; k < Nq; k++) {
5824d1a973fSToby Isaac           const PetscReal *invJ = &geom->invJ[(i * Nq + k) * dimC * dimC];
583805e7170SToby Isaac 
584805e7170SToby Isaac           vol += geom->detJ[i * Nq + k] * weights[k];
585805e7170SToby Isaac           for (j = 0; j < Nc; j++) {
586805e7170SToby Isaac             PetscScalar pH[3][3] = {{0.,0.,0.},{0.,0.,0.},{0.,0.,0.}};
587805e7170SToby Isaac             const PetscScalar *spH = &sqH[((i * Nq + k) * Nc + j) * dimC * dimC];
588805e7170SToby Isaac 
589805e7170SToby Isaac             for (l = 0; l < dimC; l++) {
590805e7170SToby Isaac               for (m = 0; m < dimC; m++) {
591805e7170SToby Isaac                 for (q = 0; q < dim; q++) {
592805e7170SToby Isaac                   for (r = 0; r < dim; r++) {
593805e7170SToby Isaac                     pH[l][m] += invJ[q * dimC + l] * invJ[r * dimC + m] * spH[q * dim + r];
594805e7170SToby Isaac                   }
595805e7170SToby Isaac                 }
596805e7170SToby Isaac               }
597805e7170SToby Isaac             }
598805e7170SToby Isaac             for (l = 0; l < dimC; l++) {
599805e7170SToby Isaac               for (m = 0; m < dimC; m++) {
600805e7170SToby Isaac                 sH[(i * Nc + j) * dimC * dimC + l * dimC + m] += geom->detJ[i * Nq + k] * weights[k] * pH[l][m];
601805e7170SToby Isaac               }
602805e7170SToby Isaac             }
603805e7170SToby Isaac           }
604805e7170SToby Isaac         }
605805e7170SToby Isaac         for (k = 0; k < Nc * dimC * dimC; k++) sH[i * Nc * dimC * dimC + k] /= vol;
606805e7170SToby Isaac       }
607805e7170SToby Isaac     } else {
608805e7170SToby Isaac       PetscReal * rH  = (PetscReal *) H;
609805e7170SToby Isaac       PetscReal * rqH = (PetscReal *) qH;
610805e7170SToby Isaac 
611805e7170SToby Isaac       for (i = 0; i < numPoints; i++) {
612805e7170SToby Isaac         PetscReal vol = 0.;
613805e7170SToby Isaac 
614805e7170SToby Isaac         for (j = 0; j < Nc * dimC * dimC; j++) {rH[i * Nc * dimC * dimC + j] = 0.;}
615805e7170SToby Isaac         for (k = 0; k < Nq; k++) {
616805e7170SToby Isaac           const PetscReal *invJ = &geom->invJ[(i * Nq + k) * dimC * dimC];
617805e7170SToby Isaac 
618805e7170SToby Isaac           vol += geom->detJ[i * Nq + k] * weights[k];
619805e7170SToby Isaac           for (j = 0; j < Nc; j++) {
620805e7170SToby Isaac             PetscReal pH[3][3] = {{0.,0.,0.},{0.,0.,0.},{0.,0.,0.}};
621805e7170SToby Isaac             const PetscReal *rpH = &rqH[((i * Nq + k) * Nc + j) * dimC * dimC];
622805e7170SToby Isaac 
623805e7170SToby Isaac             for (l = 0; l < dimC; l++) {
624805e7170SToby Isaac               for (m = 0; m < dimC; m++) {
625805e7170SToby Isaac                 for (q = 0; q < dim; q++) {
626805e7170SToby Isaac                   for (r = 0; r < dim; r++) {
627805e7170SToby Isaac                     pH[l][m] += invJ[q * dimC + l] * invJ[r * dimC + m] * rpH[q * dim + r];
628805e7170SToby Isaac                   }
629805e7170SToby Isaac                 }
630805e7170SToby Isaac               }
631805e7170SToby Isaac             }
632805e7170SToby Isaac             for (l = 0; l < dimC; l++) {
633805e7170SToby Isaac               for (m = 0; m < dimC; m++) {
634805e7170SToby Isaac                 rH[(i * Nc + j) * dimC * dimC + l * dimC + m] += geom->detJ[i * Nq + k] * weights[k] * pH[l][m];
635805e7170SToby Isaac               }
636805e7170SToby Isaac             }
637805e7170SToby Isaac           }
638805e7170SToby Isaac         }
639805e7170SToby Isaac         for (k = 0; k < Nc * dimC * dimC; k++) rH[i * Nc * dimC * dimC + k] /= vol;
640805e7170SToby Isaac       }
641805e7170SToby Isaac     }
642805e7170SToby Isaac   }
64360d4fc61SSatish Balay   if (B) {ierr = DMRestoreWorkArray(field->dm, N, mpitype, &qB);CHKERRQ(ierr);}
64460d4fc61SSatish Balay   if (D) {ierr = DMRestoreWorkArray(field->dm, N * dimC, mpitype, &qD);CHKERRQ(ierr);}
64560d4fc61SSatish Balay   if (H) {ierr = DMRestoreWorkArray(field->dm, N * dimC * dimC, mpitype, &qH);CHKERRQ(ierr);}
646805e7170SToby Isaac   ierr = PetscFEGeomDestroy(&geom);CHKERRQ(ierr);
647805e7170SToby Isaac   ierr = PetscQuadratureDestroy(&quad);CHKERRQ(ierr);
648805e7170SToby Isaac   PetscFunctionReturn(0);
649805e7170SToby Isaac }
650805e7170SToby Isaac 
651b7260050SToby Isaac static PetscErrorCode DMFieldGetDegree_DS(DMField field, IS pointIS, PetscInt *minDegree, PetscInt *maxDegree)
65251a454edSToby Isaac {
65351a454edSToby Isaac   DMField_DS     *dsfield;
65451a454edSToby Isaac   PetscObject    disc;
655741db25dSToby Isaac   PetscInt       h, imin, imax;
65651a454edSToby Isaac   PetscClassId   id;
65751a454edSToby Isaac   PetscErrorCode ierr;
65851a454edSToby Isaac 
65951a454edSToby Isaac   PetscFunctionBegin;
66051a454edSToby Isaac   dsfield = (DMField_DS *) field->data;
661741db25dSToby Isaac   ierr = ISGetMinMax(pointIS,&imin,&imax);CHKERRQ(ierr);
662741db25dSToby Isaac   if (imin >= imax) {
66351aa0bf7SToby Isaac     h = 0;
66451aa0bf7SToby Isaac   } else {
665f99c8401SToby Isaac     for (h = 0; h < dsfield->height; h++) {
66651a454edSToby Isaac       PetscInt hEnd;
66751a454edSToby Isaac 
66851a454edSToby Isaac       ierr = DMPlexGetHeightStratum(field->dm,h,NULL,&hEnd);CHKERRQ(ierr);
66951a454edSToby Isaac       if (imin < hEnd) break;
67051a454edSToby Isaac     }
67151aa0bf7SToby Isaac   }
67251a454edSToby Isaac   ierr = DMFieldDSGetHeightDisc(field,h,&disc);CHKERRQ(ierr);
67351a454edSToby Isaac   ierr = PetscObjectGetClassId(disc,&id);CHKERRQ(ierr);
67451a454edSToby Isaac   if (id == PETSCFE_CLASSID) {
67551a454edSToby Isaac     PetscFE    fe = (PetscFE) disc;
67651a454edSToby Isaac     PetscSpace sp;
67751a454edSToby Isaac 
67851a454edSToby Isaac     ierr = PetscFEGetBasisSpace(fe, &sp);CHKERRQ(ierr);
679b7260050SToby Isaac     ierr = PetscSpaceGetDegree(sp, minDegree, maxDegree);CHKERRQ(ierr);
68051a454edSToby Isaac   }
68151a454edSToby Isaac   PetscFunctionReturn(0);
68251a454edSToby Isaac }
68351a454edSToby Isaac 
68451a454edSToby Isaac static PetscErrorCode DMFieldCreateDefaultQuadrature_DS(DMField field, IS pointIS, PetscQuadrature *quad)
68551a454edSToby Isaac {
6861fdf1f07SMatthew G. Knepley   PetscInt       h, dim, imax, imin, cellHeight;
68751a454edSToby Isaac   DM             dm;
68851a454edSToby Isaac   DMField_DS     *dsfield;
68951a454edSToby Isaac   PetscObject    disc;
69051a454edSToby Isaac   PetscFE        fe;
69151a454edSToby Isaac   PetscClassId   id;
69251a454edSToby Isaac   PetscErrorCode ierr;
69351a454edSToby Isaac 
69451a454edSToby Isaac   PetscFunctionBegin;
69551a454edSToby Isaac   dm = field->dm;
69651a454edSToby Isaac   dsfield = (DMField_DS *) field->data;
697cd93b0e1SMatthew G. Knepley   ierr = ISGetMinMax(pointIS,&imin,&imax);CHKERRQ(ierr);
69851a454edSToby Isaac   ierr = DMGetDimension(dm,&dim);CHKERRQ(ierr);
69951a454edSToby Isaac   for (h = 0; h <= dim; h++) {
70051a454edSToby Isaac     PetscInt hStart, hEnd;
70151a454edSToby Isaac 
70251a454edSToby Isaac     ierr = DMPlexGetHeightStratum(dm,h,&hStart,&hEnd);CHKERRQ(ierr);
7036c041b70SSatish Balay     if (imax >= hStart && imin < hEnd) break;
70451a454edSToby Isaac   }
7051fdf1f07SMatthew G. Knepley   ierr = DMPlexGetVTKCellHeight(dm, &cellHeight);CHKERRQ(ierr);
7061fdf1f07SMatthew G. Knepley   h -= cellHeight;
70751a454edSToby Isaac   *quad = NULL;
708f99c8401SToby Isaac   if (h < dsfield->height) {
70951a454edSToby Isaac     ierr = DMFieldDSGetHeightDisc(field,h,&disc);CHKERRQ(ierr);
71051a454edSToby Isaac     ierr = PetscObjectGetClassId(disc,&id);CHKERRQ(ierr);
71151a454edSToby Isaac     if (id != PETSCFE_CLASSID) PetscFunctionReturn(0);
71251a454edSToby Isaac     fe = (PetscFE) disc;
71351a454edSToby Isaac     ierr = PetscFEGetQuadrature(fe,quad);CHKERRQ(ierr);
71451a454edSToby Isaac     ierr = PetscObjectReference((PetscObject)*quad);CHKERRQ(ierr);
71551a454edSToby Isaac   }
71651a454edSToby Isaac   PetscFunctionReturn(0);
71751a454edSToby Isaac }
71851a454edSToby Isaac 
7190145028aSToby Isaac static PetscErrorCode DMFieldComputeFaceData_DS(DMField field, IS pointIS, PetscQuadrature quad, PetscFEGeom *geom)
7200145028aSToby Isaac {
7210145028aSToby Isaac   const PetscInt *points;
7220145028aSToby Isaac   PetscInt        p, dim, dE, numFaces, Nq;
723b7260050SToby Isaac   PetscInt        maxDegree;
7240145028aSToby Isaac   DMLabel         depthLabel;
7250145028aSToby Isaac   IS              cellIS;
7260145028aSToby Isaac   DM              dm = field->dm;
7270145028aSToby Isaac   PetscErrorCode  ierr;
7280145028aSToby Isaac 
7290145028aSToby Isaac   PetscFunctionBegin;
7300145028aSToby Isaac   dim = geom->dim;
7310145028aSToby Isaac   dE  = geom->dimEmbed;
7320145028aSToby Isaac   ierr = DMPlexGetDepthLabel(dm, &depthLabel);CHKERRQ(ierr);
7330145028aSToby Isaac   ierr = DMLabelGetStratumIS(depthLabel, dim + 1, &cellIS);CHKERRQ(ierr);
734b7260050SToby Isaac   ierr = DMFieldGetDegree(field,cellIS,NULL,&maxDegree);CHKERRQ(ierr);
7350145028aSToby Isaac   ierr = ISGetIndices(pointIS, &points);CHKERRQ(ierr);
7360145028aSToby Isaac   numFaces = geom->numCells;
7370145028aSToby Isaac   Nq = geom->numPoints;
738f15274beSMatthew Knepley   /* First, set local faces and flip normals so that they are outward for the first supporting cell */
739f15274beSMatthew Knepley   for (p = 0; p < numFaces; p++) {
740f15274beSMatthew Knepley     PetscInt        point = points[p];
741f15274beSMatthew Knepley     PetscInt        suppSize, s, coneSize, c, numChildren;
742f15274beSMatthew Knepley     const PetscInt *supp, *cone, *ornt;
743f15274beSMatthew Knepley 
744f15274beSMatthew Knepley     ierr = DMPlexGetTreeChildren(dm, point, &numChildren, NULL);CHKERRQ(ierr);
745f15274beSMatthew Knepley     if (numChildren) SETERRQ(PETSC_COMM_SELF, PETSC_ERR_PLIB, "Face data not valid for facets with children");
746f15274beSMatthew Knepley     ierr = DMPlexGetSupportSize(dm, point, &suppSize);CHKERRQ(ierr);
747f15274beSMatthew Knepley     if (suppSize > 2) SETERRQ2(PETSC_COMM_SELF, PETSC_ERR_PLIB, "Point %D has %D support, expected at most 2\n", point, suppSize);
748f15274beSMatthew Knepley     if (!suppSize) continue;
749f15274beSMatthew Knepley     ierr = DMPlexGetSupport(dm, point, &supp);CHKERRQ(ierr);
750f15274beSMatthew Knepley     for (s = 0; s < suppSize; ++s) {
751f15274beSMatthew Knepley       ierr = DMPlexGetConeSize(dm, supp[s], &coneSize);CHKERRQ(ierr);
752f15274beSMatthew Knepley       ierr = DMPlexGetCone(dm, supp[s], &cone);CHKERRQ(ierr);
753f15274beSMatthew Knepley       for (c = 0; c < coneSize; ++c) if (cone[c] == point) break;
754f15274beSMatthew Knepley       if (c == coneSize) SETERRQ2(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Invalid connectivity: point %D not found in cone of support point %D", point, supp[s]);
755f15274beSMatthew Knepley       geom->face[p][s] = c;
756f15274beSMatthew Knepley     }
757f15274beSMatthew Knepley     ierr = DMPlexGetConeOrientation(dm, supp[0], &ornt);CHKERRQ(ierr);
758f15274beSMatthew Knepley     if (ornt[geom->face[p][0]] < 0) {
759f15274beSMatthew Knepley       PetscInt Np = geom->numPoints, q, dE = geom->dimEmbed, d;
760f15274beSMatthew Knepley 
761f15274beSMatthew 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];
762f15274beSMatthew Knepley     }
763f15274beSMatthew Knepley   }
764b7260050SToby Isaac   if (maxDegree <= 1) {
7650145028aSToby Isaac     PetscInt        numCells, offset, *cells;
7660145028aSToby Isaac     PetscFEGeom     *cellGeom;
7670145028aSToby Isaac     IS              suppIS;
7680145028aSToby Isaac 
7690145028aSToby Isaac     for (p = 0, numCells = 0; p < numFaces; p++) {
7700145028aSToby Isaac       PetscInt        point = points[p];
7710145028aSToby Isaac       PetscInt        numSupp, numChildren;
7720145028aSToby Isaac 
7730145028aSToby Isaac       ierr = DMPlexGetTreeChildren(dm, point, &numChildren, NULL);CHKERRQ(ierr);
7740145028aSToby Isaac       if (numChildren) SETERRQ(PETSC_COMM_SELF, PETSC_ERR_PLIB, "Face data not valid for facets with children");
7750145028aSToby Isaac       ierr = DMPlexGetSupportSize(dm, point,&numSupp);CHKERRQ(ierr);
7760145028aSToby Isaac       if (numSupp > 2) SETERRQ2(PETSC_COMM_SELF, PETSC_ERR_PLIB, "Point %D has %D support, expected at most 2\n", point, numSupp);
7770145028aSToby Isaac       numCells += numSupp;
7780145028aSToby Isaac     }
7790145028aSToby Isaac     ierr = PetscMalloc1(numCells, &cells);CHKERRQ(ierr);
7800145028aSToby Isaac     for (p = 0, offset = 0; p < numFaces; p++) {
7810145028aSToby Isaac       PetscInt        point = points[p];
7820145028aSToby Isaac       PetscInt        numSupp, s;
7830145028aSToby Isaac       const PetscInt *supp;
7840145028aSToby Isaac 
7850145028aSToby Isaac       ierr = DMPlexGetSupportSize(dm, point,&numSupp);CHKERRQ(ierr);
7860145028aSToby Isaac       ierr = DMPlexGetSupport(dm, point, &supp);CHKERRQ(ierr);
7870145028aSToby Isaac       for (s = 0; s < numSupp; s++, offset++) {
7880145028aSToby Isaac         cells[offset] = supp[s];
7890145028aSToby Isaac       }
7900145028aSToby Isaac     }
7910145028aSToby Isaac     ierr = ISCreateGeneral(PETSC_COMM_SELF,numCells,cells,PETSC_USE_POINTER, &suppIS);CHKERRQ(ierr);
79262bd480fSMatthew G. Knepley     ierr = DMFieldCreateFEGeom(field,suppIS,quad,PETSC_FALSE,&cellGeom);CHKERRQ(ierr);
7930145028aSToby Isaac     for (p = 0, offset = 0; p < numFaces; p++) {
7940145028aSToby Isaac       PetscInt        point = points[p];
7950145028aSToby Isaac       PetscInt        numSupp, s, q;
7960145028aSToby Isaac       const PetscInt *supp;
7970145028aSToby Isaac 
7980145028aSToby Isaac       ierr = DMPlexGetSupportSize(dm, point,&numSupp);CHKERRQ(ierr);
7990145028aSToby Isaac       ierr = DMPlexGetSupport(dm, point, &supp);CHKERRQ(ierr);
8000145028aSToby Isaac       for (s = 0; s < numSupp; s++, offset++) {
8010145028aSToby Isaac         for (q = 0; q < Nq * dE * dE; q++) {
80241418987SMatthew G. Knepley           geom->suppJ[s][p * Nq * dE * dE + q]    = cellGeom->J[offset * Nq * dE * dE + q];
8030145028aSToby Isaac           geom->suppInvJ[s][p * Nq * dE * dE + q] = cellGeom->invJ[offset * Nq * dE * dE + q];
8040145028aSToby Isaac         }
80541418987SMatthew G. Knepley         for (q = 0; q < Nq; q++) geom->suppDetJ[s][p * Nq + q] = cellGeom->detJ[offset * Nq + q];
8060145028aSToby Isaac       }
8070145028aSToby Isaac     }
8080145028aSToby Isaac     ierr = PetscFEGeomDestroy(&cellGeom);CHKERRQ(ierr);
8090145028aSToby Isaac     ierr = ISDestroy(&suppIS);CHKERRQ(ierr);
8100145028aSToby Isaac     ierr = PetscFree(cells);CHKERRQ(ierr);
8110145028aSToby Isaac   } else {
8120145028aSToby Isaac     PetscObject          faceDisc, cellDisc;
8130145028aSToby Isaac     PetscClassId         faceId, cellId;
8140145028aSToby Isaac     PetscDualSpace       dsp;
8150145028aSToby Isaac     DM                   K;
816ba2698f1SMatthew G. Knepley     DMPolytopeType       ct;
8170145028aSToby Isaac     PetscInt           (*co)[2][3];
8180145028aSToby Isaac     PetscInt             coneSize;
8190145028aSToby Isaac     PetscInt           **counts;
8200145028aSToby Isaac     PetscInt             f, i, o, q, s;
8210145028aSToby Isaac     const PetscInt      *coneK;
822ba2698f1SMatthew G. Knepley     PetscInt             eStart, minOrient, maxOrient, numOrient;
8230145028aSToby Isaac     PetscInt            *orients;
8240145028aSToby Isaac     PetscReal          **orientPoints;
8250145028aSToby Isaac     PetscReal           *cellPoints;
8260145028aSToby Isaac     PetscReal           *dummyWeights;
8270145028aSToby Isaac     PetscQuadrature      cellQuad = NULL;
8280145028aSToby Isaac 
8290145028aSToby Isaac     ierr = DMFieldDSGetHeightDisc(field, 1, &faceDisc);CHKERRQ(ierr);
8300145028aSToby Isaac     ierr = DMFieldDSGetHeightDisc(field, 0, &cellDisc);CHKERRQ(ierr);
8310145028aSToby Isaac     ierr = PetscObjectGetClassId(faceDisc,&faceId);CHKERRQ(ierr);
8320145028aSToby Isaac     ierr = PetscObjectGetClassId(cellDisc,&cellId);CHKERRQ(ierr);
8330145028aSToby Isaac     if (faceId != PETSCFE_CLASSID || cellId != PETSCFE_CLASSID) SETERRQ(PETSC_COMM_SELF, PETSC_ERR_PLIB, "Not supported\n");
8340145028aSToby Isaac     ierr = PetscFEGetDualSpace((PetscFE)cellDisc, &dsp);CHKERRQ(ierr);
8350145028aSToby Isaac     ierr = PetscDualSpaceGetDM(dsp, &K);CHKERRQ(ierr);
836ba2698f1SMatthew G. Knepley     ierr = DMPlexGetHeightStratum(K, 1, &eStart, NULL);CHKERRQ(ierr);
837ba2698f1SMatthew G. Knepley     ierr = DMPlexGetCellType(K, eStart, &ct);CHKERRQ(ierr);
8380145028aSToby Isaac     ierr = DMPlexGetConeSize(K,0,&coneSize);CHKERRQ(ierr);
8390145028aSToby Isaac     ierr = DMPlexGetCone(K,0,&coneK);CHKERRQ(ierr);
840c99e0549SMatthew G. Knepley     ierr = PetscMalloc2(numFaces, &co, coneSize, &counts);CHKERRQ(ierr);
841c99e0549SMatthew G. Knepley     ierr = PetscMalloc1(dE*Nq, &cellPoints);CHKERRQ(ierr);
842c99e0549SMatthew G. Knepley     ierr = PetscMalloc1(Nq, &dummyWeights);CHKERRQ(ierr);
843360cf244SMatthew G. Knepley     ierr = PetscQuadratureCreate(PETSC_COMM_SELF, &cellQuad);CHKERRQ(ierr);
8440145028aSToby Isaac     ierr = PetscQuadratureSetData(cellQuad, dE, 1, Nq, cellPoints, dummyWeights);CHKERRQ(ierr);
8450145028aSToby Isaac     minOrient = PETSC_MAX_INT;
8460145028aSToby Isaac     maxOrient = PETSC_MIN_INT;
8470145028aSToby Isaac     for (p = 0; p < numFaces; p++) { /* record the orientation of the facet wrt the support cells */
8480145028aSToby Isaac       PetscInt        point = points[p];
8490145028aSToby Isaac       PetscInt        numSupp, numChildren;
8500145028aSToby Isaac       const PetscInt *supp;
8510145028aSToby Isaac 
8520145028aSToby Isaac       ierr = DMPlexGetTreeChildren(dm, point, &numChildren, NULL);CHKERRQ(ierr);
8530145028aSToby Isaac       if (numChildren) SETERRQ(PETSC_COMM_SELF, PETSC_ERR_PLIB, "Face data not valid for facets with children");
8540145028aSToby Isaac       ierr = DMPlexGetSupportSize(dm, point,&numSupp);CHKERRQ(ierr);
8550145028aSToby Isaac       if (numSupp > 2) SETERRQ2(PETSC_COMM_SELF, PETSC_ERR_PLIB, "Point %D has %D support, expected at most 2\n", point, numSupp);
8560145028aSToby Isaac       ierr = DMPlexGetSupport(dm, point, &supp);CHKERRQ(ierr);
8570145028aSToby Isaac       for (s = 0; s < numSupp; s++) {
8580145028aSToby Isaac         PetscInt        cell = supp[s];
8590145028aSToby Isaac         PetscInt        numCone;
8600145028aSToby Isaac         const PetscInt *cone, *orient;
8610145028aSToby Isaac 
8620145028aSToby Isaac         ierr = DMPlexGetConeSize(dm, cell, &numCone);CHKERRQ(ierr);
8630145028aSToby Isaac         if (numCone != coneSize) SETERRQ(PETSC_COMM_SELF, PETSC_ERR_PLIB, "Support point does not match reference element");
8640145028aSToby Isaac         ierr = DMPlexGetCone(dm, cell, &cone);CHKERRQ(ierr);
8650145028aSToby Isaac         ierr = DMPlexGetConeOrientation(dm, cell, &orient);CHKERRQ(ierr);
8660145028aSToby Isaac         for (f = 0; f < coneSize; f++) {
8670145028aSToby Isaac           if (cone[f] == point) break;
8680145028aSToby Isaac         }
8690145028aSToby Isaac         co[p][s][0] = f;
8700145028aSToby Isaac         co[p][s][1] = orient[f];
8710145028aSToby Isaac         co[p][s][2] = cell;
8720145028aSToby Isaac         minOrient = PetscMin(minOrient, orient[f]);
873cd93b0e1SMatthew G. Knepley         maxOrient = PetscMax(maxOrient, orient[f]);
8740145028aSToby Isaac       }
8750145028aSToby Isaac       for (; s < 2; s++) {
8760145028aSToby Isaac         co[p][s][0] = -1;
8770145028aSToby Isaac         co[p][s][1] = -1;
8780145028aSToby Isaac         co[p][s][2] = -1;
8790145028aSToby Isaac       }
8800145028aSToby Isaac     }
8810145028aSToby Isaac     numOrient = maxOrient + 1 - minOrient;
8820145028aSToby Isaac     ierr = DMPlexGetCone(K,0,&coneK);CHKERRQ(ierr);
8830145028aSToby Isaac     /* count all (face,orientation) doubles that appear */
8840145028aSToby Isaac     ierr = PetscCalloc2(numOrient,&orients,numOrient,&orientPoints);CHKERRQ(ierr);
885c99e0549SMatthew G. Knepley     for (f = 0; f < coneSize; f++) {ierr = PetscCalloc1(numOrient+1, &counts[f]);CHKERRQ(ierr);}
8860145028aSToby Isaac     for (p = 0; p < numFaces; p++) {
8870145028aSToby Isaac       for (s = 0; s < 2; s++) {
8880145028aSToby Isaac         if (co[p][s][0] >= 0) {
8890145028aSToby Isaac           counts[co[p][s][0]][co[p][s][1] - minOrient]++;
8900145028aSToby Isaac           orients[co[p][s][1] - minOrient]++;
8910145028aSToby Isaac         }
8920145028aSToby Isaac       }
8930145028aSToby Isaac     }
8940145028aSToby Isaac     for (o = 0; o < numOrient; o++) {
8950145028aSToby Isaac       if (orients[o]) {
8960145028aSToby Isaac         PetscInt orient = o + minOrient;
8970145028aSToby Isaac         PetscInt q;
8980145028aSToby Isaac 
8990145028aSToby Isaac         ierr = PetscMalloc1(Nq * dim, &orientPoints[o]);CHKERRQ(ierr);
9000145028aSToby Isaac         /* rotate the quadrature points appropriately */
901ba2698f1SMatthew G. Knepley         switch (ct) {
902ba2698f1SMatthew G. Knepley         case DM_POLYTOPE_POINT: break;
903ba2698f1SMatthew G. Knepley         case DM_POLYTOPE_SEGMENT:
9040145028aSToby Isaac           if (orient == -2 || orient == 1) {
9050145028aSToby Isaac             for (q = 0; q < Nq; q++) {
9060145028aSToby Isaac               orientPoints[o][q] = -geom->xi[q];
9070145028aSToby Isaac             }
9080145028aSToby Isaac           } else {
9090145028aSToby Isaac             for (q = 0; q < Nq; q++) {
9100145028aSToby Isaac               orientPoints[o][q] = geom->xi[q];
9110145028aSToby Isaac             }
9120145028aSToby Isaac           }
9130145028aSToby Isaac           break;
914ba2698f1SMatthew G. Knepley         case DM_POLYTOPE_TRIANGLE:
9150145028aSToby Isaac           for (q = 0; q < Nq; q++) {
9160145028aSToby Isaac             PetscReal lambda[3];
9170145028aSToby Isaac             PetscReal lambdao[3];
9180145028aSToby Isaac 
9190145028aSToby Isaac             /* convert to barycentric */
9200145028aSToby Isaac             lambda[0] = - (geom->xi[2 * q] + geom->xi[2 * q + 1]) / 2.;
9210145028aSToby Isaac             lambda[1] = (geom->xi[2 * q] + 1.) / 2.;
9220145028aSToby Isaac             lambda[2] = (geom->xi[2 * q + 1] + 1.) / 2.;
9230145028aSToby Isaac             if (orient >= 0) {
9240145028aSToby Isaac               for (i = 0; i < 3; i++) {
9250145028aSToby Isaac                 lambdao[i] = lambda[(orient + i) % 3];
9260145028aSToby Isaac               }
9270145028aSToby Isaac             } else {
9280145028aSToby Isaac               for (i = 0; i < 3; i++) {
9290145028aSToby Isaac                 lambdao[i] = lambda[(-(orient + i) + 3) % 3];
9300145028aSToby Isaac               }
9310145028aSToby Isaac             }
9320145028aSToby Isaac             /* convert to coordinates */
9330145028aSToby Isaac             orientPoints[o][2 * q + 0] = -(lambdao[0] + lambdao[2]) + lambdao[1];
9340145028aSToby Isaac             orientPoints[o][2 * q + 1] = -(lambdao[0] + lambdao[1]) + lambdao[2];
9350145028aSToby Isaac           }
9360145028aSToby Isaac           break;
937ba2698f1SMatthew G. Knepley         case DM_POLYTOPE_QUADRILATERAL:
9380145028aSToby Isaac           for (q = 0; q < Nq; q++) {
9390145028aSToby Isaac             PetscReal xi[2], xio[2];
9400145028aSToby Isaac             PetscInt oabs = (orient >= 0) ? orient : -(orient + 1);
9410145028aSToby Isaac 
9420145028aSToby Isaac             xi[0] = geom->xi[2 * q];
9430145028aSToby Isaac             xi[1] = geom->xi[2 * q + 1];
9440145028aSToby Isaac             switch (oabs) {
9450145028aSToby Isaac             case 1:
9460145028aSToby Isaac               xio[0] = xi[1];
9470145028aSToby Isaac               xio[1] = -xi[0];
9480145028aSToby Isaac               break;
9490145028aSToby Isaac             case 2:
9500145028aSToby Isaac               xio[0] = -xi[0];
9510145028aSToby Isaac               xio[1] = -xi[1];
9520145028aSToby Isaac             case 3:
9530145028aSToby Isaac               xio[0] = -xi[1];
9540145028aSToby Isaac               xio[1] = xi[0];
955aa1371cbSToby Isaac             case 0:
956aa1371cbSToby Isaac             default:
957aa1371cbSToby Isaac               xio[0] = xi[0];
958aa1371cbSToby Isaac               xio[1] = xi[1];
959aa1371cbSToby Isaac               break;
9600145028aSToby Isaac             }
9610145028aSToby Isaac             if (orient < 0) {
9620145028aSToby Isaac               xio[0] = -xio[0];
9630145028aSToby Isaac             }
9640145028aSToby Isaac             orientPoints[o][2 * q + 0] = xio[0];
9650145028aSToby Isaac             orientPoints[o][2 * q + 1] = xio[1];
9660145028aSToby Isaac           }
9670145028aSToby Isaac           break;
968ba2698f1SMatthew G. Knepley         default: SETERRQ1(PETSC_COMM_SELF,PETSC_ERR_SUP,"Cell type %s not yet supported\n", DMPolytopeTypes[ct]);
9690145028aSToby Isaac         }
9700145028aSToby Isaac       }
9710145028aSToby Isaac     }
9720145028aSToby Isaac     for (f = 0; f < coneSize; f++) {
9730145028aSToby Isaac       PetscInt face = coneK[f];
9744d1a973fSToby Isaac       PetscReal v0[3];
9752d89661fSMatthew G. Knepley       PetscReal J[9], detJ;
9760145028aSToby Isaac       PetscInt numCells, offset;
9770145028aSToby Isaac       PetscInt *cells;
9780145028aSToby Isaac       IS suppIS;
9790145028aSToby Isaac 
9802d89661fSMatthew G. Knepley       ierr = DMPlexComputeCellGeometryFEM(K, face, NULL, v0, J, NULL, &detJ);CHKERRQ(ierr);
9810145028aSToby Isaac       for (o = 0; o <= numOrient; o++) {
9820145028aSToby Isaac         PetscFEGeom *cellGeom;
9830145028aSToby Isaac 
9840145028aSToby Isaac         if (!counts[f][o]) continue;
9850145028aSToby Isaac         /* If this (face,orientation) double appears,
9860145028aSToby Isaac          * convert the face quadrature points into volume quadrature points */
9870145028aSToby Isaac         for (q = 0; q < Nq; q++) {
9880145028aSToby Isaac           PetscReal xi0[3] = {-1., -1., -1.};
9890145028aSToby Isaac 
9900145028aSToby Isaac           CoordinatesRefToReal(dE, dim, xi0, v0, J, &orientPoints[o][dim * q + 0], &cellPoints[dE * q + 0]);
9910145028aSToby Isaac         }
9920145028aSToby Isaac         for (p = 0, numCells = 0; p < numFaces; p++) {
9930145028aSToby Isaac           for (s = 0; s < 2; s++) {
9940145028aSToby Isaac             if (co[p][s][0] == f && co[p][s][1] == o + minOrient) numCells++;
9950145028aSToby Isaac           }
9960145028aSToby Isaac         }
9970145028aSToby Isaac         ierr = PetscMalloc1(numCells, &cells);CHKERRQ(ierr);
9980145028aSToby Isaac         for (p = 0, offset = 0; p < numFaces; p++) {
9990145028aSToby Isaac           for (s = 0; s < 2; s++) {
10000145028aSToby Isaac             if (co[p][s][0] == f && co[p][s][1] == o + minOrient) {
10010145028aSToby Isaac               cells[offset++] = co[p][s][2];
10020145028aSToby Isaac             }
10030145028aSToby Isaac           }
10040145028aSToby Isaac         }
10050145028aSToby Isaac         ierr = ISCreateGeneral(PETSC_COMM_SELF,numCells,cells,PETSC_USE_POINTER, &suppIS);CHKERRQ(ierr);
10060145028aSToby Isaac         ierr = DMFieldCreateFEGeom(field,suppIS,cellQuad,PETSC_FALSE,&cellGeom);CHKERRQ(ierr);
10070145028aSToby Isaac         for (p = 0, offset = 0; p < numFaces; p++) {
10080145028aSToby Isaac           for (s = 0; s < 2; s++) {
10090145028aSToby Isaac             if (co[p][s][0] == f && co[p][s][1] == o + minOrient) {
10100145028aSToby Isaac               for (q = 0; q < Nq * dE * dE; q++) {
101141418987SMatthew G. Knepley                 geom->suppJ[s][p * Nq * dE * dE + q]    = cellGeom->J[offset * Nq * dE * dE + q];
10120145028aSToby Isaac                 geom->suppInvJ[s][p * Nq * dE * dE + q] = cellGeom->invJ[offset * Nq * dE * dE + q];
10130145028aSToby Isaac               }
101441418987SMatthew G. Knepley               for (q = 0; q < Nq; q++) geom->suppDetJ[s][p * Nq + q] = cellGeom->detJ[offset * Nq + q];
10150145028aSToby Isaac               offset++;
10160145028aSToby Isaac             }
10170145028aSToby Isaac           }
10180145028aSToby Isaac         }
10190145028aSToby Isaac         ierr = PetscFEGeomDestroy(&cellGeom);CHKERRQ(ierr);
10200145028aSToby Isaac         ierr = ISDestroy(&suppIS);CHKERRQ(ierr);
10210145028aSToby Isaac         ierr = PetscFree(cells);CHKERRQ(ierr);
10220145028aSToby Isaac       }
10230145028aSToby Isaac     }
10240145028aSToby Isaac     for (o = 0; o < numOrient; o++) {
10250145028aSToby Isaac       if (orients[o]) {
10260145028aSToby Isaac         ierr = PetscFree(orientPoints[o]);CHKERRQ(ierr);
10270145028aSToby Isaac       }
10280145028aSToby Isaac     }
10290145028aSToby Isaac     ierr = PetscFree2(orients,orientPoints);CHKERRQ(ierr);
10300145028aSToby Isaac     ierr = PetscQuadratureDestroy(&cellQuad);CHKERRQ(ierr);
10315b0eceaeSMatthew G. Knepley     for (f = 0; f < coneSize; f++) {ierr = PetscFree(counts[f]);CHKERRQ(ierr);}
1032c99e0549SMatthew G. Knepley     ierr = PetscFree2(co,counts);CHKERRQ(ierr);
10330145028aSToby Isaac   }
10340145028aSToby Isaac   ierr = ISRestoreIndices(pointIS, &points);CHKERRQ(ierr);
10350145028aSToby Isaac   ierr = ISDestroy(&cellIS);CHKERRQ(ierr);
10360145028aSToby Isaac   PetscFunctionReturn(0);
10370145028aSToby Isaac }
10380145028aSToby Isaac 
103951a454edSToby Isaac static PetscErrorCode DMFieldInitialize_DS(DMField field)
104051a454edSToby Isaac {
104151a454edSToby Isaac   PetscFunctionBegin;
104251a454edSToby Isaac   field->ops->destroy                 = DMFieldDestroy_DS;
104351a454edSToby Isaac   field->ops->evaluate                = DMFieldEvaluate_DS;
104451a454edSToby Isaac   field->ops->evaluateFE              = DMFieldEvaluateFE_DS;
1045805e7170SToby Isaac   field->ops->evaluateFV              = DMFieldEvaluateFV_DS;
1046b7260050SToby Isaac   field->ops->getDegree               = DMFieldGetDegree_DS;
104751a454edSToby Isaac   field->ops->createDefaultQuadrature = DMFieldCreateDefaultQuadrature_DS;
104851a454edSToby Isaac   field->ops->view                    = DMFieldView_DS;
10490145028aSToby Isaac   field->ops->computeFaceData         = DMFieldComputeFaceData_DS;
105051a454edSToby Isaac   PetscFunctionReturn(0);
105151a454edSToby Isaac }
105251a454edSToby Isaac 
105351a454edSToby Isaac PETSC_INTERN PetscErrorCode DMFieldCreate_DS(DMField field)
105451a454edSToby Isaac {
105551a454edSToby Isaac   DMField_DS     *dsfield;
105651a454edSToby Isaac   PetscErrorCode ierr;
105751a454edSToby Isaac 
105851a454edSToby Isaac   PetscFunctionBegin;
105951a454edSToby Isaac   ierr = PetscNewLog(field,&dsfield);CHKERRQ(ierr);
106051a454edSToby Isaac   field->data = dsfield;
106151a454edSToby Isaac   ierr = DMFieldInitialize_DS(field);CHKERRQ(ierr);
106251a454edSToby Isaac   PetscFunctionReturn(0);
106351a454edSToby Isaac }
106451a454edSToby Isaac 
106551a454edSToby Isaac PetscErrorCode DMFieldCreateDS(DM dm, PetscInt fieldNum, Vec vec,DMField *field)
106651a454edSToby Isaac {
106751a454edSToby Isaac   DMField        b;
106851a454edSToby Isaac   DMField_DS     *dsfield;
106951a454edSToby Isaac   PetscObject    disc = NULL;
107051a454edSToby Isaac   PetscBool      isContainer = PETSC_FALSE;
107151a454edSToby Isaac   PetscClassId   id = -1;
107251a454edSToby Isaac   PetscInt       numComponents = -1, dsNumFields;
107351a454edSToby Isaac   PetscSection   section;
107451a454edSToby Isaac   PetscErrorCode ierr;
107551a454edSToby Isaac 
107651a454edSToby Isaac   PetscFunctionBegin;
107792fd8e1eSJed Brown   ierr = DMGetLocalSection(dm,&section);CHKERRQ(ierr);
107851a454edSToby Isaac   ierr = PetscSectionGetFieldComponents(section,fieldNum,&numComponents);CHKERRQ(ierr);
107951a454edSToby Isaac   ierr = DMGetNumFields(dm,&dsNumFields);CHKERRQ(ierr);
108044a7f3ddSMatthew G. Knepley   if (dsNumFields) {ierr = DMGetField(dm,fieldNum,NULL,&disc);CHKERRQ(ierr);}
108151a454edSToby Isaac   if (disc) {
108251a454edSToby Isaac     ierr = PetscObjectGetClassId(disc,&id);CHKERRQ(ierr);
108351a454edSToby Isaac     isContainer = (id == PETSC_CONTAINER_CLASSID) ? PETSC_TRUE : PETSC_FALSE;
108451a454edSToby Isaac   }
108551a454edSToby Isaac   if (!disc || isContainer) {
108651a454edSToby Isaac     MPI_Comm        comm = PetscObjectComm((PetscObject) dm);
10871fdf1f07SMatthew G. Knepley     PetscInt        cStart, cEnd, dim, cellHeight;
108851a454edSToby Isaac     PetscInt        localConeSize = 0, coneSize;
108951a454edSToby Isaac     PetscFE         fe;
109051a454edSToby Isaac     PetscDualSpace  Q;
109151a454edSToby Isaac     PetscSpace      P;
109251a454edSToby Isaac     DM              K;
109351a454edSToby Isaac     PetscQuadrature quad, fquad;
109451a454edSToby Isaac     PetscBool       isSimplex;
109551a454edSToby Isaac 
10961fdf1f07SMatthew G. Knepley     ierr = DMPlexGetVTKCellHeight(dm, &cellHeight);CHKERRQ(ierr);
10971fdf1f07SMatthew G. Knepley     ierr = DMPlexGetHeightStratum(dm, cellHeight, &cStart, &cEnd);CHKERRQ(ierr);
109851a454edSToby Isaac     ierr = DMGetDimension(dm, &dim);CHKERRQ(ierr);
109951a454edSToby Isaac     if (cEnd > cStart) {
110051a454edSToby Isaac       ierr = DMPlexGetConeSize(dm, cStart, &localConeSize);CHKERRQ(ierr);
110151a454edSToby Isaac     }
1102ffc4695bSBarry Smith     ierr = MPI_Allreduce(&localConeSize,&coneSize,1,MPIU_INT,MPI_MAX,comm);CHKERRMPI(ierr);
110351a454edSToby Isaac     isSimplex = (coneSize == (dim + 1)) ? PETSC_TRUE : PETSC_FALSE;
1104360cf244SMatthew G. Knepley     ierr = PetscSpaceCreate(PETSC_COMM_SELF, &P);CHKERRQ(ierr);
110551a454edSToby Isaac     ierr = PetscSpaceSetType(P,PETSCSPACEPOLYNOMIAL);CHKERRQ(ierr);
1106d39dd5f5SToby Isaac     ierr = PetscSpaceSetDegree(P, 1, PETSC_DETERMINE);CHKERRQ(ierr);
1107d39dd5f5SToby Isaac     ierr = PetscSpaceSetNumComponents(P, numComponents);CHKERRQ(ierr);
110851a454edSToby Isaac     ierr = PetscSpaceSetNumVariables(P, dim);CHKERRQ(ierr);
110951a454edSToby Isaac     ierr = PetscSpacePolynomialSetTensor(P, isSimplex ? PETSC_FALSE : PETSC_TRUE);CHKERRQ(ierr);
111051a454edSToby Isaac     ierr = PetscSpaceSetUp(P);CHKERRQ(ierr);
1111360cf244SMatthew G. Knepley     ierr = PetscDualSpaceCreate(PETSC_COMM_SELF, &Q);CHKERRQ(ierr);
111251a454edSToby Isaac     ierr = PetscDualSpaceSetType(Q,PETSCDUALSPACELAGRANGE);CHKERRQ(ierr);
111351a454edSToby Isaac     ierr = PetscDualSpaceCreateReferenceCell(Q, dim, isSimplex, &K);CHKERRQ(ierr);
111451a454edSToby Isaac     ierr = PetscDualSpaceSetDM(Q, K);CHKERRQ(ierr);
111551a454edSToby Isaac     ierr = DMDestroy(&K);CHKERRQ(ierr);
111651a454edSToby Isaac     ierr = PetscDualSpaceSetNumComponents(Q, numComponents);CHKERRQ(ierr);
111751a454edSToby Isaac     ierr = PetscDualSpaceSetOrder(Q, 1);CHKERRQ(ierr);
111851a454edSToby Isaac     ierr = PetscDualSpaceLagrangeSetTensor(Q, isSimplex ? PETSC_FALSE : PETSC_TRUE);CHKERRQ(ierr);
111951a454edSToby Isaac     ierr = PetscDualSpaceSetUp(Q);CHKERRQ(ierr);
1120360cf244SMatthew G. Knepley     ierr = PetscFECreate(PETSC_COMM_SELF, &fe);CHKERRQ(ierr);
112151a454edSToby Isaac     ierr = PetscFESetType(fe,PETSCFEBASIC);CHKERRQ(ierr);
112251a454edSToby Isaac     ierr = PetscFESetBasisSpace(fe, P);CHKERRQ(ierr);
112351a454edSToby Isaac     ierr = PetscFESetDualSpace(fe, Q);CHKERRQ(ierr);
112451a454edSToby Isaac     ierr = PetscFESetNumComponents(fe, numComponents);CHKERRQ(ierr);
112551a454edSToby Isaac     ierr = PetscFESetUp(fe);CHKERRQ(ierr);
112651a454edSToby Isaac     ierr = PetscSpaceDestroy(&P);CHKERRQ(ierr);
112751a454edSToby Isaac     ierr = PetscDualSpaceDestroy(&Q);CHKERRQ(ierr);
112851a454edSToby Isaac     if (isSimplex) {
1129e6a796c3SToby Isaac       ierr = PetscDTStroudConicalQuadrature(dim,   1, 1, -1.0, 1.0, &quad);CHKERRQ(ierr);
1130e6a796c3SToby Isaac       ierr = PetscDTStroudConicalQuadrature(dim-1, 1, 1, -1.0, 1.0, &fquad);CHKERRQ(ierr);
113151a454edSToby Isaac     }
113251a454edSToby Isaac     else {
113351a454edSToby Isaac       ierr = PetscDTGaussTensorQuadrature(dim,   1, 1, -1.0, 1.0, &quad);CHKERRQ(ierr);
113451a454edSToby Isaac       ierr = PetscDTGaussTensorQuadrature(dim-1, 1, 1, -1.0, 1.0, &fquad);CHKERRQ(ierr);
113551a454edSToby Isaac     }
113651a454edSToby Isaac     ierr = PetscFESetQuadrature(fe, quad);CHKERRQ(ierr);
113751a454edSToby Isaac     ierr = PetscFESetFaceQuadrature(fe, fquad);CHKERRQ(ierr);
113851a454edSToby Isaac     ierr = PetscQuadratureDestroy(&quad);CHKERRQ(ierr);
113951a454edSToby Isaac     ierr = PetscQuadratureDestroy(&fquad);CHKERRQ(ierr);
114051a454edSToby Isaac     disc = (PetscObject) fe;
114151a454edSToby Isaac   } else {
114251a454edSToby Isaac     ierr = PetscObjectReference(disc);CHKERRQ(ierr);
114351a454edSToby Isaac   }
114451a454edSToby Isaac   ierr = PetscObjectGetClassId(disc,&id);CHKERRQ(ierr);
114551a454edSToby Isaac   if (id == PETSCFE_CLASSID) {
114651a454edSToby Isaac     PetscFE fe = (PetscFE) disc;
114751a454edSToby Isaac 
114851a454edSToby Isaac     ierr = PetscFEGetNumComponents(fe,&numComponents);CHKERRQ(ierr);
11492da392ccSBarry Smith   } else SETERRQ(PetscObjectComm((PetscObject)dm),PETSC_ERR_SUP,"Not implemented");
115051a454edSToby Isaac   ierr = DMFieldCreate(dm,numComponents,DMFIELD_VERTEX,&b);CHKERRQ(ierr);
115151a454edSToby Isaac   ierr = DMFieldSetType(b,DMFIELDDS);CHKERRQ(ierr);
115251a454edSToby Isaac   dsfield = (DMField_DS *) b->data;
115351a454edSToby Isaac   dsfield->fieldNum = fieldNum;
115451a454edSToby Isaac   ierr = DMGetDimension(dm,&dsfield->height);CHKERRQ(ierr);
1155f99c8401SToby Isaac   dsfield->height++;
115651a454edSToby Isaac   ierr = PetscCalloc1(dsfield->height,&dsfield->disc);CHKERRQ(ierr);
115751a454edSToby Isaac   dsfield->disc[0] = disc;
115851a454edSToby Isaac   ierr = PetscObjectReference((PetscObject)vec);CHKERRQ(ierr);
115951a454edSToby Isaac   dsfield->vec = vec;
116051a454edSToby Isaac   *field = b;
116151a454edSToby Isaac 
116251a454edSToby Isaac   PetscFunctionReturn(0);
116351a454edSToby Isaac }
1164