xref: /petsc/src/dm/impls/plex/plexfem.c (revision 5f80ce2ab25dff0f4601e710601cbbcecf323266)
1af0996ceSBarry Smith #include <petsc/private/dmpleximpl.h>   /*I      "petscdmplex.h"   I*/
2da97024aSMatthew G. Knepley #include <petscsf.h>
3cb1e1211SMatthew G Knepley 
48e3a2eefSMatthew G. Knepley #include <petscblaslapack.h>
5e8f14785SLisandro Dalcin #include <petsc/private/hashsetij.h>
6af0996ceSBarry Smith #include <petsc/private/petscfeimpl.h>
7af0996ceSBarry Smith #include <petsc/private/petscfvimpl.h>
8a0845e3aSMatthew G. Knepley 
95f0b18bfSMatthew G. Knepley PetscBool Clementcite = PETSC_FALSE;
105f0b18bfSMatthew G. Knepley const char ClementCitation[] = "@article{clement1975approximation,\n"
115f0b18bfSMatthew G. Knepley                                "  title   = {Approximation by finite element functions using local regularization},\n"
125f0b18bfSMatthew G. Knepley                                "  author  = {Philippe Cl{\\'e}ment},\n"
135f0b18bfSMatthew G. Knepley                                "  journal = {Revue fran{\\c{c}}aise d'automatique, informatique, recherche op{\\'e}rationnelle. Analyse num{\\'e}rique},\n"
145f0b18bfSMatthew G. Knepley                                "  volume  = {9},\n"
155f0b18bfSMatthew G. Knepley                                "  number  = {R2},\n"
165f0b18bfSMatthew G. Knepley                                "  pages   = {77--84},\n"
175f0b18bfSMatthew G. Knepley                                "  year    = {1975}\n}\n";
185f0b18bfSMatthew G. Knepley 
192f856554SMatthew G. Knepley static PetscErrorCode DMPlexConvertPlex(DM dm, DM *plex, PetscBool copy)
202f856554SMatthew G. Knepley {
212f856554SMatthew G. Knepley   PetscBool      isPlex;
222f856554SMatthew G. Knepley 
232f856554SMatthew G. Knepley   PetscFunctionBegin;
24*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscObjectTypeCompare((PetscObject) dm, DMPLEX, &isPlex));
252f856554SMatthew G. Knepley   if (isPlex) {
262f856554SMatthew G. Knepley     *plex = dm;
27*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectReference((PetscObject) dm));
282f856554SMatthew G. Knepley   } else {
29*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectQuery((PetscObject) dm, "dm_plex", (PetscObject *) plex));
302f856554SMatthew G. Knepley     if (!*plex) {
31*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMConvert(dm, DMPLEX, plex));
32*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscObjectCompose((PetscObject) dm, "dm_plex", (PetscObject) *plex));
332f856554SMatthew G. Knepley       if (copy) {
342f856554SMatthew G. Knepley         DMSubDomainHookLink link;
359a2a23afSMatthew G. Knepley 
36*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMCopyAuxiliaryVec(dm, *plex));
379a2a23afSMatthew G. Knepley         /* Run the subdomain hook (this will copy the DMSNES/DMTS) */
382f856554SMatthew G. Knepley         for (link = dm->subdomainhook; link; link = link->next) {
39*5f80ce2aSJacob Faibussowitsch           if (link->ddhook) CHKERRQ((*link->ddhook)(dm, *plex, link->ctx));
402f856554SMatthew G. Knepley         }
412f856554SMatthew G. Knepley       }
422f856554SMatthew G. Knepley     } else {
43*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscObjectReference((PetscObject) *plex));
442f856554SMatthew G. Knepley     }
452f856554SMatthew G. Knepley   }
462f856554SMatthew G. Knepley   PetscFunctionReturn(0);
472f856554SMatthew G. Knepley }
482f856554SMatthew G. Knepley 
499b6f715bSMatthew G. Knepley static PetscErrorCode PetscContainerUserDestroy_PetscFEGeom (void *ctx)
509b6f715bSMatthew G. Knepley {
519b6f715bSMatthew G. Knepley   PetscFEGeom *geom = (PetscFEGeom *) ctx;
529b6f715bSMatthew G. Knepley 
539b6f715bSMatthew G. Knepley   PetscFunctionBegin;
54*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFEGeomDestroy(&geom));
559b6f715bSMatthew G. Knepley   PetscFunctionReturn(0);
569b6f715bSMatthew G. Knepley }
579b6f715bSMatthew G. Knepley 
589b6f715bSMatthew G. Knepley static PetscErrorCode DMPlexGetFEGeom(DMField coordField, IS pointIS, PetscQuadrature quad, PetscBool faceData, PetscFEGeom **geom)
599b6f715bSMatthew G. Knepley {
609b6f715bSMatthew G. Knepley   char            composeStr[33] = {0};
619b6f715bSMatthew G. Knepley   PetscObjectId   id;
629b6f715bSMatthew G. Knepley   PetscContainer  container;
639b6f715bSMatthew G. Knepley 
649b6f715bSMatthew G. Knepley   PetscFunctionBegin;
65*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscObjectGetId((PetscObject)quad,&id));
66*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSNPrintf(composeStr, 32, "DMPlexGetFEGeom_%x\n", id));
67*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscObjectQuery((PetscObject) pointIS, composeStr, (PetscObject *) &container));
689b6f715bSMatthew G. Knepley   if (container) {
69*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscContainerGetPointer(container, (void **) geom));
709b6f715bSMatthew G. Knepley   } else {
71*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMFieldCreateFEGeom(coordField, pointIS, quad, faceData, geom));
72*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscContainerCreate(PETSC_COMM_SELF,&container));
73*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscContainerSetPointer(container, (void *) *geom));
74*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscContainerSetUserDestroy(container, PetscContainerUserDestroy_PetscFEGeom));
75*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectCompose((PetscObject) pointIS, composeStr, (PetscObject) container));
76*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscContainerDestroy(&container));
779b6f715bSMatthew G. Knepley   }
789b6f715bSMatthew G. Knepley   PetscFunctionReturn(0);
799b6f715bSMatthew G. Knepley }
809b6f715bSMatthew G. Knepley 
819b6f715bSMatthew G. Knepley static PetscErrorCode DMPlexRestoreFEGeom(DMField coordField, IS pointIS, PetscQuadrature quad, PetscBool faceData, PetscFEGeom **geom)
829b6f715bSMatthew G. Knepley {
839b6f715bSMatthew G. Knepley   PetscFunctionBegin;
849b6f715bSMatthew G. Knepley   *geom = NULL;
859b6f715bSMatthew G. Knepley   PetscFunctionReturn(0);
869b6f715bSMatthew G. Knepley }
879b6f715bSMatthew G. Knepley 
8846fa42a0SMatthew G. Knepley /*@
8946fa42a0SMatthew G. Knepley   DMPlexGetScale - Get the scale for the specified fundamental unit
9046fa42a0SMatthew G. Knepley 
9146fa42a0SMatthew G. Knepley   Not collective
9246fa42a0SMatthew G. Knepley 
934165533cSJose E. Roman   Input Parameters:
9446fa42a0SMatthew G. Knepley + dm   - the DM
9546fa42a0SMatthew G. Knepley - unit - The SI unit
9646fa42a0SMatthew G. Knepley 
974165533cSJose E. Roman   Output Parameter:
9846fa42a0SMatthew G. Knepley . scale - The value used to scale all quantities with this unit
9946fa42a0SMatthew G. Knepley 
10046fa42a0SMatthew G. Knepley   Level: advanced
10146fa42a0SMatthew G. Knepley 
10246fa42a0SMatthew G. Knepley .seealso: DMPlexSetScale(), PetscUnit
10346fa42a0SMatthew G. Knepley @*/
104cb1e1211SMatthew G Knepley PetscErrorCode DMPlexGetScale(DM dm, PetscUnit unit, PetscReal *scale)
105cb1e1211SMatthew G Knepley {
106cb1e1211SMatthew G Knepley   DM_Plex *mesh = (DM_Plex*) dm->data;
107cb1e1211SMatthew G Knepley 
108cb1e1211SMatthew G Knepley   PetscFunctionBegin;
109cb1e1211SMatthew G Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
110cb1e1211SMatthew G Knepley   PetscValidPointer(scale, 3);
111cb1e1211SMatthew G Knepley   *scale = mesh->scale[unit];
112cb1e1211SMatthew G Knepley   PetscFunctionReturn(0);
113cb1e1211SMatthew G Knepley }
114cb1e1211SMatthew G Knepley 
11546fa42a0SMatthew G. Knepley /*@
11646fa42a0SMatthew G. Knepley   DMPlexSetScale - Set the scale for the specified fundamental unit
11746fa42a0SMatthew G. Knepley 
11846fa42a0SMatthew G. Knepley   Not collective
11946fa42a0SMatthew G. Knepley 
1204165533cSJose E. Roman   Input Parameters:
12146fa42a0SMatthew G. Knepley + dm   - the DM
12246fa42a0SMatthew G. Knepley . unit - The SI unit
12346fa42a0SMatthew G. Knepley - scale - The value used to scale all quantities with this unit
12446fa42a0SMatthew G. Knepley 
12546fa42a0SMatthew G. Knepley   Level: advanced
12646fa42a0SMatthew G. Knepley 
12746fa42a0SMatthew G. Knepley .seealso: DMPlexGetScale(), PetscUnit
12846fa42a0SMatthew G. Knepley @*/
129cb1e1211SMatthew G Knepley PetscErrorCode DMPlexSetScale(DM dm, PetscUnit unit, PetscReal scale)
130cb1e1211SMatthew G Knepley {
131cb1e1211SMatthew G Knepley   DM_Plex *mesh = (DM_Plex*) dm->data;
132cb1e1211SMatthew G Knepley 
133cb1e1211SMatthew G Knepley   PetscFunctionBegin;
134cb1e1211SMatthew G Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
135cb1e1211SMatthew G Knepley   mesh->scale[unit] = scale;
136cb1e1211SMatthew G Knepley   PetscFunctionReturn(0);
137cb1e1211SMatthew G Knepley }
138cb1e1211SMatthew G Knepley 
139327779f2SMatthew Knepley static PetscErrorCode DMPlexProjectRigidBody_Private(PetscInt dim, PetscReal t, const PetscReal X[], PetscInt Nc, PetscScalar *mode, void *ctx)
140026175e5SToby Isaac {
14112adca46SMatthew G. Knepley   const PetscInt eps[3][3][3] = {{{0, 0, 0}, {0, 0, 1}, {0, -1, 0}}, {{0, 0, -1}, {0, 0, 0}, {1, 0, 0}}, {{0, 1, 0}, {-1, 0, 0}, {0, 0, 0}}};
142026175e5SToby Isaac   PetscInt *ctxInt  = (PetscInt *) ctx;
143ad917190SMatthew G. Knepley   PetscInt  dim2    = ctxInt[0];
144026175e5SToby Isaac   PetscInt  d       = ctxInt[1];
145026175e5SToby Isaac   PetscInt  i, j, k = dim > 2 ? d - dim : d;
146026175e5SToby Isaac 
147ad917190SMatthew G. Knepley   PetscFunctionBegin;
148*5f80ce2aSJacob Faibussowitsch   PetscCheck(dim == dim2,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Input dimension %D does not match context dimension %D", dim, dim2);
149026175e5SToby Isaac   for (i = 0; i < dim; i++) mode[i] = 0.;
150026175e5SToby Isaac   if (d < dim) {
15112adca46SMatthew G. Knepley     mode[d] = 1.; /* Translation along axis d */
152ad917190SMatthew G. Knepley   } else {
153026175e5SToby Isaac     for (i = 0; i < dim; i++) {
154026175e5SToby Isaac       for (j = 0; j < dim; j++) {
15512adca46SMatthew G. Knepley         mode[j] += eps[i][j][k]*X[i]; /* Rotation about axis d */
156026175e5SToby Isaac       }
157026175e5SToby Isaac     }
158026175e5SToby Isaac   }
159ad917190SMatthew G. Knepley   PetscFunctionReturn(0);
160026175e5SToby Isaac }
161026175e5SToby Isaac 
162cc4e42d9SMartin Diehl /*@
16312adca46SMatthew G. Knepley   DMPlexCreateRigidBody - For the default global section, create rigid body modes by function space interpolation
164cb1e1211SMatthew G Knepley 
165d083f849SBarry Smith   Collective on dm
166cb1e1211SMatthew G Knepley 
1674165533cSJose E. Roman   Input Parameters:
16856cf3b9cSMatthew G. Knepley + dm - the DM
16956cf3b9cSMatthew G. Knepley - field - The field number for the rigid body space, or 0 for the default
170cb1e1211SMatthew G Knepley 
1714165533cSJose E. Roman   Output Parameter:
172cb1e1211SMatthew G Knepley . sp - the null space
173cb1e1211SMatthew G Knepley 
17412adca46SMatthew G. Knepley   Note: This is necessary to provide a suitable coarse space for algebraic multigrid
175cb1e1211SMatthew G Knepley 
176cb1e1211SMatthew G Knepley   Level: advanced
177cb1e1211SMatthew G Knepley 
17812adca46SMatthew G. Knepley .seealso: MatNullSpaceCreate(), PCGAMG
179cb1e1211SMatthew G Knepley @*/
18056cf3b9cSMatthew G. Knepley PetscErrorCode DMPlexCreateRigidBody(DM dm, PetscInt field, MatNullSpace *sp)
181cb1e1211SMatthew G Knepley {
18256cf3b9cSMatthew G. Knepley   PetscErrorCode (**func)(PetscInt, PetscReal, const PetscReal *, PetscInt, PetscScalar *, void *);
183cb1e1211SMatthew G Knepley   MPI_Comm          comm;
184026175e5SToby Isaac   Vec               mode[6];
185026175e5SToby Isaac   PetscSection      section, globalSection;
18656cf3b9cSMatthew G. Knepley   PetscInt          dim, dimEmbed, Nf, n, m, mmin, d, i, j;
187cb1e1211SMatthew G Knepley 
188cb1e1211SMatthew G Knepley   PetscFunctionBegin;
189*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscObjectGetComm((PetscObject) dm, &comm));
190*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dm, &dim));
191*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateDim(dm, &dimEmbed));
192*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetNumFields(dm, &Nf));
1932c71b3e2SJacob Faibussowitsch   PetscCheckFalse(Nf && (field < 0 || field >= Nf),comm, PETSC_ERR_ARG_OUTOFRANGE, "Field %D is not in [0, Nf)", field, Nf);
19456cf3b9cSMatthew G. Knepley   if (dim == 1 && Nf < 2) {
195*5f80ce2aSJacob Faibussowitsch     CHKERRQ(MatNullSpaceCreate(comm, PETSC_TRUE, 0, NULL, sp));
196cb1e1211SMatthew G Knepley     PetscFunctionReturn(0);
197cb1e1211SMatthew G Knepley   }
198*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &section));
199*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetGlobalSection(dm, &globalSection));
200*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetConstrainedStorageSize(globalSection, &n));
201*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscCalloc1(Nf, &func));
202b247467aSMatthew G. Knepley   m    = (dim*(dim+1))/2;
203*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecCreate(comm, &mode[0]));
204*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecSetType(mode[0], dm->vectype));
205*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecSetSizes(mode[0], n, PETSC_DETERMINE));
206*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecSetUp(mode[0]));
207*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetSize(mode[0], &n));
208b247467aSMatthew G. Knepley   mmin = PetscMin(m, n);
20956cf3b9cSMatthew G. Knepley   func[field] = DMPlexProjectRigidBody_Private;
210*5f80ce2aSJacob Faibussowitsch   for (i = 1; i < m; ++i) CHKERRQ(VecDuplicate(mode[0], &mode[i]));
211026175e5SToby Isaac   for (d = 0; d < m; d++) {
212330485fdSToby Isaac     PetscInt ctx[2];
213026175e5SToby Isaac     void    *voidctx = (void *) (&ctx[0]);
214cb1e1211SMatthew G Knepley 
2159d8fbdeaSMatthew G. Knepley     ctx[0] = dimEmbed;
216330485fdSToby Isaac     ctx[1] = d;
217*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMProjectFunction(dm, 0.0, func, &voidctx, INSERT_VALUES, mode[d]));
218cb1e1211SMatthew G Knepley   }
2193b2202bfSJacob Faibussowitsch   /* Orthonormalize system */
220b50a2c0aSJacob Faibussowitsch   for (i = 0; i < mmin; ++i) {
221b77f2eeeSJacob Faibussowitsch     PetscScalar dots[6];
222b50a2c0aSJacob Faibussowitsch 
223*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecNormalize(mode[i], NULL));
224*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecMDot(mode[i], mmin-i-1, mode+i+1, dots+i+1));
225b50a2c0aSJacob Faibussowitsch     for (j = i+1; j < mmin; ++j) {
226b77f2eeeSJacob Faibussowitsch       dots[j] *= -1.0;
227*5f80ce2aSJacob Faibussowitsch       CHKERRQ(VecAXPY(mode[j], dots[j], mode[i]));
228b50a2c0aSJacob Faibussowitsch     }
229cb1e1211SMatthew G Knepley   }
230*5f80ce2aSJacob Faibussowitsch   CHKERRQ(MatNullSpaceCreate(comm, PETSC_FALSE, mmin, mode, sp));
231*5f80ce2aSJacob Faibussowitsch   for (i = 0; i < m; ++i) CHKERRQ(VecDestroy(&mode[i]));
232*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree(func));
233cb1e1211SMatthew G Knepley   PetscFunctionReturn(0);
234cb1e1211SMatthew G Knepley }
235cb1e1211SMatthew G Knepley 
236cc4e42d9SMartin Diehl /*@
23712adca46SMatthew G. Knepley   DMPlexCreateRigidBodies - For the default global section, create rigid body modes by function space interpolation
23812adca46SMatthew G. Knepley 
239d083f849SBarry Smith   Collective on dm
24012adca46SMatthew G. Knepley 
2414165533cSJose E. Roman   Input Parameters:
24212adca46SMatthew G. Knepley + dm    - the DM
24312adca46SMatthew G. Knepley . nb    - The number of bodies
24412adca46SMatthew G. Knepley . label - The DMLabel marking each domain
24512adca46SMatthew G. Knepley . nids  - The number of ids per body
24612adca46SMatthew G. Knepley - ids   - An array of the label ids in sequence for each domain
24712adca46SMatthew G. Knepley 
2484165533cSJose E. Roman   Output Parameter:
24912adca46SMatthew G. Knepley . sp - the null space
25012adca46SMatthew G. Knepley 
25112adca46SMatthew G. Knepley   Note: This is necessary to provide a suitable coarse space for algebraic multigrid
25212adca46SMatthew G. Knepley 
25312adca46SMatthew G. Knepley   Level: advanced
25412adca46SMatthew G. Knepley 
25512adca46SMatthew G. Knepley .seealso: MatNullSpaceCreate()
25612adca46SMatthew G. Knepley @*/
25712adca46SMatthew G. Knepley PetscErrorCode DMPlexCreateRigidBodies(DM dm, PetscInt nb, DMLabel label, const PetscInt nids[], const PetscInt ids[], MatNullSpace *sp)
25812adca46SMatthew G. Knepley {
25912adca46SMatthew G. Knepley   MPI_Comm       comm;
26012adca46SMatthew G. Knepley   PetscSection   section, globalSection;
26112adca46SMatthew G. Knepley   Vec           *mode;
26212adca46SMatthew G. Knepley   PetscScalar   *dots;
26312adca46SMatthew G. Knepley   PetscInt       dim, dimEmbed, n, m, b, d, i, j, off;
26412adca46SMatthew G. Knepley 
26512adca46SMatthew G. Knepley   PetscFunctionBegin;
266*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscObjectGetComm((PetscObject)dm,&comm));
267*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dm, &dim));
268*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateDim(dm, &dimEmbed));
269*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &section));
270*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetGlobalSection(dm, &globalSection));
271*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetConstrainedStorageSize(globalSection, &n));
27212adca46SMatthew G. Knepley   m    = nb * (dim*(dim+1))/2;
273*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc2(m, &mode, m, &dots));
274*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecCreate(comm, &mode[0]));
275*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecSetSizes(mode[0], n, PETSC_DETERMINE));
276*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecSetUp(mode[0]));
277*5f80ce2aSJacob Faibussowitsch   for (i = 1; i < m; ++i) CHKERRQ(VecDuplicate(mode[0], &mode[i]));
27812adca46SMatthew G. Knepley   for (b = 0, off = 0; b < nb; ++b) {
27912adca46SMatthew G. Knepley     for (d = 0; d < m/nb; ++d) {
28012adca46SMatthew G. Knepley       PetscInt         ctx[2];
28112adca46SMatthew G. Knepley       PetscErrorCode (*func)(PetscInt, PetscReal, const PetscReal *, PetscInt, PetscScalar *, void *) = DMPlexProjectRigidBody_Private;
28212adca46SMatthew G. Knepley       void            *voidctx = (void *) (&ctx[0]);
28312adca46SMatthew G. Knepley 
28412adca46SMatthew G. Knepley       ctx[0] = dimEmbed;
28512adca46SMatthew G. Knepley       ctx[1] = d;
286*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMProjectFunctionLabel(dm, 0.0, label, nids[b], &ids[off], 0, NULL, &func, &voidctx, INSERT_VALUES, mode[d]));
28712adca46SMatthew G. Knepley       off   += nids[b];
28812adca46SMatthew G. Knepley     }
28912adca46SMatthew G. Knepley   }
2903b2202bfSJacob Faibussowitsch   /* Orthonormalize system */
291606c1a1cSJacob Faibussowitsch   for (i = 0; i < m; ++i) {
292b77f2eeeSJacob Faibussowitsch     PetscScalar dots[6];
2935a0e29b9SJacob Faibussowitsch 
294*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecNormalize(mode[i], NULL));
295*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecMDot(mode[i], m-i-1, mode+i+1, dots+i+1));
2965a0e29b9SJacob Faibussowitsch     for (j = i+1; j < m; ++j) {
297b77f2eeeSJacob Faibussowitsch       dots[j] *= -1.0;
298*5f80ce2aSJacob Faibussowitsch       CHKERRQ(VecAXPY(mode[j], dots[j], mode[i]));
2995a0e29b9SJacob Faibussowitsch     }
30012adca46SMatthew G. Knepley   }
301*5f80ce2aSJacob Faibussowitsch   CHKERRQ(MatNullSpaceCreate(comm, PETSC_FALSE, m, mode, sp));
302*5f80ce2aSJacob Faibussowitsch   for (i = 0; i< m; ++i) CHKERRQ(VecDestroy(&mode[i]));
303*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree2(mode, dots));
30412adca46SMatthew G. Knepley   PetscFunctionReturn(0);
30512adca46SMatthew G. Knepley }
30612adca46SMatthew G. Knepley 
307b29cfa1cSToby Isaac /*@
308b29cfa1cSToby Isaac   DMPlexSetMaxProjectionHeight - In DMPlexProjectXXXLocal() functions, the projected values of a basis function's dofs
309b29cfa1cSToby Isaac   are computed by associating the basis function with one of the mesh points in its transitively-closed support, and
310b29cfa1cSToby Isaac   evaluating the dual space basis of that point.  A basis function is associated with the point in its
311b29cfa1cSToby Isaac   transitively-closed support whose mesh height is highest (w.r.t. DAG height), but not greater than the maximum
312b29cfa1cSToby Isaac   projection height, which is set with this function.  By default, the maximum projection height is zero, which means
313b29cfa1cSToby Isaac   that only mesh cells are used to project basis functions.  A height of one, for example, evaluates a cell-interior
314b29cfa1cSToby Isaac   basis functions using its cells dual space basis, but all other basis functions with the dual space basis of a face.
315b29cfa1cSToby Isaac 
316b29cfa1cSToby Isaac   Input Parameters:
317b29cfa1cSToby Isaac + dm - the DMPlex object
318b29cfa1cSToby Isaac - height - the maximum projection height >= 0
319b29cfa1cSToby Isaac 
320b29cfa1cSToby Isaac   Level: advanced
321b29cfa1cSToby Isaac 
3224d6f44ffSToby Isaac .seealso: DMPlexGetMaxProjectionHeight(), DMProjectFunctionLocal(), DMProjectFunctionLabelLocal()
323b29cfa1cSToby Isaac @*/
324b29cfa1cSToby Isaac PetscErrorCode DMPlexSetMaxProjectionHeight(DM dm, PetscInt height)
325b29cfa1cSToby Isaac {
326b29cfa1cSToby Isaac   DM_Plex *plex = (DM_Plex *) dm->data;
327b29cfa1cSToby Isaac 
328b29cfa1cSToby Isaac   PetscFunctionBegin;
329b29cfa1cSToby Isaac   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
330b29cfa1cSToby Isaac   plex->maxProjectionHeight = height;
331b29cfa1cSToby Isaac   PetscFunctionReturn(0);
332b29cfa1cSToby Isaac }
333b29cfa1cSToby Isaac 
334b29cfa1cSToby Isaac /*@
335b29cfa1cSToby Isaac   DMPlexGetMaxProjectionHeight - Get the maximum height (w.r.t. DAG) of mesh points used to evaluate dual bases in
336b29cfa1cSToby Isaac   DMPlexProjectXXXLocal() functions.
337b29cfa1cSToby Isaac 
338b29cfa1cSToby Isaac   Input Parameters:
339b29cfa1cSToby Isaac . dm - the DMPlex object
340b29cfa1cSToby Isaac 
341b29cfa1cSToby Isaac   Output Parameters:
342b29cfa1cSToby Isaac . height - the maximum projection height
343b29cfa1cSToby Isaac 
344b29cfa1cSToby Isaac   Level: intermediate
345b29cfa1cSToby Isaac 
3464d6f44ffSToby Isaac .seealso: DMPlexSetMaxProjectionHeight(), DMProjectFunctionLocal(), DMProjectFunctionLabelLocal()
347b29cfa1cSToby Isaac @*/
348b29cfa1cSToby Isaac PetscErrorCode DMPlexGetMaxProjectionHeight(DM dm, PetscInt *height)
349b29cfa1cSToby Isaac {
350b29cfa1cSToby Isaac   DM_Plex *plex = (DM_Plex *) dm->data;
351b29cfa1cSToby Isaac 
352b29cfa1cSToby Isaac   PetscFunctionBegin;
353b29cfa1cSToby Isaac   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
354b29cfa1cSToby Isaac   *height = plex->maxProjectionHeight;
355b29cfa1cSToby Isaac   PetscFunctionReturn(0);
356b29cfa1cSToby Isaac }
357b29cfa1cSToby Isaac 
358ca3d3a14SMatthew G. Knepley typedef struct {
359ca3d3a14SMatthew G. Knepley   PetscReal    alpha; /* The first Euler angle, and in 2D the only one */
360ca3d3a14SMatthew G. Knepley   PetscReal    beta;  /* The second Euler angle */
361ca3d3a14SMatthew G. Knepley   PetscReal    gamma; /* The third Euler angle */
362ca3d3a14SMatthew G. Knepley   PetscInt     dim;   /* The dimension of R */
363ca3d3a14SMatthew G. Knepley   PetscScalar *R;     /* The rotation matrix, transforming a vector in the local basis to the global basis */
364ca3d3a14SMatthew G. Knepley   PetscScalar *RT;    /* The transposed rotation matrix, transforming a vector in the global basis to the local basis */
365ca3d3a14SMatthew G. Knepley } RotCtx;
366ca3d3a14SMatthew G. Knepley 
367ca3d3a14SMatthew G. Knepley /*
368ca3d3a14SMatthew G. Knepley   Note: Following https://en.wikipedia.org/wiki/Euler_angles, we will specify Euler angles by extrinsic rotations, meaning that
369ca3d3a14SMatthew G. Knepley   we rotate with respect to a fixed initial coordinate system, the local basis (x-y-z). The global basis (X-Y-Z) is reached as follows:
370ca3d3a14SMatthew G. Knepley   $ The XYZ system rotates about the z axis by alpha. The X axis is now at angle alpha with respect to the x axis.
371ca3d3a14SMatthew G. Knepley   $ The XYZ system rotates again about the x axis by beta. The Z axis is now at angle beta with respect to the z axis.
372ca3d3a14SMatthew G. Knepley   $ The XYZ system rotates a third time about the z axis by gamma.
373ca3d3a14SMatthew G. Knepley */
374ca3d3a14SMatthew G. Knepley static PetscErrorCode DMPlexBasisTransformSetUp_Rotation_Internal(DM dm, void *ctx)
375ca3d3a14SMatthew G. Knepley {
376ca3d3a14SMatthew G. Knepley   RotCtx        *rc  = (RotCtx *) ctx;
377ca3d3a14SMatthew G. Knepley   PetscInt       dim = rc->dim;
378ca3d3a14SMatthew G. Knepley   PetscReal      c1, s1, c2, s2, c3, s3;
379ca3d3a14SMatthew G. Knepley 
380ca3d3a14SMatthew G. Knepley   PetscFunctionBegin;
381*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc2(PetscSqr(dim), &rc->R, PetscSqr(dim), &rc->RT));
382ca3d3a14SMatthew G. Knepley   switch (dim) {
383ca3d3a14SMatthew G. Knepley   case 2:
384ca3d3a14SMatthew G. Knepley     c1 = PetscCosReal(rc->alpha);s1 = PetscSinReal(rc->alpha);
385ca3d3a14SMatthew G. Knepley     rc->R[0] =  c1;rc->R[1] = s1;
386ca3d3a14SMatthew G. Knepley     rc->R[2] = -s1;rc->R[3] = c1;
387*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscArraycpy(rc->RT, rc->R, PetscSqr(dim)));
388b458e8f1SJose E. Roman     DMPlex_Transpose2D_Internal(rc->RT);
389ca3d3a14SMatthew G. Knepley     break;
390ca3d3a14SMatthew G. Knepley   case 3:
391ca3d3a14SMatthew G. Knepley     c1 = PetscCosReal(rc->alpha);s1 = PetscSinReal(rc->alpha);
392ca3d3a14SMatthew G. Knepley     c2 = PetscCosReal(rc->beta); s2 = PetscSinReal(rc->beta);
393ca3d3a14SMatthew G. Knepley     c3 = PetscCosReal(rc->gamma);s3 = PetscSinReal(rc->gamma);
394ca3d3a14SMatthew G. Knepley     rc->R[0] =  c1*c3 - c2*s1*s3;rc->R[1] =  c3*s1    + c1*c2*s3;rc->R[2] = s2*s3;
395ca3d3a14SMatthew G. Knepley     rc->R[3] = -c1*s3 - c2*c3*s1;rc->R[4] =  c1*c2*c3 - s1*s3;   rc->R[5] = c3*s2;
396ca3d3a14SMatthew G. Knepley     rc->R[6] =  s1*s2;           rc->R[7] = -c1*s2;              rc->R[8] = c2;
397*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscArraycpy(rc->RT, rc->R, PetscSqr(dim)));
398b458e8f1SJose E. Roman     DMPlex_Transpose3D_Internal(rc->RT);
399ca3d3a14SMatthew G. Knepley     break;
40098921bdaSJacob Faibussowitsch   default: SETERRQ(PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_OUTOFRANGE, "Dimension %D not supported", dim);
401ca3d3a14SMatthew G. Knepley   }
402ca3d3a14SMatthew G. Knepley   PetscFunctionReturn(0);
403ca3d3a14SMatthew G. Knepley }
404ca3d3a14SMatthew G. Knepley 
405ca3d3a14SMatthew G. Knepley static PetscErrorCode DMPlexBasisTransformDestroy_Rotation_Internal(DM dm, void *ctx)
406ca3d3a14SMatthew G. Knepley {
407ca3d3a14SMatthew G. Knepley   RotCtx        *rc = (RotCtx *) ctx;
408ca3d3a14SMatthew G. Knepley 
409ca3d3a14SMatthew G. Knepley   PetscFunctionBegin;
410*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree2(rc->R, rc->RT));
411*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree(rc));
412ca3d3a14SMatthew G. Knepley   PetscFunctionReturn(0);
413ca3d3a14SMatthew G. Knepley }
414ca3d3a14SMatthew G. Knepley 
415ca3d3a14SMatthew G. Knepley static PetscErrorCode DMPlexBasisTransformGetMatrix_Rotation_Internal(DM dm, const PetscReal x[], PetscBool l2g, const PetscScalar **A, void *ctx)
416ca3d3a14SMatthew G. Knepley {
417ca3d3a14SMatthew G. Knepley   RotCtx *rc = (RotCtx *) ctx;
418ca3d3a14SMatthew G. Knepley 
419ca3d3a14SMatthew G. Knepley   PetscFunctionBeginHot;
420ca3d3a14SMatthew G. Knepley   PetscValidPointer(ctx, 5);
421ca3d3a14SMatthew G. Knepley   if (l2g) {*A = rc->R;}
422ca3d3a14SMatthew G. Knepley   else     {*A = rc->RT;}
423ca3d3a14SMatthew G. Knepley   PetscFunctionReturn(0);
424ca3d3a14SMatthew G. Knepley }
425ca3d3a14SMatthew G. Knepley 
426ab6a9622SMatthew G. Knepley PetscErrorCode DMPlexBasisTransformApplyReal_Internal(DM dm, const PetscReal x[], PetscBool l2g, PetscInt dim, const PetscReal *y, PetscReal *z, void *ctx)
427ab6a9622SMatthew G. Knepley {
428ec277c0fSMatthew G. Knepley   PetscFunctionBegin;
429ab6a9622SMatthew G. Knepley   #if defined(PETSC_USE_COMPLEX)
430ab6a9622SMatthew G. Knepley   switch (dim) {
431ab6a9622SMatthew G. Knepley     case 2:
432ab6a9622SMatthew G. Knepley     {
43327104ee2SJacob Faibussowitsch       PetscScalar yt[2] = {y[0], y[1]}, zt[2] = {0.0,0.0};
434ab6a9622SMatthew G. Knepley 
435*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexBasisTransformApply_Internal(dm, x, l2g, dim, yt, zt, ctx));
436ab6a9622SMatthew G. Knepley       z[0] = PetscRealPart(zt[0]); z[1] = PetscRealPart(zt[1]);
437ab6a9622SMatthew G. Knepley     }
4389b4815dcSMatthew G. Knepley     break;
439ab6a9622SMatthew G. Knepley     case 3:
440ab6a9622SMatthew G. Knepley     {
44127104ee2SJacob Faibussowitsch       PetscScalar yt[3] = {y[0], y[1], y[2]}, zt[3] = {0.0,0.0,0.0};
442ab6a9622SMatthew G. Knepley 
443*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexBasisTransformApply_Internal(dm, x, l2g, dim, yt, zt, ctx));
444ab6a9622SMatthew G. Knepley       z[0] = PetscRealPart(zt[0]); z[1] = PetscRealPart(zt[1]); z[2] = PetscRealPart(zt[2]);
445ab6a9622SMatthew G. Knepley     }
4469b4815dcSMatthew G. Knepley     break;
447ab6a9622SMatthew G. Knepley   }
448ab6a9622SMatthew G. Knepley   #else
449*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexBasisTransformApply_Internal(dm, x, l2g, dim, y, z, ctx));
450ab6a9622SMatthew G. Knepley   #endif
451ec277c0fSMatthew G. Knepley   PetscFunctionReturn(0);
452ab6a9622SMatthew G. Knepley }
453ab6a9622SMatthew G. Knepley 
454ec277c0fSMatthew G. Knepley PetscErrorCode DMPlexBasisTransformApply_Internal(DM dm, const PetscReal x[], PetscBool l2g, PetscInt dim, const PetscScalar *y, PetscScalar *z, void *ctx)
455ca3d3a14SMatthew G. Knepley {
456ca3d3a14SMatthew G. Knepley   const PetscScalar *A;
457ca3d3a14SMatthew G. Knepley 
458ca3d3a14SMatthew G. Knepley   PetscFunctionBeginHot;
459*5f80ce2aSJacob Faibussowitsch   CHKERRQ((*dm->transformGetMatrix)(dm, x, l2g, &A, ctx));
460ca3d3a14SMatthew G. Knepley   switch (dim) {
4611fba962aSMatthew G. Knepley   case 2: DMPlex_Mult2D_Internal(A, 1, y, z);break;
4621fba962aSMatthew G. Knepley   case 3: DMPlex_Mult3D_Internal(A, 1, y, z);break;
463ca3d3a14SMatthew G. Knepley   }
464ca3d3a14SMatthew G. Knepley   PetscFunctionReturn(0);
465ca3d3a14SMatthew G. Knepley }
466ca3d3a14SMatthew G. Knepley 
467ca3d3a14SMatthew G. Knepley static PetscErrorCode DMPlexBasisTransformField_Internal(DM dm, DM tdm, Vec tv, PetscInt p, PetscInt f, PetscBool l2g, PetscScalar *a)
468ca3d3a14SMatthew G. Knepley {
469ca3d3a14SMatthew G. Knepley   PetscSection       ts;
470ca3d3a14SMatthew G. Knepley   const PetscScalar *ta, *tva;
471ca3d3a14SMatthew G. Knepley   PetscInt           dof;
472ca3d3a14SMatthew G. Knepley 
473ca3d3a14SMatthew G. Knepley   PetscFunctionBeginHot;
474*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(tdm, &ts));
475*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetFieldDof(ts, p, f, &dof));
476*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetArrayRead(tv, &ta));
477*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexPointLocalFieldRead(tdm, p, f, ta, &tva));
478ca3d3a14SMatthew G. Knepley   if (l2g) {
479ca3d3a14SMatthew G. Knepley     switch (dof) {
4801fba962aSMatthew G. Knepley     case 4: DMPlex_Mult2D_Internal(tva, 1, a, a);break;
4811fba962aSMatthew G. Knepley     case 9: DMPlex_Mult3D_Internal(tva, 1, a, a);break;
482ca3d3a14SMatthew G. Knepley     }
483ca3d3a14SMatthew G. Knepley   } else {
484ca3d3a14SMatthew G. Knepley     switch (dof) {
4851fba962aSMatthew G. Knepley     case 4: DMPlex_MultTranspose2D_Internal(tva, 1, a, a);break;
4861fba962aSMatthew G. Knepley     case 9: DMPlex_MultTranspose3D_Internal(tva, 1, a, a);break;
487ca3d3a14SMatthew G. Knepley     }
488ca3d3a14SMatthew G. Knepley   }
489*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecRestoreArrayRead(tv, &ta));
490ca3d3a14SMatthew G. Knepley   PetscFunctionReturn(0);
491ca3d3a14SMatthew G. Knepley }
492ca3d3a14SMatthew G. Knepley 
493ca3d3a14SMatthew G. Knepley static PetscErrorCode DMPlexBasisTransformFieldTensor_Internal(DM dm, DM tdm, Vec tv, PetscInt pf, PetscInt f, PetscInt pg, PetscInt g, PetscBool l2g, PetscInt lda, PetscScalar *a)
494ca3d3a14SMatthew G. Knepley {
495ca3d3a14SMatthew G. Knepley   PetscSection       s, ts;
496ca3d3a14SMatthew G. Knepley   const PetscScalar *ta, *tvaf, *tvag;
497ca3d3a14SMatthew G. Knepley   PetscInt           fdof, gdof, fpdof, gpdof;
498ca3d3a14SMatthew G. Knepley 
499ca3d3a14SMatthew G. Knepley   PetscFunctionBeginHot;
500*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &s));
501*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(tdm, &ts));
502*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetFieldDof(s, pf, f, &fpdof));
503*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetFieldDof(s, pg, g, &gpdof));
504*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetFieldDof(ts, pf, f, &fdof));
505*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetFieldDof(ts, pg, g, &gdof));
506*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetArrayRead(tv, &ta));
507*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexPointLocalFieldRead(tdm, pf, f, ta, &tvaf));
508*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexPointLocalFieldRead(tdm, pg, g, ta, &tvag));
509ca3d3a14SMatthew G. Knepley   if (l2g) {
510ca3d3a14SMatthew G. Knepley     switch (fdof) {
511ca3d3a14SMatthew G. Knepley     case 4: DMPlex_MatMult2D_Internal(tvaf, gpdof, lda, a, a);break;
512ca3d3a14SMatthew G. Knepley     case 9: DMPlex_MatMult3D_Internal(tvaf, gpdof, lda, a, a);break;
513ca3d3a14SMatthew G. Knepley     }
514ca3d3a14SMatthew G. Knepley     switch (gdof) {
515ca3d3a14SMatthew G. Knepley     case 4: DMPlex_MatMultTransposeLeft2D_Internal(tvag, fpdof, lda, a, a);break;
516ca3d3a14SMatthew G. Knepley     case 9: DMPlex_MatMultTransposeLeft3D_Internal(tvag, fpdof, lda, a, a);break;
517ca3d3a14SMatthew G. Knepley     }
518ca3d3a14SMatthew G. Knepley   } else {
519ca3d3a14SMatthew G. Knepley     switch (fdof) {
520ca3d3a14SMatthew G. Knepley     case 4: DMPlex_MatMultTranspose2D_Internal(tvaf, gpdof, lda, a, a);break;
521ca3d3a14SMatthew G. Knepley     case 9: DMPlex_MatMultTranspose3D_Internal(tvaf, gpdof, lda, a, a);break;
522ca3d3a14SMatthew G. Knepley     }
523ca3d3a14SMatthew G. Knepley     switch (gdof) {
524ca3d3a14SMatthew G. Knepley     case 4: DMPlex_MatMultLeft2D_Internal(tvag, fpdof, lda, a, a);break;
525ca3d3a14SMatthew G. Knepley     case 9: DMPlex_MatMultLeft3D_Internal(tvag, fpdof, lda, a, a);break;
526ca3d3a14SMatthew G. Knepley     }
527ca3d3a14SMatthew G. Knepley   }
528*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecRestoreArrayRead(tv, &ta));
529ca3d3a14SMatthew G. Knepley   PetscFunctionReturn(0);
530ca3d3a14SMatthew G. Knepley }
531ca3d3a14SMatthew G. Knepley 
532ca3d3a14SMatthew G. Knepley PetscErrorCode DMPlexBasisTransformPoint_Internal(DM dm, DM tdm, Vec tv, PetscInt p, PetscBool fieldActive[], PetscBool l2g, PetscScalar *a)
533ca3d3a14SMatthew G. Knepley {
534ca3d3a14SMatthew G. Knepley   PetscSection    s;
535ca3d3a14SMatthew G. Knepley   PetscSection    clSection;
536ca3d3a14SMatthew G. Knepley   IS              clPoints;
537ca3d3a14SMatthew G. Knepley   const PetscInt *clp;
538ca3d3a14SMatthew G. Knepley   PetscInt       *points = NULL;
539ca3d3a14SMatthew G. Knepley   PetscInt        Nf, f, Np, cp, dof, d = 0;
540ca3d3a14SMatthew G. Knepley 
541ca3d3a14SMatthew G. Knepley   PetscFunctionBegin;
542*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &s));
543*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetNumFields(s, &Nf));
544*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetCompressedClosure(dm, s, p, &Np, &points, &clSection, &clPoints, &clp));
545ca3d3a14SMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
546ca3d3a14SMatthew G. Knepley     for (cp = 0; cp < Np*2; cp += 2) {
547*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscSectionGetFieldDof(s, points[cp], f, &dof));
548ca3d3a14SMatthew G. Knepley       if (!dof) continue;
549*5f80ce2aSJacob Faibussowitsch       if (fieldActive[f]) CHKERRQ(DMPlexBasisTransformField_Internal(dm, tdm, tv, points[cp], f, l2g, &a[d]));
550ca3d3a14SMatthew G. Knepley       d += dof;
551ca3d3a14SMatthew G. Knepley     }
552ca3d3a14SMatthew G. Knepley   }
553*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexRestoreCompressedClosure(dm, s, p, &Np, &points, &clSection, &clPoints, &clp));
554ca3d3a14SMatthew G. Knepley   PetscFunctionReturn(0);
555ca3d3a14SMatthew G. Knepley }
556ca3d3a14SMatthew G. Knepley 
557ca3d3a14SMatthew G. Knepley PetscErrorCode DMPlexBasisTransformPointTensor_Internal(DM dm, DM tdm, Vec tv, PetscInt p, PetscBool l2g, PetscInt lda, PetscScalar *a)
558ca3d3a14SMatthew G. Knepley {
559ca3d3a14SMatthew G. Knepley   PetscSection    s;
560ca3d3a14SMatthew G. Knepley   PetscSection    clSection;
561ca3d3a14SMatthew G. Knepley   IS              clPoints;
562ca3d3a14SMatthew G. Knepley   const PetscInt *clp;
563ca3d3a14SMatthew G. Knepley   PetscInt       *points = NULL;
5648bdb3c71SMatthew G. Knepley   PetscInt        Nf, f, g, Np, cpf, cpg, fdof, gdof, r, c = 0;
565ca3d3a14SMatthew G. Knepley 
566ca3d3a14SMatthew G. Knepley   PetscFunctionBegin;
567*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &s));
568*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetNumFields(s, &Nf));
569*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetCompressedClosure(dm, s, p, &Np, &points, &clSection, &clPoints, &clp));
570ca3d3a14SMatthew G. Knepley   for (f = 0, r = 0; f < Nf; ++f) {
571ca3d3a14SMatthew G. Knepley     for (cpf = 0; cpf < Np*2; cpf += 2) {
572*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscSectionGetFieldDof(s, points[cpf], f, &fdof));
573ca3d3a14SMatthew G. Knepley       for (g = 0, c = 0; g < Nf; ++g) {
574ca3d3a14SMatthew G. Knepley         for (cpg = 0; cpg < Np*2; cpg += 2) {
575*5f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscSectionGetFieldDof(s, points[cpg], g, &gdof));
576*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexBasisTransformFieldTensor_Internal(dm, tdm, tv, points[cpf], f, points[cpg], g, l2g, lda, &a[r*lda+c]));
577ca3d3a14SMatthew G. Knepley           c += gdof;
578ca3d3a14SMatthew G. Knepley         }
579ca3d3a14SMatthew G. Knepley       }
580*5f80ce2aSJacob Faibussowitsch       PetscCheck(c == lda,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Invalid number of columns %D should be %D", c, lda);
581ca3d3a14SMatthew G. Knepley       r += fdof;
582ca3d3a14SMatthew G. Knepley     }
583ca3d3a14SMatthew G. Knepley   }
584*5f80ce2aSJacob Faibussowitsch   PetscCheck(r == lda,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Invalid number of rows %D should be %D", c, lda);
585*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexRestoreCompressedClosure(dm, s, p, &Np, &points, &clSection, &clPoints, &clp));
586ca3d3a14SMatthew G. Knepley   PetscFunctionReturn(0);
587ca3d3a14SMatthew G. Knepley }
588ca3d3a14SMatthew G. Knepley 
589ca3d3a14SMatthew G. Knepley static PetscErrorCode DMPlexBasisTransform_Internal(DM dm, Vec lv, PetscBool l2g)
590ca3d3a14SMatthew G. Knepley {
591ca3d3a14SMatthew G. Knepley   DM                 tdm;
592ca3d3a14SMatthew G. Knepley   Vec                tv;
593ca3d3a14SMatthew G. Knepley   PetscSection       ts, s;
594ca3d3a14SMatthew G. Knepley   const PetscScalar *ta;
595ca3d3a14SMatthew G. Knepley   PetscScalar       *a, *va;
596ca3d3a14SMatthew G. Knepley   PetscInt           pStart, pEnd, p, Nf, f;
597ca3d3a14SMatthew G. Knepley 
598ca3d3a14SMatthew G. Knepley   PetscFunctionBegin;
599*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetBasisTransformDM_Internal(dm, &tdm));
600*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetBasisTransformVec_Internal(dm, &tv));
601*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(tdm, &ts));
602*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &s));
603*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetChart(s, &pStart, &pEnd));
604*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetNumFields(s, &Nf));
605*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetArray(lv, &a));
606*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetArrayRead(tv, &ta));
607ca3d3a14SMatthew G. Knepley   for (p = pStart; p < pEnd; ++p) {
608ca3d3a14SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
609*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexPointLocalFieldRef(dm, p, f, a, &va));
610*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexBasisTransformField_Internal(dm, tdm, tv, p, f, l2g, va));
611ca3d3a14SMatthew G. Knepley     }
612ca3d3a14SMatthew G. Knepley   }
613*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecRestoreArray(lv, &a));
614*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecRestoreArrayRead(tv, &ta));
615ca3d3a14SMatthew G. Knepley   PetscFunctionReturn(0);
616ca3d3a14SMatthew G. Knepley }
617ca3d3a14SMatthew G. Knepley 
618ca3d3a14SMatthew G. Knepley /*@
619ca3d3a14SMatthew G. Knepley   DMPlexGlobalToLocalBasis - Transform the values in the given local vector from the global basis to the local basis
620ca3d3a14SMatthew G. Knepley 
621ca3d3a14SMatthew G. Knepley   Input Parameters:
622ca3d3a14SMatthew G. Knepley + dm - The DM
623ca3d3a14SMatthew G. Knepley - lv - A local vector with values in the global basis
624ca3d3a14SMatthew G. Knepley 
625ca3d3a14SMatthew G. Knepley   Output Parameters:
626ca3d3a14SMatthew G. Knepley . lv - A local vector with values in the local basis
627ca3d3a14SMatthew G. Knepley 
628c0f8e1fdSMatthew G. Knepley   Note: This method is only intended to be called inside DMGlobalToLocal(). It is unlikely that a user will have a local vector full of coefficients for the global basis unless they are reimplementing GlobalToLocal.
629c0f8e1fdSMatthew G. Knepley 
630ca3d3a14SMatthew G. Knepley   Level: developer
631ca3d3a14SMatthew G. Knepley 
632436bc73aSJed Brown .seealso: DMPlexLocalToGlobalBasis(), DMGetLocalSection(), DMPlexCreateBasisRotation()
633ca3d3a14SMatthew G. Knepley @*/
634ca3d3a14SMatthew G. Knepley PetscErrorCode DMPlexGlobalToLocalBasis(DM dm, Vec lv)
635ca3d3a14SMatthew G. Knepley {
636ca3d3a14SMatthew G. Knepley   PetscFunctionBegin;
637ca3d3a14SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
638ca3d3a14SMatthew G. Knepley   PetscValidHeaderSpecific(lv, VEC_CLASSID, 2);
639*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexBasisTransform_Internal(dm, lv, PETSC_FALSE));
640ca3d3a14SMatthew G. Knepley   PetscFunctionReturn(0);
641ca3d3a14SMatthew G. Knepley }
642ca3d3a14SMatthew G. Knepley 
643ca3d3a14SMatthew G. Knepley /*@
644ca3d3a14SMatthew G. Knepley   DMPlexLocalToGlobalBasis - Transform the values in the given local vector from the local basis to the global basis
645ca3d3a14SMatthew G. Knepley 
646ca3d3a14SMatthew G. Knepley   Input Parameters:
647ca3d3a14SMatthew G. Knepley + dm - The DM
648ca3d3a14SMatthew G. Knepley - lv - A local vector with values in the local basis
649ca3d3a14SMatthew G. Knepley 
650ca3d3a14SMatthew G. Knepley   Output Parameters:
651ca3d3a14SMatthew G. Knepley . lv - A local vector with values in the global basis
652ca3d3a14SMatthew G. Knepley 
653c0f8e1fdSMatthew G. Knepley   Note: This method is only intended to be called inside DMGlobalToLocal(). It is unlikely that a user would want a local vector full of coefficients for the global basis unless they are reimplementing GlobalToLocal.
654c0f8e1fdSMatthew G. Knepley 
655ca3d3a14SMatthew G. Knepley   Level: developer
656ca3d3a14SMatthew G. Knepley 
657436bc73aSJed Brown .seealso: DMPlexGlobalToLocalBasis(), DMGetLocalSection(), DMPlexCreateBasisRotation()
658ca3d3a14SMatthew G. Knepley @*/
659ca3d3a14SMatthew G. Knepley PetscErrorCode DMPlexLocalToGlobalBasis(DM dm, Vec lv)
660ca3d3a14SMatthew G. Knepley {
661ca3d3a14SMatthew G. Knepley   PetscFunctionBegin;
662ca3d3a14SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
663ca3d3a14SMatthew G. Knepley   PetscValidHeaderSpecific(lv, VEC_CLASSID, 2);
664*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexBasisTransform_Internal(dm, lv, PETSC_TRUE));
665ca3d3a14SMatthew G. Knepley   PetscFunctionReturn(0);
666ca3d3a14SMatthew G. Knepley }
667ca3d3a14SMatthew G. Knepley 
668ca3d3a14SMatthew G. Knepley /*@
669ca3d3a14SMatthew G. Knepley   DMPlexCreateBasisRotation - Create an internal transformation from the global basis, used to specify boundary conditions
670ca3d3a14SMatthew G. Knepley     and global solutions, to a local basis, appropriate for discretization integrals and assembly.
671ca3d3a14SMatthew G. Knepley 
672ca3d3a14SMatthew G. Knepley   Input Parameters:
673ca3d3a14SMatthew G. Knepley + dm    - The DM
674ca3d3a14SMatthew G. Knepley . alpha - The first Euler angle, and in 2D the only one
675ca3d3a14SMatthew G. Knepley . beta  - The second Euler angle
676f0fc11ceSJed Brown - gamma - The third Euler angle
677ca3d3a14SMatthew G. Knepley 
678ca3d3a14SMatthew G. Knepley   Note: Following https://en.wikipedia.org/wiki/Euler_angles, we will specify Euler angles by extrinsic rotations, meaning that
679ca3d3a14SMatthew G. Knepley   we rotate with respect to a fixed initial coordinate system, the local basis (x-y-z). The global basis (X-Y-Z) is reached as follows:
680ca3d3a14SMatthew G. Knepley   $ The XYZ system rotates about the z axis by alpha. The X axis is now at angle alpha with respect to the x axis.
681ca3d3a14SMatthew G. Knepley   $ The XYZ system rotates again about the x axis by beta. The Z axis is now at angle beta with respect to the z axis.
682ca3d3a14SMatthew G. Knepley   $ The XYZ system rotates a third time about the z axis by gamma.
683ca3d3a14SMatthew G. Knepley 
684ca3d3a14SMatthew G. Knepley   Level: developer
685ca3d3a14SMatthew G. Knepley 
686ca3d3a14SMatthew G. Knepley .seealso: DMPlexGlobalToLocalBasis(), DMPlexLocalToGlobalBasis()
687ca3d3a14SMatthew G. Knepley @*/
688ca3d3a14SMatthew G. Knepley PetscErrorCode DMPlexCreateBasisRotation(DM dm, PetscReal alpha, PetscReal beta, PetscReal gamma)
689ca3d3a14SMatthew G. Knepley {
690ca3d3a14SMatthew G. Knepley   RotCtx        *rc;
691ca3d3a14SMatthew G. Knepley   PetscInt       cdim;
692ca3d3a14SMatthew G. Knepley 
693362febeeSStefano Zampini   PetscFunctionBegin;
694*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateDim(dm, &cdim));
695*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc1(1, &rc));
696ca3d3a14SMatthew G. Knepley   dm->transformCtx       = rc;
697ca3d3a14SMatthew G. Knepley   dm->transformSetUp     = DMPlexBasisTransformSetUp_Rotation_Internal;
698ca3d3a14SMatthew G. Knepley   dm->transformDestroy   = DMPlexBasisTransformDestroy_Rotation_Internal;
699ca3d3a14SMatthew G. Knepley   dm->transformGetMatrix = DMPlexBasisTransformGetMatrix_Rotation_Internal;
700ca3d3a14SMatthew G. Knepley   rc->dim   = cdim;
701ca3d3a14SMatthew G. Knepley   rc->alpha = alpha;
702ca3d3a14SMatthew G. Knepley   rc->beta  = beta;
703ca3d3a14SMatthew G. Knepley   rc->gamma = gamma;
704*5f80ce2aSJacob Faibussowitsch   CHKERRQ((*dm->transformSetUp)(dm, dm->transformCtx));
705*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMConstructBasisTransform_Internal(dm));
706ca3d3a14SMatthew G. Knepley   PetscFunctionReturn(0);
707ca3d3a14SMatthew G. Knepley }
708ca3d3a14SMatthew G. Knepley 
709b278463cSMatthew G. Knepley /*@C
710ece3a9fcSMatthew G. Knepley   DMPlexInsertBoundaryValuesEssential - Insert boundary values into a local vector using a function of the coordinates
711b278463cSMatthew G. Knepley 
712b278463cSMatthew G. Knepley   Input Parameters:
713b278463cSMatthew G. Knepley + dm     - The DM, with a PetscDS that matches the problem being constrained
714b278463cSMatthew G. Knepley . time   - The time
715b278463cSMatthew G. Knepley . field  - The field to constrain
7161c531cf8SMatthew G. Knepley . Nc     - The number of constrained field components, or 0 for all components
7171c531cf8SMatthew G. Knepley . comps  - An array of constrained component numbers, or NULL for all components
718b278463cSMatthew G. Knepley . label  - The DMLabel defining constrained points
719b278463cSMatthew G. Knepley . numids - The number of DMLabel ids for constrained points
720b278463cSMatthew G. Knepley . ids    - An array of ids for constrained points
721b278463cSMatthew G. Knepley . func   - A pointwise function giving boundary values
722b278463cSMatthew G. Knepley - ctx    - An optional user context for bcFunc
723b278463cSMatthew G. Knepley 
724b278463cSMatthew G. Knepley   Output Parameter:
725b278463cSMatthew G. Knepley . locX   - A local vector to receives the boundary values
726b278463cSMatthew G. Knepley 
727b278463cSMatthew G. Knepley   Level: developer
728b278463cSMatthew G. Knepley 
729ece3a9fcSMatthew G. Knepley .seealso: DMPlexInsertBoundaryValuesEssentialField(), DMPlexInsertBoundaryValuesEssentialBdField(), DMAddBoundary()
730b278463cSMatthew G. Knepley @*/
7311c531cf8SMatthew G. Knepley PetscErrorCode DMPlexInsertBoundaryValuesEssential(DM dm, PetscReal time, PetscInt field, PetscInt Nc, const PetscInt comps[], DMLabel label, PetscInt numids, const PetscInt ids[], PetscErrorCode (*func)(PetscInt, PetscReal, const PetscReal[], PetscInt, PetscScalar *, void *), void *ctx, Vec locX)
73255f2e967SMatthew G. Knepley {
7330163fd50SMatthew G. Knepley   PetscErrorCode (**funcs)(PetscInt, PetscReal, const PetscReal x[], PetscInt, PetscScalar *u, void *ctx);
73455f2e967SMatthew G. Knepley   void            **ctxs;
735d7ddef95SMatthew G. Knepley   PetscInt          numFields;
736d7ddef95SMatthew G. Knepley 
737d7ddef95SMatthew G. Knepley   PetscFunctionBegin;
738*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetNumFields(dm, &numFields));
739*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscCalloc2(numFields,&funcs,numFields,&ctxs));
740d7ddef95SMatthew G. Knepley   funcs[field] = func;
741d7ddef95SMatthew G. Knepley   ctxs[field]  = ctx;
742*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMProjectFunctionLabelLocal(dm, time, label, numids, ids, Nc, comps, funcs, ctxs, INSERT_BC_VALUES, locX));
743*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree2(funcs,ctxs));
744d7ddef95SMatthew G. Knepley   PetscFunctionReturn(0);
745d7ddef95SMatthew G. Knepley }
746d7ddef95SMatthew G. Knepley 
747b278463cSMatthew G. Knepley /*@C
748ece3a9fcSMatthew G. Knepley   DMPlexInsertBoundaryValuesEssentialField - Insert boundary values into a local vector using a function of the coordinates and field data
749b278463cSMatthew G. Knepley 
750b278463cSMatthew G. Knepley   Input Parameters:
751b278463cSMatthew G. Knepley + dm     - The DM, with a PetscDS that matches the problem being constrained
752b278463cSMatthew G. Knepley . time   - The time
753b278463cSMatthew G. Knepley . locU   - A local vector with the input solution values
754b278463cSMatthew G. Knepley . field  - The field to constrain
7551c531cf8SMatthew G. Knepley . Nc     - The number of constrained field components, or 0 for all components
7561c531cf8SMatthew G. Knepley . comps  - An array of constrained component numbers, or NULL for all components
757b278463cSMatthew G. Knepley . label  - The DMLabel defining constrained points
758b278463cSMatthew G. Knepley . numids - The number of DMLabel ids for constrained points
759b278463cSMatthew G. Knepley . ids    - An array of ids for constrained points
760b278463cSMatthew G. Knepley . func   - A pointwise function giving boundary values
761b278463cSMatthew G. Knepley - ctx    - An optional user context for bcFunc
762b278463cSMatthew G. Knepley 
763b278463cSMatthew G. Knepley   Output Parameter:
764b278463cSMatthew G. Knepley . locX   - A local vector to receives the boundary values
765b278463cSMatthew G. Knepley 
766b278463cSMatthew G. Knepley   Level: developer
767b278463cSMatthew G. Knepley 
768ece3a9fcSMatthew G. Knepley .seealso: DMPlexInsertBoundaryValuesEssential(), DMPlexInsertBoundaryValuesEssentialBdField(), DMAddBoundary()
769b278463cSMatthew G. Knepley @*/
7701c531cf8SMatthew G. Knepley PetscErrorCode DMPlexInsertBoundaryValuesEssentialField(DM dm, PetscReal time, Vec locU, PetscInt field, PetscInt Nc, const PetscInt comps[], DMLabel label, PetscInt numids, const PetscInt ids[],
771c60e475cSMatthew G. Knepley                                                         void (*func)(PetscInt, PetscInt, PetscInt,
772c60e475cSMatthew G. Knepley                                                                      const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
773c60e475cSMatthew G. Knepley                                                                      const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
77497b6e6e8SMatthew G. Knepley                                                                      PetscReal, const PetscReal[], PetscInt, const PetscScalar[],
775b278463cSMatthew G. Knepley                                                                      PetscScalar[]),
776b278463cSMatthew G. Knepley                                                         void *ctx, Vec locX)
777c60e475cSMatthew G. Knepley {
778c60e475cSMatthew G. Knepley   void (**funcs)(PetscInt, PetscInt, PetscInt,
779c60e475cSMatthew G. Knepley                  const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
780c60e475cSMatthew G. Knepley                  const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
78197b6e6e8SMatthew G. Knepley                  PetscReal, const PetscReal[], PetscInt, const PetscScalar[], PetscScalar[]);
782c60e475cSMatthew G. Knepley   void            **ctxs;
783c60e475cSMatthew G. Knepley   PetscInt          numFields;
784c60e475cSMatthew G. Knepley 
785c60e475cSMatthew G. Knepley   PetscFunctionBegin;
786*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetNumFields(dm, &numFields));
787*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscCalloc2(numFields,&funcs,numFields,&ctxs));
788c60e475cSMatthew G. Knepley   funcs[field] = func;
789c60e475cSMatthew G. Knepley   ctxs[field]  = ctx;
790*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMProjectFieldLabelLocal(dm, time, label, numids, ids, Nc, comps, locU, funcs, INSERT_BC_VALUES, locX));
791*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree2(funcs,ctxs));
792c60e475cSMatthew G. Knepley   PetscFunctionReturn(0);
793c60e475cSMatthew G. Knepley }
794c60e475cSMatthew G. Knepley 
795b278463cSMatthew G. Knepley /*@C
796ece3a9fcSMatthew G. Knepley   DMPlexInsertBoundaryValuesEssentialBdField - Insert boundary values into a local vector using a function of the coodinates and boundary field data
797ece3a9fcSMatthew G. Knepley 
798ece3a9fcSMatthew G. Knepley   Collective on dm
799ece3a9fcSMatthew G. Knepley 
800ece3a9fcSMatthew G. Knepley   Input Parameters:
801ece3a9fcSMatthew G. Knepley + dm     - The DM, with a PetscDS that matches the problem being constrained
802ece3a9fcSMatthew G. Knepley . time   - The time
803ece3a9fcSMatthew G. Knepley . locU   - A local vector with the input solution values
804ece3a9fcSMatthew G. Knepley . field  - The field to constrain
805ece3a9fcSMatthew G. Knepley . Nc     - The number of constrained field components, or 0 for all components
806ece3a9fcSMatthew G. Knepley . comps  - An array of constrained component numbers, or NULL for all components
807ece3a9fcSMatthew G. Knepley . label  - The DMLabel defining constrained points
808ece3a9fcSMatthew G. Knepley . numids - The number of DMLabel ids for constrained points
809ece3a9fcSMatthew G. Knepley . ids    - An array of ids for constrained points
810ece3a9fcSMatthew G. Knepley . func   - A pointwise function giving boundary values, the calling sequence is given in DMProjectBdFieldLabelLocal()
811ece3a9fcSMatthew G. Knepley - ctx    - An optional user context for bcFunc
812ece3a9fcSMatthew G. Knepley 
813ece3a9fcSMatthew G. Knepley   Output Parameter:
814ece3a9fcSMatthew G. Knepley . locX   - A local vector to receive the boundary values
815ece3a9fcSMatthew G. Knepley 
816ece3a9fcSMatthew G. Knepley   Level: developer
817ece3a9fcSMatthew G. Knepley 
818ece3a9fcSMatthew G. Knepley .seealso: DMProjectBdFieldLabelLocal(), DMPlexInsertBoundaryValuesEssential(), DMPlexInsertBoundaryValuesEssentialField(), DMAddBoundary()
819ece3a9fcSMatthew G. Knepley @*/
820ece3a9fcSMatthew G. Knepley PetscErrorCode DMPlexInsertBoundaryValuesEssentialBdField(DM dm, PetscReal time, Vec locU, PetscInt field, PetscInt Nc, const PetscInt comps[], DMLabel label, PetscInt numids, const PetscInt ids[],
821ece3a9fcSMatthew G. Knepley                                                           void (*func)(PetscInt, PetscInt, PetscInt,
822ece3a9fcSMatthew G. Knepley                                                                        const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
823ece3a9fcSMatthew G. Knepley                                                                        const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
824ece3a9fcSMatthew G. Knepley                                                                        PetscReal, const PetscReal[], const PetscReal[], PetscInt, const PetscScalar[],
825ece3a9fcSMatthew G. Knepley                                                                        PetscScalar[]),
826ece3a9fcSMatthew G. Knepley                                                           void *ctx, Vec locX)
827ece3a9fcSMatthew G. Knepley {
828ece3a9fcSMatthew G. Knepley   void (**funcs)(PetscInt, PetscInt, PetscInt,
829ece3a9fcSMatthew G. Knepley                  const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
830ece3a9fcSMatthew G. Knepley                  const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
831ece3a9fcSMatthew G. Knepley                  PetscReal, const PetscReal[], const PetscReal[], PetscInt, const PetscScalar[], PetscScalar[]);
832ece3a9fcSMatthew G. Knepley   void            **ctxs;
833ece3a9fcSMatthew G. Knepley   PetscInt          numFields;
834ece3a9fcSMatthew G. Knepley 
835ece3a9fcSMatthew G. Knepley   PetscFunctionBegin;
836*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetNumFields(dm, &numFields));
837*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscCalloc2(numFields,&funcs,numFields,&ctxs));
838ece3a9fcSMatthew G. Knepley   funcs[field] = func;
839ece3a9fcSMatthew G. Knepley   ctxs[field]  = ctx;
840*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMProjectBdFieldLabelLocal(dm, time, label, numids, ids, Nc, comps, locU, funcs, INSERT_BC_VALUES, locX));
841*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree2(funcs,ctxs));
842ece3a9fcSMatthew G. Knepley   PetscFunctionReturn(0);
843ece3a9fcSMatthew G. Knepley }
844ece3a9fcSMatthew G. Knepley 
845ece3a9fcSMatthew G. Knepley /*@C
846b278463cSMatthew G. Knepley   DMPlexInsertBoundaryValuesRiemann - Insert boundary values into a local vector
847b278463cSMatthew G. Knepley 
848b278463cSMatthew G. Knepley   Input Parameters:
849b278463cSMatthew G. Knepley + dm     - The DM, with a PetscDS that matches the problem being constrained
850b278463cSMatthew G. Knepley . time   - The time
851b278463cSMatthew G. Knepley . faceGeometry - A vector with the FVM face geometry information
852b278463cSMatthew G. Knepley . cellGeometry - A vector with the FVM cell geometry information
853b278463cSMatthew G. Knepley . Grad         - A vector with the FVM cell gradient information
854b278463cSMatthew G. Knepley . field  - The field to constrain
8551c531cf8SMatthew G. Knepley . Nc     - The number of constrained field components, or 0 for all components
8561c531cf8SMatthew G. Knepley . comps  - An array of constrained component numbers, or NULL for all components
857b278463cSMatthew G. Knepley . label  - The DMLabel defining constrained points
858b278463cSMatthew G. Knepley . numids - The number of DMLabel ids for constrained points
859b278463cSMatthew G. Knepley . ids    - An array of ids for constrained points
860b278463cSMatthew G. Knepley . func   - A pointwise function giving boundary values
861b278463cSMatthew G. Knepley - ctx    - An optional user context for bcFunc
862b278463cSMatthew G. Knepley 
863b278463cSMatthew G. Knepley   Output Parameter:
864b278463cSMatthew G. Knepley . locX   - A local vector to receives the boundary values
865b278463cSMatthew G. Knepley 
866b278463cSMatthew G. Knepley   Note: This implementation currently ignores the numcomps/comps argument from DMAddBoundary()
867b278463cSMatthew G. Knepley 
868b278463cSMatthew G. Knepley   Level: developer
869b278463cSMatthew G. Knepley 
870b278463cSMatthew G. Knepley .seealso: DMPlexInsertBoundaryValuesEssential(), DMPlexInsertBoundaryValuesEssentialField(), DMAddBoundary()
871b278463cSMatthew G. Knepley @*/
8721c531cf8SMatthew G. Knepley PetscErrorCode DMPlexInsertBoundaryValuesRiemann(DM dm, PetscReal time, Vec faceGeometry, Vec cellGeometry, Vec Grad, PetscInt field, PetscInt Nc, const PetscInt comps[], DMLabel label, PetscInt numids, const PetscInt ids[],
873b278463cSMatthew G. Knepley                                                  PetscErrorCode (*func)(PetscReal,const PetscReal*,const PetscReal*,const PetscScalar*,PetscScalar*,void*), void *ctx, Vec locX)
874d7ddef95SMatthew G. Knepley {
87561f58d28SMatthew G. Knepley   PetscDS            prob;
876da97024aSMatthew G. Knepley   PetscSF            sf;
877d7ddef95SMatthew G. Knepley   DM                 dmFace, dmCell, dmGrad;
87820369375SToby Isaac   const PetscScalar *facegeom, *cellgeom = NULL, *grad;
879da97024aSMatthew G. Knepley   const PetscInt    *leaves;
880d7ddef95SMatthew G. Knepley   PetscScalar       *x, *fx;
881520b3818SMatthew G. Knepley   PetscInt           dim, nleaves, loc, fStart, fEnd, pdim, i;
882*5f80ce2aSJacob Faibussowitsch   PetscErrorCode     ierru = 0;
883d7ddef95SMatthew G. Knepley 
884d7ddef95SMatthew G. Knepley   PetscFunctionBegin;
885*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetPointSF(dm, &sf));
886*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSFGetGraph(sf, NULL, &nleaves, &leaves, NULL));
887da97024aSMatthew G. Knepley   nleaves = PetscMax(0, nleaves);
888*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dm, &dim));
889*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetHeightStratum(dm, 1, &fStart, &fEnd));
890*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDS(dm, &prob));
891*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetDM(faceGeometry, &dmFace));
892*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetArrayRead(faceGeometry, &facegeom));
89320369375SToby Isaac   if (cellGeometry) {
894*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetDM(cellGeometry, &dmCell));
895*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetArrayRead(cellGeometry, &cellgeom));
89620369375SToby Isaac   }
897d7ddef95SMatthew G. Knepley   if (Grad) {
898c0a6632aSMatthew G. Knepley     PetscFV fv;
899c0a6632aSMatthew G. Knepley 
900*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, field, (PetscObject *) &fv));
901*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetDM(Grad, &dmGrad));
902*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetArrayRead(Grad, &grad));
903*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFVGetNumComponents(fv, &pdim));
904*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetWorkArray(dm, pdim, MPIU_SCALAR, &fx));
905d7ddef95SMatthew G. Knepley   }
906*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetArray(locX, &x));
907d7ddef95SMatthew G. Knepley   for (i = 0; i < numids; ++i) {
908d7ddef95SMatthew G. Knepley     IS              faceIS;
909d7ddef95SMatthew G. Knepley     const PetscInt *faces;
910d7ddef95SMatthew G. Knepley     PetscInt        numFaces, f;
911d7ddef95SMatthew G. Knepley 
912*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMLabelGetStratumIS(label, ids[i], &faceIS));
913d7ddef95SMatthew G. Knepley     if (!faceIS) continue; /* No points with that id on this process */
914*5f80ce2aSJacob Faibussowitsch     CHKERRQ(ISGetLocalSize(faceIS, &numFaces));
915*5f80ce2aSJacob Faibussowitsch     CHKERRQ(ISGetIndices(faceIS, &faces));
916d7ddef95SMatthew G. Knepley     for (f = 0; f < numFaces; ++f) {
917d7ddef95SMatthew G. Knepley       const PetscInt         face = faces[f], *cells;
918640bce14SSatish Balay       PetscFVFaceGeom        *fg;
919d7ddef95SMatthew G. Knepley 
920d7ddef95SMatthew G. Knepley       if ((face < fStart) || (face >= fEnd)) continue; /* Refinement adds non-faces to labels */
921*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFindInt(face, nleaves, (PetscInt *) leaves, &loc));
922da97024aSMatthew G. Knepley       if (loc >= 0) continue;
923*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexPointLocalRead(dmFace, face, facegeom, &fg));
924*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetSupport(dm, face, &cells));
925d7ddef95SMatthew G. Knepley       if (Grad) {
926640bce14SSatish Balay         PetscFVCellGeom       *cg;
927640bce14SSatish Balay         PetscScalar           *cx, *cgrad;
928d7ddef95SMatthew G. Knepley         PetscScalar           *xG;
929d7ddef95SMatthew G. Knepley         PetscReal              dx[3];
930d7ddef95SMatthew G. Knepley         PetscInt               d;
931d7ddef95SMatthew G. Knepley 
932*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexPointLocalRead(dmCell, cells[0], cellgeom, &cg));
933*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexPointLocalRead(dm, cells[0], x, &cx));
934*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexPointLocalRead(dmGrad, cells[0], grad, &cgrad));
935*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexPointLocalFieldRef(dm, cells[1], field, x, &xG));
936d7ddef95SMatthew G. Knepley         DMPlex_WaxpyD_Internal(dim, -1, cg->centroid, fg->centroid, dx);
937d7ddef95SMatthew G. Knepley         for (d = 0; d < pdim; ++d) fx[d] = cx[d] + DMPlex_DotD_Internal(dim, &cgrad[d*dim], dx);
938*5f80ce2aSJacob Faibussowitsch         CHKERRQ((*func)(time, fg->centroid, fg->normal, fx, xG, ctx));
939d7ddef95SMatthew G. Knepley       } else {
940640bce14SSatish Balay         PetscScalar *xI;
941d7ddef95SMatthew G. Knepley         PetscScalar *xG;
942d7ddef95SMatthew G. Knepley 
943*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexPointLocalRead(dm, cells[0], x, &xI));
944*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexPointLocalFieldRef(dm, cells[1], field, x, &xG));
945e735a8a9SMatthew G. Knepley         ierru = (*func)(time, fg->centroid, fg->normal, xI, xG, ctx);
946e735a8a9SMatthew G. Knepley         if (ierru) {
947*5f80ce2aSJacob Faibussowitsch           CHKERRQ(ISRestoreIndices(faceIS, &faces));
948*5f80ce2aSJacob Faibussowitsch           CHKERRQ(ISDestroy(&faceIS));
949e735a8a9SMatthew G. Knepley           goto cleanup;
950e735a8a9SMatthew G. Knepley         }
951d7ddef95SMatthew G. Knepley       }
952d7ddef95SMatthew G. Knepley     }
953*5f80ce2aSJacob Faibussowitsch     CHKERRQ(ISRestoreIndices(faceIS, &faces));
954*5f80ce2aSJacob Faibussowitsch     CHKERRQ(ISDestroy(&faceIS));
955d7ddef95SMatthew G. Knepley   }
956e735a8a9SMatthew G. Knepley   cleanup:
957*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecRestoreArray(locX, &x));
958d7ddef95SMatthew G. Knepley   if (Grad) {
959*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMRestoreWorkArray(dm, pdim, MPIU_SCALAR, &fx));
960*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecRestoreArrayRead(Grad, &grad));
961d7ddef95SMatthew G. Knepley   }
962*5f80ce2aSJacob Faibussowitsch   if (cellGeometry) CHKERRQ(VecRestoreArrayRead(cellGeometry, &cellgeom));
963*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecRestoreArrayRead(faceGeometry, &facegeom));
964e735a8a9SMatthew G. Knepley   CHKERRQ(ierru);
965d7ddef95SMatthew G. Knepley   PetscFunctionReturn(0);
966d7ddef95SMatthew G. Knepley }
967d7ddef95SMatthew G. Knepley 
9680c364540SMatthew G. Knepley static PetscErrorCode zero(PetscInt dim, PetscReal time, const PetscReal x[], PetscInt Nc, PetscScalar *u, void *ctx)
9690c364540SMatthew G. Knepley {
9700c364540SMatthew G. Knepley   PetscInt c;
9710c364540SMatthew G. Knepley   for (c = 0; c < Nc; ++c) u[c] = 0.0;
9720c364540SMatthew G. Knepley   return 0;
9730c364540SMatthew G. Knepley }
9740c364540SMatthew G. Knepley 
975f1d73a7aSMatthew G. Knepley PetscErrorCode DMPlexInsertBoundaryValues_Plex(DM dm, PetscBool insertEssential, Vec locX, PetscReal time, Vec faceGeomFVM, Vec cellGeomFVM, Vec gradFVM)
976d7ddef95SMatthew G. Knepley {
9770c364540SMatthew G. Knepley   PetscObject    isZero;
978e5e52638SMatthew G. Knepley   PetscDS        prob;
979d7ddef95SMatthew G. Knepley   PetscInt       numBd, b;
98055f2e967SMatthew G. Knepley 
98155f2e967SMatthew G. Knepley   PetscFunctionBegin;
982*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDS(dm, &prob));
983*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetNumBoundary(prob, &numBd));
984*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscObjectQuery((PetscObject) locX, "__Vec_bc_zero__", &isZero));
98555f2e967SMatthew G. Knepley   for (b = 0; b < numBd; ++b) {
98645480ffeSMatthew G. Knepley     PetscWeakForm           wf;
987f971fd6bSMatthew G. Knepley     DMBoundaryConditionType type;
98845480ffeSMatthew G. Knepley     const char             *name;
989d7ddef95SMatthew G. Knepley     DMLabel                 label;
9901c531cf8SMatthew G. Knepley     PetscInt                field, Nc;
9911c531cf8SMatthew G. Knepley     const PetscInt         *comps;
992d7ddef95SMatthew G. Knepley     PetscObject             obj;
993d7ddef95SMatthew G. Knepley     PetscClassId            id;
99445480ffeSMatthew G. Knepley     void                  (*bvfunc)(void);
995d7ddef95SMatthew G. Knepley     PetscInt                numids;
996d7ddef95SMatthew G. Knepley     const PetscInt         *ids;
99755f2e967SMatthew G. Knepley     void                   *ctx;
99855f2e967SMatthew G. Knepley 
999*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetBoundary(prob, b, &wf, &type, &name, &label, &numids, &ids, &field, &Nc, &comps, &bvfunc, NULL, &ctx));
1000f971fd6bSMatthew G. Knepley     if (insertEssential != (type & DM_BC_ESSENTIAL)) continue;
1001*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetField(dm, field, NULL, &obj));
1002*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
1003d7ddef95SMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
1004c60e475cSMatthew G. Knepley       switch (type) {
1005c60e475cSMatthew G. Knepley         /* for FEM, there is no insertion to be done for non-essential boundary conditions */
1006c60e475cSMatthew G. Knepley       case DM_BC_ESSENTIAL:
100745480ffeSMatthew G. Knepley         {
100845480ffeSMatthew G. Knepley           PetscSimplePointFunc func = (PetscSimplePointFunc) bvfunc;
100945480ffeSMatthew G. Knepley 
101045480ffeSMatthew G. Knepley           if (isZero) func = zero;
1011*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexLabelAddCells(dm,label));
1012*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexInsertBoundaryValuesEssential(dm, time, field, Nc, comps, label, numids, ids, func, ctx, locX));
1013*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexLabelClearCells(dm,label));
101445480ffeSMatthew G. Knepley         }
1015c60e475cSMatthew G. Knepley         break;
1016c60e475cSMatthew G. Knepley       case DM_BC_ESSENTIAL_FIELD:
101745480ffeSMatthew G. Knepley         {
101845480ffeSMatthew G. Knepley           PetscPointFunc func = (PetscPointFunc) bvfunc;
101945480ffeSMatthew G. Knepley 
1020*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexLabelAddCells(dm,label));
1021*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexInsertBoundaryValuesEssentialField(dm, time, locX, field, Nc, comps, label, numids, ids, func, ctx, locX));
1022*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexLabelClearCells(dm,label));
102345480ffeSMatthew G. Knepley         }
1024c60e475cSMatthew G. Knepley         break;
1025c60e475cSMatthew G. Knepley       default: break;
1026c60e475cSMatthew G. Knepley       }
1027d7ddef95SMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
102845480ffeSMatthew G. Knepley       {
102945480ffeSMatthew G. Knepley         PetscErrorCode (*func)(PetscReal,const PetscReal*,const PetscReal*,const PetscScalar*,PetscScalar*,void*) = (PetscErrorCode (*)(PetscReal,const PetscReal*,const PetscReal*,const PetscScalar*,PetscScalar*,void*)) bvfunc;
103045480ffeSMatthew G. Knepley 
103143ea7facSMatthew G. Knepley         if (!faceGeomFVM) continue;
1032*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexInsertBoundaryValuesRiemann(dm, time, faceGeomFVM, cellGeomFVM, gradFVM, field, Nc, comps, label, numids, ids, func, ctx, locX));
103345480ffeSMatthew G. Knepley       }
103498921bdaSJacob Faibussowitsch     } else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", field);
103555f2e967SMatthew G. Knepley   }
103655f2e967SMatthew G. Knepley   PetscFunctionReturn(0);
103755f2e967SMatthew G. Knepley }
103855f2e967SMatthew G. Knepley 
103956cf3b9cSMatthew G. Knepley PetscErrorCode DMPlexInsertTimeDerivativeBoundaryValues_Plex(DM dm, PetscBool insertEssential, Vec locX, PetscReal time, Vec faceGeomFVM, Vec cellGeomFVM, Vec gradFVM)
104056cf3b9cSMatthew G. Knepley {
104156cf3b9cSMatthew G. Knepley   PetscObject    isZero;
104256cf3b9cSMatthew G. Knepley   PetscDS        prob;
104356cf3b9cSMatthew G. Knepley   PetscInt       numBd, b;
104456cf3b9cSMatthew G. Knepley 
104556cf3b9cSMatthew G. Knepley   PetscFunctionBegin;
104656cf3b9cSMatthew G. Knepley   if (!locX) PetscFunctionReturn(0);
1047*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDS(dm, &prob));
1048*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetNumBoundary(prob, &numBd));
1049*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscObjectQuery((PetscObject) locX, "__Vec_bc_zero__", &isZero));
105056cf3b9cSMatthew G. Knepley   for (b = 0; b < numBd; ++b) {
105145480ffeSMatthew G. Knepley     PetscWeakForm           wf;
105256cf3b9cSMatthew G. Knepley     DMBoundaryConditionType type;
105345480ffeSMatthew G. Knepley     const char             *name;
105456cf3b9cSMatthew G. Knepley     DMLabel                 label;
105556cf3b9cSMatthew G. Knepley     PetscInt                field, Nc;
105656cf3b9cSMatthew G. Knepley     const PetscInt         *comps;
105756cf3b9cSMatthew G. Knepley     PetscObject             obj;
105856cf3b9cSMatthew G. Knepley     PetscClassId            id;
105956cf3b9cSMatthew G. Knepley     PetscInt                numids;
106056cf3b9cSMatthew G. Knepley     const PetscInt         *ids;
106145480ffeSMatthew G. Knepley     void                  (*bvfunc)(void);
106256cf3b9cSMatthew G. Knepley     void                   *ctx;
106356cf3b9cSMatthew G. Knepley 
1064*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetBoundary(prob, b, &wf, &type, &name, &label, &numids, &ids, &field, &Nc, &comps, NULL, &bvfunc, &ctx));
106556cf3b9cSMatthew G. Knepley     if (insertEssential != (type & DM_BC_ESSENTIAL)) continue;
1066*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetField(dm, field, NULL, &obj));
1067*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
106856cf3b9cSMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
106956cf3b9cSMatthew G. Knepley       switch (type) {
107056cf3b9cSMatthew G. Knepley         /* for FEM, there is no insertion to be done for non-essential boundary conditions */
107156cf3b9cSMatthew G. Knepley       case DM_BC_ESSENTIAL:
107245480ffeSMatthew G. Knepley         {
107345480ffeSMatthew G. Knepley           PetscSimplePointFunc func_t = (PetscSimplePointFunc) bvfunc;
107445480ffeSMatthew G. Knepley 
107545480ffeSMatthew G. Knepley           if (isZero) func_t = zero;
1076*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexLabelAddCells(dm,label));
1077*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexInsertBoundaryValuesEssential(dm, time, field, Nc, comps, label, numids, ids, func_t, ctx, locX));
1078*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexLabelClearCells(dm,label));
107945480ffeSMatthew G. Knepley         }
108056cf3b9cSMatthew G. Knepley         break;
108156cf3b9cSMatthew G. Knepley       case DM_BC_ESSENTIAL_FIELD:
108245480ffeSMatthew G. Knepley         {
108345480ffeSMatthew G. Knepley           PetscPointFunc func_t = (PetscPointFunc) bvfunc;
108445480ffeSMatthew G. Knepley 
1085*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexLabelAddCells(dm,label));
1086*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexInsertBoundaryValuesEssentialField(dm, time, locX, field, Nc, comps, label, numids, ids, func_t, ctx, locX));
1087*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexLabelClearCells(dm,label));
108845480ffeSMatthew G. Knepley         }
108956cf3b9cSMatthew G. Knepley         break;
109056cf3b9cSMatthew G. Knepley       default: break;
109156cf3b9cSMatthew G. Knepley       }
109298921bdaSJacob Faibussowitsch     } else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", field);
109356cf3b9cSMatthew G. Knepley   }
109456cf3b9cSMatthew G. Knepley   PetscFunctionReturn(0);
109556cf3b9cSMatthew G. Knepley }
109656cf3b9cSMatthew G. Knepley 
1097f1d73a7aSMatthew G. Knepley /*@
1098f1d73a7aSMatthew G. Knepley   DMPlexInsertBoundaryValues - Puts coefficients which represent boundary values into the local solution vector
1099f1d73a7aSMatthew G. Knepley 
1100ed808b8fSJed Brown   Not Collective
1101ed808b8fSJed Brown 
1102f1d73a7aSMatthew G. Knepley   Input Parameters:
1103f1d73a7aSMatthew G. Knepley + dm - The DM
1104f1d73a7aSMatthew G. Knepley . insertEssential - Should I insert essential (e.g. Dirichlet) or inessential (e.g. Neumann) boundary conditions
1105f1d73a7aSMatthew G. Knepley . time - The time
1106f1d73a7aSMatthew G. Knepley . faceGeomFVM - Face geometry data for FV discretizations
1107f1d73a7aSMatthew G. Knepley . cellGeomFVM - Cell geometry data for FV discretizations
1108f1d73a7aSMatthew G. Knepley - gradFVM - Gradient reconstruction data for FV discretizations
1109f1d73a7aSMatthew G. Knepley 
1110f1d73a7aSMatthew G. Knepley   Output Parameters:
1111f1d73a7aSMatthew G. Knepley . locX - Solution updated with boundary values
1112f1d73a7aSMatthew G. Knepley 
1113ed808b8fSJed Brown   Level: intermediate
1114f1d73a7aSMatthew G. Knepley 
1115ed808b8fSJed Brown .seealso: DMProjectFunctionLabelLocal(), DMAddBoundary()
1116f1d73a7aSMatthew G. Knepley @*/
1117f1d73a7aSMatthew G. Knepley PetscErrorCode DMPlexInsertBoundaryValues(DM dm, PetscBool insertEssential, Vec locX, PetscReal time, Vec faceGeomFVM, Vec cellGeomFVM, Vec gradFVM)
1118f1d73a7aSMatthew G. Knepley {
1119f1d73a7aSMatthew G. Knepley   PetscFunctionBegin;
1120f1d73a7aSMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
1121064a246eSJacob Faibussowitsch   PetscValidHeaderSpecific(locX, VEC_CLASSID, 3);
1122064a246eSJacob Faibussowitsch   if (faceGeomFVM) {PetscValidHeaderSpecific(faceGeomFVM, VEC_CLASSID, 5);}
1123064a246eSJacob Faibussowitsch   if (cellGeomFVM) {PetscValidHeaderSpecific(cellGeomFVM, VEC_CLASSID, 6);}
1124064a246eSJacob Faibussowitsch   if (gradFVM)     {PetscValidHeaderSpecific(gradFVM, VEC_CLASSID, 7);}
1125*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscTryMethod(dm,"DMPlexInsertBoundaryValues_C",(DM,PetscBool,Vec,PetscReal,Vec,Vec,Vec),(dm,insertEssential,locX,time,faceGeomFVM,cellGeomFVM,gradFVM)));
1126f1d73a7aSMatthew G. Knepley   PetscFunctionReturn(0);
1127f1d73a7aSMatthew G. Knepley }
1128f1d73a7aSMatthew G. Knepley 
112956cf3b9cSMatthew G. Knepley /*@
1130a5b23f4aSJose E. Roman   DMPlexInsertTimeDerivativeBoundaryValues - Puts coefficients which represent boundary values of the time derivative into the local solution vector
113156cf3b9cSMatthew G. Knepley 
113256cf3b9cSMatthew G. Knepley   Input Parameters:
113356cf3b9cSMatthew G. Knepley + dm - The DM
113456cf3b9cSMatthew G. Knepley . insertEssential - Should I insert essential (e.g. Dirichlet) or inessential (e.g. Neumann) boundary conditions
113556cf3b9cSMatthew G. Knepley . time - The time
113656cf3b9cSMatthew G. Knepley . faceGeomFVM - Face geometry data for FV discretizations
113756cf3b9cSMatthew G. Knepley . cellGeomFVM - Cell geometry data for FV discretizations
113856cf3b9cSMatthew G. Knepley - gradFVM - Gradient reconstruction data for FV discretizations
113956cf3b9cSMatthew G. Knepley 
114056cf3b9cSMatthew G. Knepley   Output Parameters:
114156cf3b9cSMatthew G. Knepley . locX_t - Solution updated with boundary values
114256cf3b9cSMatthew G. Knepley 
114356cf3b9cSMatthew G. Knepley   Level: developer
114456cf3b9cSMatthew G. Knepley 
114556cf3b9cSMatthew G. Knepley .seealso: DMProjectFunctionLabelLocal()
114656cf3b9cSMatthew G. Knepley @*/
114756cf3b9cSMatthew G. Knepley PetscErrorCode DMPlexInsertTimeDerivativeBoundaryValues(DM dm, PetscBool insertEssential, Vec locX_t, PetscReal time, Vec faceGeomFVM, Vec cellGeomFVM, Vec gradFVM)
114856cf3b9cSMatthew G. Knepley {
114956cf3b9cSMatthew G. Knepley   PetscFunctionBegin;
115056cf3b9cSMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
1151064a246eSJacob Faibussowitsch   if (locX_t)      {PetscValidHeaderSpecific(locX_t, VEC_CLASSID, 3);}
1152064a246eSJacob Faibussowitsch   if (faceGeomFVM) {PetscValidHeaderSpecific(faceGeomFVM, VEC_CLASSID, 5);}
1153064a246eSJacob Faibussowitsch   if (cellGeomFVM) {PetscValidHeaderSpecific(cellGeomFVM, VEC_CLASSID, 6);}
1154064a246eSJacob Faibussowitsch   if (gradFVM)     {PetscValidHeaderSpecific(gradFVM, VEC_CLASSID, 7);}
1155*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscTryMethod(dm,"DMPlexInsertTimeDerviativeBoundaryValues_C",(DM,PetscBool,Vec,PetscReal,Vec,Vec,Vec),(dm,insertEssential,locX_t,time,faceGeomFVM,cellGeomFVM,gradFVM)));
115656cf3b9cSMatthew G. Knepley   PetscFunctionReturn(0);
115756cf3b9cSMatthew G. Knepley }
115856cf3b9cSMatthew G. Knepley 
11590709b2feSToby Isaac PetscErrorCode DMComputeL2Diff_Plex(DM dm, PetscReal time, PetscErrorCode (**funcs)(PetscInt, PetscReal, const PetscReal [], PetscInt, PetscScalar *, void *), void **ctxs, Vec X, PetscReal *diff)
1160cb1e1211SMatthew G Knepley {
1161574a98acSMatthew G. Knepley   Vec              localX;
1162574a98acSMatthew G. Knepley 
1163574a98acSMatthew G. Knepley   PetscFunctionBegin;
1164*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalVector(dm, &localX));
1165*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexInsertBoundaryValues(dm, PETSC_TRUE, localX, time, NULL, NULL, NULL));
1166*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGlobalToLocalBegin(dm, X, INSERT_VALUES, localX));
1167*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGlobalToLocalEnd(dm, X, INSERT_VALUES, localX));
1168*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexComputeL2DiffLocal(dm, time, funcs, ctxs, localX, diff));
1169*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreLocalVector(dm, &localX));
1170574a98acSMatthew G. Knepley   PetscFunctionReturn(0);
1171574a98acSMatthew G. Knepley }
1172574a98acSMatthew G. Knepley 
1173574a98acSMatthew G. Knepley /*@C
1174ca3d3a14SMatthew G. Knepley   DMComputeL2DiffLocal - This function computes the L_2 difference between a function u and an FEM interpolant solution u_h.
1175574a98acSMatthew G. Knepley 
1176d083f849SBarry Smith   Collective on dm
1177c0f8e1fdSMatthew G. Knepley 
1178574a98acSMatthew G. Knepley   Input Parameters:
1179574a98acSMatthew G. Knepley + dm     - The DM
1180574a98acSMatthew G. Knepley . time   - The time
1181574a98acSMatthew G. Knepley . funcs  - The functions to evaluate for each field component
1182574a98acSMatthew G. Knepley . ctxs   - Optional array of contexts to pass to each function, or NULL.
1183574a98acSMatthew G. Knepley - localX - The coefficient vector u_h, a local vector
1184574a98acSMatthew G. Knepley 
1185574a98acSMatthew G. Knepley   Output Parameter:
1186574a98acSMatthew G. Knepley . diff - The diff ||u - u_h||_2
1187574a98acSMatthew G. Knepley 
1188574a98acSMatthew G. Knepley   Level: developer
1189574a98acSMatthew G. Knepley 
1190574a98acSMatthew G. Knepley .seealso: DMProjectFunction(), DMComputeL2FieldDiff(), DMComputeL2GradientDiff()
1191574a98acSMatthew G. Knepley @*/
1192574a98acSMatthew G. Knepley PetscErrorCode DMPlexComputeL2DiffLocal(DM dm, PetscReal time, PetscErrorCode (**funcs)(PetscInt, PetscReal, const PetscReal [], PetscInt, PetscScalar *, void *), void **ctxs, Vec localX, PetscReal *diff)
1193574a98acSMatthew G. Knepley {
11940f09c10fSMatthew G. Knepley   const PetscInt   debug = ((DM_Plex*)dm->data)->printL2;
1195ca3d3a14SMatthew G. Knepley   DM               tdm;
1196ca3d3a14SMatthew G. Knepley   Vec              tv;
1197cb1e1211SMatthew G Knepley   PetscSection     section;
1198c5bbbd5bSMatthew G. Knepley   PetscQuadrature  quad;
11994bee2e38SMatthew G. Knepley   PetscFEGeom      fegeom;
120015496722SMatthew G. Knepley   PetscScalar     *funcVal, *interpolant;
12014bee2e38SMatthew G. Knepley   PetscReal       *coords, *gcoords;
1202cb1e1211SMatthew G Knepley   PetscReal        localDiff = 0.0;
12037318780aSToby Isaac   const PetscReal *quadWeights;
1204412e9a14SMatthew G. Knepley   PetscInt         dim, coordDim, numFields, numComponents = 0, qNc, Nq, cellHeight, cStart, cEnd, c, field, fieldOffset;
1205ca3d3a14SMatthew G. Knepley   PetscBool        transform;
1206cb1e1211SMatthew G Knepley   PetscErrorCode   ierr;
1207cb1e1211SMatthew G Knepley 
1208cb1e1211SMatthew G Knepley   PetscFunctionBegin;
1209*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dm, &dim));
1210*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateDim(dm, &coordDim));
12112a4e142eSMatthew G. Knepley   fegeom.dimEmbed = coordDim;
1212*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &section));
1213*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetNumFields(section, &numFields));
1214*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetBasisTransformDM_Internal(dm, &tdm));
1215*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetBasisTransformVec_Internal(dm, &tv));
1216*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMHasBasisTransform(dm, &transform));
1217cb1e1211SMatthew G Knepley   for (field = 0; field < numFields; ++field) {
121815496722SMatthew G. Knepley     PetscObject  obj;
121915496722SMatthew G. Knepley     PetscClassId id;
1220c5bbbd5bSMatthew G. Knepley     PetscInt     Nc;
1221c5bbbd5bSMatthew G. Knepley 
1222*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetField(dm, field, NULL, &obj));
1223*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
122415496722SMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
122515496722SMatthew G. Knepley       PetscFE fe = (PetscFE) obj;
122615496722SMatthew G. Knepley 
1227*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetQuadrature(fe, &quad));
1228*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetNumComponents(fe, &Nc));
122915496722SMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
123015496722SMatthew G. Knepley       PetscFV fv = (PetscFV) obj;
123115496722SMatthew G. Knepley 
1232*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetQuadrature(fv, &quad));
1233*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetNumComponents(fv, &Nc));
123498921bdaSJacob Faibussowitsch     } else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", field);
1235c5bbbd5bSMatthew G. Knepley     numComponents += Nc;
1236cb1e1211SMatthew G Knepley   }
1237*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscQuadratureGetData(quad, NULL, &qNc, &Nq, NULL, &quadWeights));
12382c71b3e2SJacob Faibussowitsch   PetscCheckFalse((qNc != 1) && (qNc != numComponents),PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_SIZ, "Quadrature components %D != %D field components", qNc, numComponents);
1239*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc6(numComponents,&funcVal,numComponents,&interpolant,coordDim*Nq,&coords,Nq,&fegeom.detJ,coordDim*coordDim*Nq,&fegeom.J,coordDim*coordDim*Nq,&fegeom.invJ));
1240*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetVTKCellHeight(dm, &cellHeight));
1241*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetSimplexOrBoxCells(dm, cellHeight, &cStart, &cEnd));
1242cb1e1211SMatthew G Knepley   for (c = cStart; c < cEnd; ++c) {
1243a1e44745SMatthew G. Knepley     PetscScalar *x = NULL;
1244cb1e1211SMatthew G Knepley     PetscReal    elemDiff = 0.0;
12459c3cf19fSMatthew G. Knepley     PetscInt     qc = 0;
1246cb1e1211SMatthew G Knepley 
1247*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexComputeCellGeometryFEM(dm, c, quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
1248*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecGetClosure(dm, NULL, localX, c, NULL, &x));
1249cb1e1211SMatthew G Knepley 
125015496722SMatthew G. Knepley     for (field = 0, fieldOffset = 0; field < numFields; ++field) {
125115496722SMatthew G. Knepley       PetscObject  obj;
125215496722SMatthew G. Knepley       PetscClassId id;
1253c110b1eeSGeoffrey Irving       void * const ctx = ctxs ? ctxs[field] : NULL;
125415496722SMatthew G. Knepley       PetscInt     Nb, Nc, q, fc;
1255cb1e1211SMatthew G Knepley 
1256*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMGetField(dm, field, NULL, &obj));
1257*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscObjectGetClassId(obj, &id));
1258*5f80ce2aSJacob Faibussowitsch       if (id == PETSCFE_CLASSID)      {CHKERRQ(PetscFEGetNumComponents((PetscFE) obj, &Nc));CHKERRQ(PetscFEGetDimension((PetscFE) obj, &Nb));}
1259*5f80ce2aSJacob Faibussowitsch       else if (id == PETSCFV_CLASSID) {CHKERRQ(PetscFVGetNumComponents((PetscFV) obj, &Nc));Nb = 1;}
126098921bdaSJacob Faibussowitsch       else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", field);
1261cb1e1211SMatthew G Knepley       if (debug) {
1262cb1e1211SMatthew G Knepley         char title[1024];
1263*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscSNPrintf(title, 1023, "Solution for Field %D", field));
1264*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPrintCellVector(c, title, Nb, &x[fieldOffset]));
1265cb1e1211SMatthew G Knepley       }
12667318780aSToby Isaac       for (q = 0; q < Nq; ++q) {
12672a4e142eSMatthew G. Knepley         PetscFEGeom qgeom;
12682a4e142eSMatthew G. Knepley 
12692a4e142eSMatthew G. Knepley         qgeom.dimEmbed = fegeom.dimEmbed;
12702a4e142eSMatthew G. Knepley         qgeom.J        = &fegeom.J[q*coordDim*coordDim];
12712a4e142eSMatthew G. Knepley         qgeom.invJ     = &fegeom.invJ[q*coordDim*coordDim];
12722a4e142eSMatthew G. Knepley         qgeom.detJ     = &fegeom.detJ[q];
1273*5f80ce2aSJacob Faibussowitsch         PetscCheck(fegeom.detJ[q] > 0.0,PETSC_COMM_SELF, PETSC_ERR_ARG_OUTOFRANGE, "Invalid determinant %g for element %D, point %D", (double)fegeom.detJ[q], c, q);
1274d3a7d86cSMatthew G. Knepley         if (transform) {
1275d3a7d86cSMatthew G. Knepley           gcoords = &coords[coordDim*Nq];
1276*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexBasisTransformApplyReal_Internal(dm, &coords[coordDim*q], PETSC_TRUE, coordDim, &coords[coordDim*q], gcoords, dm->transformCtx));
1277d3a7d86cSMatthew G. Knepley         } else {
1278d3a7d86cSMatthew G. Knepley           gcoords = &coords[coordDim*q];
1279d3a7d86cSMatthew G. Knepley         }
1280*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscArrayzero(funcVal,Nc));
1281ca3d3a14SMatthew G. Knepley         ierr = (*funcs[field])(coordDim, time, gcoords, Nc, funcVal, ctx);
1282e735a8a9SMatthew G. Knepley         if (ierr) {
1283*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexVecRestoreClosure(dm, NULL, localX, c, NULL, &x));
1284*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMRestoreLocalVector(dm, &localX));
1285*5f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFree6(funcVal,interpolant,coords,fegeom.detJ,fegeom.J,fegeom.invJ));
1286e735a8a9SMatthew G. Knepley           CHKERRQ(ierr);
1287e735a8a9SMatthew G. Knepley         }
1288*5f80ce2aSJacob Faibussowitsch         if (transform) CHKERRQ(DMPlexBasisTransformApply_Internal(dm, &coords[coordDim*q], PETSC_FALSE, Nc, funcVal, funcVal, dm->transformCtx));
1289*5f80ce2aSJacob Faibussowitsch         if (id == PETSCFE_CLASSID)      CHKERRQ(PetscFEInterpolate_Static((PetscFE) obj, &x[fieldOffset], &qgeom, q, interpolant));
1290*5f80ce2aSJacob Faibussowitsch         else if (id == PETSCFV_CLASSID) CHKERRQ(PetscFVInterpolate_Static((PetscFV) obj, &x[fieldOffset], q, interpolant));
12912df84da0SMatthew G. Knepley         else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, field);
129215496722SMatthew G. Knepley         for (fc = 0; fc < Nc; ++fc) {
1293beaa55a6SMatthew G. Knepley           const PetscReal wt = quadWeights[q*qNc+(qNc == 1 ? 0 : qc+fc)];
1294*5f80ce2aSJacob Faibussowitsch           if (debug) CHKERRQ(PetscPrintf(PETSC_COMM_SELF, "    elem %" PetscInt_FMT " field %" PetscInt_FMT ",%" PetscInt_FMT " point %g %g %g diff %g (%g, %g)\n", c, field, fc, (double)(coordDim > 0 ? coords[coordDim*q] : 0.), (double)(coordDim > 1 ? coords[coordDim*q+1] : 0.),(double)(coordDim > 2 ? coords[coordDim*q+2] : 0.), (double)(PetscSqr(PetscRealPart(interpolant[fc] - funcVal[fc]))*wt*fegeom.detJ[q]), PetscRealPart(interpolant[fc]), PetscRealPart(funcVal[fc])));
12954bee2e38SMatthew G. Knepley           elemDiff += PetscSqr(PetscRealPart(interpolant[fc] - funcVal[fc]))*wt*fegeom.detJ[q];
1296cb1e1211SMatthew G Knepley         }
1297cb1e1211SMatthew G Knepley       }
12989c3cf19fSMatthew G. Knepley       fieldOffset += Nb;
1299beaa55a6SMatthew G. Knepley       qc += Nc;
1300cb1e1211SMatthew G Knepley     }
1301*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecRestoreClosure(dm, NULL, localX, c, NULL, &x));
1302*5f80ce2aSJacob Faibussowitsch     if (debug) CHKERRQ(PetscPrintf(PETSC_COMM_SELF, "  elem %" PetscInt_FMT " diff %g\n", c, (double)elemDiff));
1303cb1e1211SMatthew G Knepley     localDiff += elemDiff;
1304cb1e1211SMatthew G Knepley   }
1305*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree6(funcVal,interpolant,coords,fegeom.detJ,fegeom.J,fegeom.invJ));
1306*5f80ce2aSJacob Faibussowitsch   CHKERRMPI(MPIU_Allreduce(&localDiff, diff, 1, MPIU_REAL, MPIU_SUM, PetscObjectComm((PetscObject)dm)));
1307cb1e1211SMatthew G Knepley   *diff = PetscSqrtReal(*diff);
1308cb1e1211SMatthew G Knepley   PetscFunctionReturn(0);
1309cb1e1211SMatthew G Knepley }
1310cb1e1211SMatthew G Knepley 
1311b698f381SToby Isaac PetscErrorCode DMComputeL2GradientDiff_Plex(DM dm, PetscReal time, PetscErrorCode (**funcs)(PetscInt, PetscReal, const PetscReal [], const PetscReal [], PetscInt, PetscScalar *, void *), void **ctxs, Vec X, const PetscReal n[], PetscReal *diff)
1312cb1e1211SMatthew G Knepley {
13130f09c10fSMatthew G. Knepley   const PetscInt   debug = ((DM_Plex*)dm->data)->printL2;
1314ca3d3a14SMatthew G. Knepley   DM               tdm;
1315cb1e1211SMatthew G Knepley   PetscSection     section;
131640e14135SMatthew G. Knepley   PetscQuadrature  quad;
1317ca3d3a14SMatthew G. Knepley   Vec              localX, tv;
13189c3cf19fSMatthew G. Knepley   PetscScalar     *funcVal, *interpolant;
13192a4e142eSMatthew G. Knepley   const PetscReal *quadWeights;
13204bee2e38SMatthew G. Knepley   PetscFEGeom      fegeom;
13214bee2e38SMatthew G. Knepley   PetscReal       *coords, *gcoords;
132240e14135SMatthew G. Knepley   PetscReal        localDiff = 0.0;
1323485ad865SMatthew G. Knepley   PetscInt         dim, coordDim, qNc = 0, Nq = 0, numFields, numComponents = 0, cStart, cEnd, c, field, fieldOffset;
1324ca3d3a14SMatthew G. Knepley   PetscBool        transform;
1325cb1e1211SMatthew G Knepley   PetscErrorCode   ierr;
1326cb1e1211SMatthew G Knepley 
1327cb1e1211SMatthew G Knepley   PetscFunctionBegin;
1328*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dm, &dim));
1329*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateDim(dm, &coordDim));
13304bee2e38SMatthew G. Knepley   fegeom.dimEmbed = coordDim;
1331*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &section));
1332*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetNumFields(section, &numFields));
1333*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalVector(dm, &localX));
1334*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGlobalToLocalBegin(dm, X, INSERT_VALUES, localX));
1335*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGlobalToLocalEnd(dm, X, INSERT_VALUES, localX));
1336*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetBasisTransformDM_Internal(dm, &tdm));
1337*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetBasisTransformVec_Internal(dm, &tv));
1338*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMHasBasisTransform(dm, &transform));
1339652b88e8SMatthew G. Knepley   for (field = 0; field < numFields; ++field) {
13400f2d7e86SMatthew G. Knepley     PetscFE  fe;
134140e14135SMatthew G. Knepley     PetscInt Nc;
1342652b88e8SMatthew G. Knepley 
1343*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetField(dm, field, NULL, (PetscObject *) &fe));
1344*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGetQuadrature(fe, &quad));
1345*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGetNumComponents(fe, &Nc));
134640e14135SMatthew G. Knepley     numComponents += Nc;
1347652b88e8SMatthew G. Knepley   }
1348*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscQuadratureGetData(quad, NULL, &qNc, &Nq, NULL, &quadWeights));
13492c71b3e2SJacob Faibussowitsch   PetscCheckFalse((qNc != 1) && (qNc != numComponents),PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_SIZ, "Quadrature components %D != %D field components", qNc, numComponents);
1350*5f80ce2aSJacob Faibussowitsch   /* CHKERRQ(DMProjectFunctionLocal(dm, fe, funcs, INSERT_BC_VALUES, localX)); */
1351*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc6(numComponents,&funcVal,coordDim*Nq,&coords,coordDim*coordDim*Nq,&fegeom.J,coordDim*coordDim*Nq,&fegeom.invJ,numComponents*coordDim,&interpolant,Nq,&fegeom.detJ));
1352*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetSimplexOrBoxCells(dm, 0, &cStart, &cEnd));
135340e14135SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
135440e14135SMatthew G. Knepley     PetscScalar *x = NULL;
135540e14135SMatthew G. Knepley     PetscReal    elemDiff = 0.0;
13569c3cf19fSMatthew G. Knepley     PetscInt     qc = 0;
1357652b88e8SMatthew G. Knepley 
1358*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexComputeCellGeometryFEM(dm, c, quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
1359*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecGetClosure(dm, NULL, localX, c, NULL, &x));
136040e14135SMatthew G. Knepley 
13619c3cf19fSMatthew G. Knepley     for (field = 0, fieldOffset = 0; field < numFields; ++field) {
13620f2d7e86SMatthew G. Knepley       PetscFE          fe;
136351259fa3SMatthew G. Knepley       void * const     ctx = ctxs ? ctxs[field] : NULL;
13649c3cf19fSMatthew G. Knepley       PetscInt         Nb, Nc, q, fc;
136540e14135SMatthew G. Knepley 
1366*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMGetField(dm, field, NULL, (PetscObject *) &fe));
1367*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetDimension(fe, &Nb));
1368*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetNumComponents(fe, &Nc));
136940e14135SMatthew G. Knepley       if (debug) {
137040e14135SMatthew G. Knepley         char title[1024];
1371*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscSNPrintf(title, 1023, "Solution for Field %" PetscInt_FMT, field));
1372*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPrintCellVector(c, title, Nb, &x[fieldOffset]));
1373652b88e8SMatthew G. Knepley       }
13749c3cf19fSMatthew G. Knepley       for (q = 0; q < Nq; ++q) {
13752a4e142eSMatthew G. Knepley         PetscFEGeom qgeom;
13762a4e142eSMatthew G. Knepley 
13772a4e142eSMatthew G. Knepley         qgeom.dimEmbed = fegeom.dimEmbed;
13782a4e142eSMatthew G. Knepley         qgeom.J        = &fegeom.J[q*coordDim*coordDim];
13792a4e142eSMatthew G. Knepley         qgeom.invJ     = &fegeom.invJ[q*coordDim*coordDim];
13802a4e142eSMatthew G. Knepley         qgeom.detJ     = &fegeom.detJ[q];
13812df84da0SMatthew G. Knepley         PetscCheck(fegeom.detJ[q] > 0.0, PETSC_COMM_SELF, PETSC_ERR_ARG_OUTOFRANGE, "Invalid determinant %g for element %" PetscInt_FMT ", quadrature points %" PetscInt_FMT, (double)fegeom.detJ[q], c, q);
1382d3a7d86cSMatthew G. Knepley         if (transform) {
1383d3a7d86cSMatthew G. Knepley           gcoords = &coords[coordDim*Nq];
1384*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexBasisTransformApplyReal_Internal(dm, &coords[coordDim*q], PETSC_TRUE, coordDim, &coords[coordDim*q], gcoords, dm->transformCtx));
1385d3a7d86cSMatthew G. Knepley         } else {
1386d3a7d86cSMatthew G. Knepley           gcoords = &coords[coordDim*q];
1387d3a7d86cSMatthew G. Knepley         }
1388*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscArrayzero(funcVal,Nc));
13894bee2e38SMatthew G. Knepley         ierr = (*funcs[field])(coordDim, time, gcoords, n, Nc, funcVal, ctx);
1390e735a8a9SMatthew G. Knepley         if (ierr) {
1391*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexVecRestoreClosure(dm, NULL, localX, c, NULL, &x));
1392*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMRestoreLocalVector(dm, &localX));
1393*5f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFree6(funcVal,coords,fegeom.J,fegeom.invJ,interpolant,fegeom.detJ));
1394e735a8a9SMatthew G. Knepley           CHKERRQ(ierr);
1395e735a8a9SMatthew G. Knepley         }
1396*5f80ce2aSJacob Faibussowitsch         if (transform) CHKERRQ(DMPlexBasisTransformApply_Internal(dm, &coords[coordDim*q], PETSC_FALSE, Nc, funcVal, funcVal, dm->transformCtx));
1397*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEInterpolateGradient_Static(fe, 1, &x[fieldOffset], &qgeom, q, interpolant));
13984bee2e38SMatthew G. Knepley         /* Overwrite with the dot product if the normal is given */
13994bee2e38SMatthew G. Knepley         if (n) {
14004bee2e38SMatthew G. Knepley           for (fc = 0; fc < Nc; ++fc) {
14014bee2e38SMatthew G. Knepley             PetscScalar sum = 0.0;
14024bee2e38SMatthew G. Knepley             PetscInt    d;
14034bee2e38SMatthew G. Knepley             for (d = 0; d < dim; ++d) sum += interpolant[fc*dim+d]*n[d];
14044bee2e38SMatthew G. Knepley             interpolant[fc] = sum;
14054bee2e38SMatthew G. Knepley           }
14064bee2e38SMatthew G. Knepley         }
14079c3cf19fSMatthew G. Knepley         for (fc = 0; fc < Nc; ++fc) {
1408beaa55a6SMatthew G. Knepley           const PetscReal wt = quadWeights[q*qNc+(qNc == 1 ? 0 : qc+fc)];
1409*5f80ce2aSJacob Faibussowitsch           if (debug) CHKERRQ(PetscPrintf(PETSC_COMM_SELF, "    elem %D fieldDer %D,%D diff %g\n", c, field, fc, (double)(PetscSqr(PetscRealPart(interpolant[fc] - funcVal[fc]))*wt*fegeom.detJ[q])));
14104bee2e38SMatthew G. Knepley           elemDiff += PetscSqr(PetscRealPart(interpolant[fc] - funcVal[fc]))*wt*fegeom.detJ[q];
141140e14135SMatthew G. Knepley         }
141240e14135SMatthew G. Knepley       }
14139c3cf19fSMatthew G. Knepley       fieldOffset += Nb;
14149c3cf19fSMatthew G. Knepley       qc          += Nc;
141540e14135SMatthew G. Knepley     }
1416*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecRestoreClosure(dm, NULL, localX, c, NULL, &x));
1417*5f80ce2aSJacob Faibussowitsch     if (debug) CHKERRQ(PetscPrintf(PETSC_COMM_SELF, "  elem %D diff %g\n", c, (double)elemDiff));
141840e14135SMatthew G. Knepley     localDiff += elemDiff;
141940e14135SMatthew G. Knepley   }
1420*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree6(funcVal,coords,fegeom.J,fegeom.invJ,interpolant,fegeom.detJ));
1421*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreLocalVector(dm, &localX));
1422*5f80ce2aSJacob Faibussowitsch   CHKERRMPI(MPIU_Allreduce(&localDiff, diff, 1, MPIU_REAL, MPIU_SUM, PetscObjectComm((PetscObject)dm)));
142340e14135SMatthew G. Knepley   *diff = PetscSqrtReal(*diff);
1424cb1e1211SMatthew G Knepley   PetscFunctionReturn(0);
1425cb1e1211SMatthew G Knepley }
1426cb1e1211SMatthew G Knepley 
1427c6eecec3SToby Isaac PetscErrorCode DMComputeL2FieldDiff_Plex(DM dm, PetscReal time, PetscErrorCode (**funcs)(PetscInt, PetscReal, const PetscReal [], PetscInt, PetscScalar *, void *), void **ctxs, Vec X, PetscReal *diff)
142873d901b8SMatthew G. Knepley {
14290f09c10fSMatthew G. Knepley   const PetscInt   debug = ((DM_Plex*)dm->data)->printL2;
1430ca3d3a14SMatthew G. Knepley   DM               tdm;
1431083401c6SMatthew G. Knepley   DMLabel          depthLabel;
143273d901b8SMatthew G. Knepley   PetscSection     section;
1433ca3d3a14SMatthew G. Knepley   Vec              localX, tv;
143473d901b8SMatthew G. Knepley   PetscReal       *localDiff;
1435083401c6SMatthew G. Knepley   PetscInt         dim, depth, dE, Nf, f, Nds, s;
1436ca3d3a14SMatthew G. Knepley   PetscBool        transform;
143773d901b8SMatthew G. Knepley   PetscErrorCode   ierr;
143873d901b8SMatthew G. Knepley 
143973d901b8SMatthew G. Knepley   PetscFunctionBegin;
1440*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dm, &dim));
1441*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateDim(dm, &dE));
1442*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &section));
1443*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalVector(dm, &localX));
1444*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetBasisTransformDM_Internal(dm, &tdm));
1445*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetBasisTransformVec_Internal(dm, &tv));
1446*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMHasBasisTransform(dm, &transform));
1447*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetNumFields(dm, &Nf));
1448*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetDepthLabel(dm, &depthLabel));
1449*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMLabelGetNumValues(depthLabel, &depth));
1450083401c6SMatthew G. Knepley 
1451*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecSet(localX, 0.0));
1452*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGlobalToLocalBegin(dm, X, INSERT_VALUES, localX));
1453*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGlobalToLocalEnd(dm, X, INSERT_VALUES, localX));
1454*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMProjectFunctionLocal(dm, time, funcs, ctxs, INSERT_BC_VALUES, localX));
1455*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetNumDS(dm, &Nds));
1456*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscCalloc1(Nf, &localDiff));
1457083401c6SMatthew G. Knepley   for (s = 0; s < Nds; ++s) {
1458083401c6SMatthew G. Knepley     PetscDS          ds;
1459083401c6SMatthew G. Knepley     DMLabel          label;
1460083401c6SMatthew G. Knepley     IS               fieldIS, pointIS;
1461083401c6SMatthew G. Knepley     const PetscInt  *fields, *points = NULL;
1462083401c6SMatthew G. Knepley     PetscQuadrature  quad;
1463083401c6SMatthew G. Knepley     const PetscReal *quadPoints, *quadWeights;
1464083401c6SMatthew G. Knepley     PetscFEGeom      fegeom;
1465083401c6SMatthew G. Knepley     PetscReal       *coords, *gcoords;
1466083401c6SMatthew G. Knepley     PetscScalar     *funcVal, *interpolant;
14675fedec97SMatthew G. Knepley     PetscBool        isCohesive;
1468083401c6SMatthew G. Knepley     PetscInt         qNc, Nq, totNc, cStart = 0, cEnd, c, dsNf;
146973d901b8SMatthew G. Knepley 
1470*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetRegionNumDS(dm, s, &label, &fieldIS, &ds));
1471*5f80ce2aSJacob Faibussowitsch     CHKERRQ(ISGetIndices(fieldIS, &fields));
1472*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSIsCohesive(ds, &isCohesive));
1473*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetNumFields(ds, &dsNf));
1474*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetTotalComponents(ds, &totNc));
1475*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetQuadrature(ds, &quad));
1476*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscQuadratureGetData(quad, NULL, &qNc, &Nq, &quadPoints, &quadWeights));
14772c71b3e2SJacob Faibussowitsch     PetscCheckFalse((qNc != 1) && (qNc != totNc),PETSC_COMM_SELF, PETSC_ERR_ARG_SIZ, "Quadrature components %D != %D field components", qNc, totNc);
1478*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscCalloc6(totNc, &funcVal, totNc, &interpolant, dE*(Nq+1), &coords,Nq, &fegeom.detJ, dE*dE*Nq, &fegeom.J, dE*dE*Nq, &fegeom.invJ));
1479083401c6SMatthew G. Knepley     if (!label) {
1480*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetSimplexOrBoxCells(dm, 0, &cStart, &cEnd));
1481083401c6SMatthew G. Knepley     } else {
1482*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMLabelGetStratumIS(label, 1, &pointIS));
1483*5f80ce2aSJacob Faibussowitsch       CHKERRQ(ISGetLocalSize(pointIS, &cEnd));
1484*5f80ce2aSJacob Faibussowitsch       CHKERRQ(ISGetIndices(pointIS, &points));
1485083401c6SMatthew G. Knepley     }
148673d901b8SMatthew G. Knepley     for (c = cStart; c < cEnd; ++c) {
1487083401c6SMatthew G. Knepley       const PetscInt cell  = points ? points[c] : c;
148873d901b8SMatthew G. Knepley       PetscScalar    *x    = NULL;
14895fedec97SMatthew G. Knepley       const PetscInt *cone;
14905fedec97SMatthew G. Knepley       PetscInt        qc   = 0, fOff = 0, dep;
149173d901b8SMatthew G. Knepley 
1492*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMLabelGetValue(depthLabel, cell, &dep));
1493083401c6SMatthew G. Knepley       if (dep != depth-1) continue;
14945fedec97SMatthew G. Knepley       if (isCohesive) {
1495*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexGetCone(dm, cell, &cone));
1496*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexComputeCellGeometryFEM(dm, cone[0], quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
149796959cd1SMatthew G. Knepley       } else {
1498*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexComputeCellGeometryFEM(dm, cell, quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
149996959cd1SMatthew G. Knepley       }
1500*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecGetClosure(dm, NULL, localX, cell, NULL, &x));
15015fedec97SMatthew G. Knepley       for (f = 0; f < dsNf; ++f) {
150215496722SMatthew G. Knepley         PetscObject  obj;
150315496722SMatthew G. Knepley         PetscClassId id;
1504083401c6SMatthew G. Knepley         void * const ctx = ctxs ? ctxs[fields[f]] : NULL;
150515496722SMatthew G. Knepley         PetscInt     Nb, Nc, q, fc;
150615496722SMatthew G. Knepley         PetscReal    elemDiff = 0.0;
15075fedec97SMatthew G. Knepley         PetscBool    cohesive;
150815496722SMatthew G. Knepley 
1509*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDSGetCohesive(ds, f, &cohesive));
15105fedec97SMatthew G. Knepley         if (isCohesive && !cohesive) continue;
1511*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDSGetDiscretization(ds, f, &obj));
1512*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscObjectGetClassId(obj, &id));
1513*5f80ce2aSJacob Faibussowitsch         if (id == PETSCFE_CLASSID)      {CHKERRQ(PetscFEGetNumComponents((PetscFE) obj, &Nc));CHKERRQ(PetscFEGetDimension((PetscFE) obj, &Nb));}
1514*5f80ce2aSJacob Faibussowitsch         else if (id == PETSCFV_CLASSID) {CHKERRQ(PetscFVGetNumComponents((PetscFV) obj, &Nc));Nb = 1;}
151598921bdaSJacob Faibussowitsch         else SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", fields[f]);
151673d901b8SMatthew G. Knepley         if (debug) {
151773d901b8SMatthew G. Knepley           char title[1024];
1518*5f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscSNPrintf(title, 1023, "Solution for Field %D", fields[f]));
1519*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPrintCellVector(cell, title, Nb, &x[fOff]));
152073d901b8SMatthew G. Knepley         }
15217318780aSToby Isaac         for (q = 0; q < Nq; ++q) {
15222a4e142eSMatthew G. Knepley           PetscFEGeom qgeom;
15232a4e142eSMatthew G. Knepley 
15242a4e142eSMatthew G. Knepley           qgeom.dimEmbed = fegeom.dimEmbed;
1525083401c6SMatthew G. Knepley           qgeom.J        = &fegeom.J[q*dE*dE];
1526083401c6SMatthew G. Knepley           qgeom.invJ     = &fegeom.invJ[q*dE*dE];
15272a4e142eSMatthew G. Knepley           qgeom.detJ     = &fegeom.detJ[q];
1528*5f80ce2aSJacob Faibussowitsch           PetscCheck(fegeom.detJ[q] > 0.0,PETSC_COMM_SELF, PETSC_ERR_ARG_OUTOFRANGE, "Invalid determinant %g for cell %D, quadrature point %D", (double)fegeom.detJ[q], cell, q);
1529d3a7d86cSMatthew G. Knepley           if (transform) {
1530083401c6SMatthew G. Knepley             gcoords = &coords[dE*Nq];
1531*5f80ce2aSJacob Faibussowitsch             CHKERRQ(DMPlexBasisTransformApplyReal_Internal(dm, &coords[dE*q], PETSC_TRUE, dE, &coords[dE*q], gcoords, dm->transformCtx));
1532d3a7d86cSMatthew G. Knepley           } else {
1533083401c6SMatthew G. Knepley             gcoords = &coords[dE*q];
1534d3a7d86cSMatthew G. Knepley           }
15352df84da0SMatthew G. Knepley           for (fc = 0; fc < Nc; ++fc) funcVal[fc] = 0.;
1536083401c6SMatthew G. Knepley           ierr = (*funcs[fields[f]])(dE, time, gcoords, Nc, funcVal, ctx);
1537e735a8a9SMatthew G. Knepley           if (ierr) {
1538*5f80ce2aSJacob Faibussowitsch             CHKERRQ(DMPlexVecRestoreClosure(dm, NULL, localX, cell, NULL, &x));
1539*5f80ce2aSJacob Faibussowitsch             CHKERRQ(DMRestoreLocalVector(dm, &localX));
1540*5f80ce2aSJacob Faibussowitsch             CHKERRQ(PetscFree6(funcVal,interpolant,coords,fegeom.detJ,fegeom.J,fegeom.invJ));
1541e735a8a9SMatthew G. Knepley             CHKERRQ(ierr);
1542e735a8a9SMatthew G. Knepley           }
1543*5f80ce2aSJacob Faibussowitsch           if (transform) CHKERRQ(DMPlexBasisTransformApply_Internal(dm, &coords[dE*q], PETSC_FALSE, Nc, funcVal, funcVal, dm->transformCtx));
154496959cd1SMatthew G. Knepley           /* Call once for each face, except for lagrange field */
1545*5f80ce2aSJacob Faibussowitsch           if (id == PETSCFE_CLASSID)      CHKERRQ(PetscFEInterpolate_Static((PetscFE) obj, &x[fOff], &qgeom, q, interpolant));
1546*5f80ce2aSJacob Faibussowitsch           else if (id == PETSCFV_CLASSID) CHKERRQ(PetscFVInterpolate_Static((PetscFV) obj, &x[fOff], q, interpolant));
154798921bdaSJacob Faibussowitsch           else SETERRQ(PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", fields[f]);
154815496722SMatthew G. Knepley           for (fc = 0; fc < Nc; ++fc) {
1549beaa55a6SMatthew G. Knepley             const PetscReal wt = quadWeights[q*qNc+(qNc == 1 ? 0 : qc+fc)];
1550*5f80ce2aSJacob Faibussowitsch             if (debug) CHKERRQ(PetscPrintf(PETSC_COMM_SELF, "    cell %D field %D,%D point %g %g %g diff %g\n", cell, fields[f], fc, (double)(dE > 0 ? coords[dE*q] : 0.), (double)(dE > 1 ? coords[dE*q+1] : 0.),(double)(dE > 2 ? coords[dE*q+2] : 0.), (double)(PetscSqr(PetscRealPart(interpolant[fc] - funcVal[fc]))*wt*fegeom.detJ[q])));
15514bee2e38SMatthew G. Knepley             elemDiff += PetscSqr(PetscRealPart(interpolant[fc] - funcVal[fc]))*wt*fegeom.detJ[q];
155273d901b8SMatthew G. Knepley           }
155373d901b8SMatthew G. Knepley         }
1554083401c6SMatthew G. Knepley         fOff += Nb;
15559c3cf19fSMatthew G. Knepley         qc   += Nc;
1556083401c6SMatthew G. Knepley         localDiff[fields[f]] += elemDiff;
1557*5f80ce2aSJacob Faibussowitsch         if (debug) CHKERRQ(PetscPrintf(PETSC_COMM_SELF, "  cell %D field %D cum diff %g\n", cell, fields[f], (double)localDiff[fields[f]]));
155873d901b8SMatthew G. Knepley       }
1559*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecRestoreClosure(dm, NULL, localX, cell, NULL, &x));
1560083401c6SMatthew G. Knepley     }
1561083401c6SMatthew G. Knepley     if (label) {
1562*5f80ce2aSJacob Faibussowitsch       CHKERRQ(ISRestoreIndices(pointIS, &points));
1563*5f80ce2aSJacob Faibussowitsch       CHKERRQ(ISDestroy(&pointIS));
1564083401c6SMatthew G. Knepley     }
1565*5f80ce2aSJacob Faibussowitsch     CHKERRQ(ISRestoreIndices(fieldIS, &fields));
1566*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFree6(funcVal, interpolant, coords, fegeom.detJ, fegeom.J, fegeom.invJ));
156773d901b8SMatthew G. Knepley   }
1568*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreLocalVector(dm, &localX));
1569*5f80ce2aSJacob Faibussowitsch   CHKERRMPI(MPIU_Allreduce(localDiff, diff, Nf, MPIU_REAL, MPIU_SUM, PetscObjectComm((PetscObject)dm)));
1570*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree(localDiff));
1571083401c6SMatthew G. Knepley   for (f = 0; f < Nf; ++f) diff[f] = PetscSqrtReal(diff[f]);
157273d901b8SMatthew G. Knepley   PetscFunctionReturn(0);
157373d901b8SMatthew G. Knepley }
157473d901b8SMatthew G. Knepley 
1575e729f68cSMatthew G. Knepley /*@C
1576e729f68cSMatthew G. Knepley   DMPlexComputeL2DiffVec - This function computes the cellwise L_2 difference between a function u and an FEM interpolant solution u_h, and stores it in a Vec.
1577e729f68cSMatthew G. Knepley 
1578d083f849SBarry Smith   Collective on dm
1579c0f8e1fdSMatthew G. Knepley 
1580e729f68cSMatthew G. Knepley   Input Parameters:
1581e729f68cSMatthew G. Knepley + dm    - The DM
15820163fd50SMatthew G. Knepley . time  - The time
1583ca3eba1bSToby Isaac . funcs - The functions to evaluate for each field component: NULL means that component does not contribute to error calculation
1584e729f68cSMatthew G. Knepley . ctxs  - Optional array of contexts to pass to each function, or NULL.
1585e729f68cSMatthew G. Knepley - X     - The coefficient vector u_h
1586e729f68cSMatthew G. Knepley 
1587e729f68cSMatthew G. Knepley   Output Parameter:
1588e729f68cSMatthew G. Knepley . D - A Vec which holds the difference ||u - u_h||_2 for each cell
1589e729f68cSMatthew G. Knepley 
1590e729f68cSMatthew G. Knepley   Level: developer
1591e729f68cSMatthew G. Knepley 
1592b698f381SToby Isaac .seealso: DMProjectFunction(), DMComputeL2Diff(), DMPlexComputeL2FieldDiff(), DMComputeL2GradientDiff()
1593e729f68cSMatthew G. Knepley @*/
15940163fd50SMatthew G. Knepley PetscErrorCode DMPlexComputeL2DiffVec(DM dm, PetscReal time, PetscErrorCode (**funcs)(PetscInt, PetscReal, const PetscReal [], PetscInt, PetscScalar *, void *), void **ctxs, Vec X, Vec D)
1595e729f68cSMatthew G. Knepley {
1596e729f68cSMatthew G. Knepley   PetscSection     section;
1597e729f68cSMatthew G. Knepley   PetscQuadrature  quad;
1598e729f68cSMatthew G. Knepley   Vec              localX;
15994bee2e38SMatthew G. Knepley   PetscFEGeom      fegeom;
1600e729f68cSMatthew G. Knepley   PetscScalar     *funcVal, *interpolant;
16014bee2e38SMatthew G. Knepley   PetscReal       *coords;
1602e729f68cSMatthew G. Knepley   const PetscReal *quadPoints, *quadWeights;
1603485ad865SMatthew G. Knepley   PetscInt         dim, coordDim, numFields, numComponents = 0, qNc, Nq, cStart, cEnd, c, field, fieldOffset;
1604e729f68cSMatthew G. Knepley 
1605e729f68cSMatthew G. Knepley   PetscFunctionBegin;
1606*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecSet(D, 0.0));
1607*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dm, &dim));
1608*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateDim(dm, &coordDim));
1609*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &section));
1610*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetNumFields(section, &numFields));
1611*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalVector(dm, &localX));
1612*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMProjectFunctionLocal(dm, time, funcs, ctxs, INSERT_BC_VALUES, localX));
1613*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGlobalToLocalBegin(dm, X, INSERT_VALUES, localX));
1614*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGlobalToLocalEnd(dm, X, INSERT_VALUES, localX));
1615e729f68cSMatthew G. Knepley   for (field = 0; field < numFields; ++field) {
1616e729f68cSMatthew G. Knepley     PetscObject  obj;
1617e729f68cSMatthew G. Knepley     PetscClassId id;
1618e729f68cSMatthew G. Knepley     PetscInt     Nc;
1619e729f68cSMatthew G. Knepley 
1620*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetField(dm, field, NULL, &obj));
1621*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
1622e729f68cSMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
1623e729f68cSMatthew G. Knepley       PetscFE fe = (PetscFE) obj;
1624e729f68cSMatthew G. Knepley 
1625*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetQuadrature(fe, &quad));
1626*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetNumComponents(fe, &Nc));
1627e729f68cSMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
1628e729f68cSMatthew G. Knepley       PetscFV fv = (PetscFV) obj;
1629e729f68cSMatthew G. Knepley 
1630*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetQuadrature(fv, &quad));
1631*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetNumComponents(fv, &Nc));
163298921bdaSJacob Faibussowitsch     } else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", field);
1633e729f68cSMatthew G. Knepley     numComponents += Nc;
1634e729f68cSMatthew G. Knepley   }
1635*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscQuadratureGetData(quad, NULL, &qNc, &Nq, &quadPoints, &quadWeights));
16362c71b3e2SJacob Faibussowitsch   PetscCheckFalse((qNc != 1) && (qNc != numComponents),PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_SIZ, "Quadrature components %D != %D field components", qNc, numComponents);
1637*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc6(numComponents,&funcVal,numComponents,&interpolant,coordDim*Nq,&coords,Nq,&fegeom.detJ,coordDim*coordDim*Nq,&fegeom.J,coordDim*coordDim*Nq,&fegeom.invJ));
1638*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetSimplexOrBoxCells(dm, 0, &cStart, &cEnd));
1639e729f68cSMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
1640e729f68cSMatthew G. Knepley     PetscScalar *x = NULL;
16416f288a59SMatthew G. Knepley     PetscScalar  elemDiff = 0.0;
16429c3cf19fSMatthew G. Knepley     PetscInt     qc = 0;
1643e729f68cSMatthew G. Knepley 
1644*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexComputeCellGeometryFEM(dm, c, quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
1645*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecGetClosure(dm, NULL, localX, c, NULL, &x));
1646e729f68cSMatthew G. Knepley 
1647e729f68cSMatthew G. Knepley     for (field = 0, fieldOffset = 0; field < numFields; ++field) {
1648e729f68cSMatthew G. Knepley       PetscObject  obj;
1649e729f68cSMatthew G. Knepley       PetscClassId id;
1650e729f68cSMatthew G. Knepley       void * const ctx = ctxs ? ctxs[field] : NULL;
1651e729f68cSMatthew G. Knepley       PetscInt     Nb, Nc, q, fc;
1652e729f68cSMatthew G. Knepley 
1653*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMGetField(dm, field, NULL, &obj));
1654*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscObjectGetClassId(obj, &id));
1655*5f80ce2aSJacob Faibussowitsch       if (id == PETSCFE_CLASSID)      {CHKERRQ(PetscFEGetNumComponents((PetscFE) obj, &Nc));CHKERRQ(PetscFEGetDimension((PetscFE) obj, &Nb));}
1656*5f80ce2aSJacob Faibussowitsch       else if (id == PETSCFV_CLASSID) {CHKERRQ(PetscFVGetNumComponents((PetscFV) obj, &Nc));Nb = 1;}
165798921bdaSJacob Faibussowitsch       else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", field);
165823f34ed2SToby Isaac       if (funcs[field]) {
16597318780aSToby Isaac         for (q = 0; q < Nq; ++q) {
16602a4e142eSMatthew G. Knepley           PetscFEGeom qgeom;
16612a4e142eSMatthew G. Knepley 
16622a4e142eSMatthew G. Knepley           qgeom.dimEmbed = fegeom.dimEmbed;
16632a4e142eSMatthew G. Knepley           qgeom.J        = &fegeom.J[q*coordDim*coordDim];
16642a4e142eSMatthew G. Knepley           qgeom.invJ     = &fegeom.invJ[q*coordDim*coordDim];
16652a4e142eSMatthew G. Knepley           qgeom.detJ     = &fegeom.detJ[q];
1666*5f80ce2aSJacob Faibussowitsch           PetscCheck(fegeom.detJ[q] > 0.0,PETSC_COMM_SELF, PETSC_ERR_ARG_OUTOFRANGE, "Invalid determinant %g for element %D, quadrature points %D", (double)fegeom.detJ[q], c, q);
1667*5f80ce2aSJacob Faibussowitsch           CHKERRQ((*funcs[field])(coordDim, time, &coords[q*coordDim], Nc, funcVal, ctx));
1668c3e24edfSBarry Smith #if defined(needs_fix_with_return_code_argument)
1669e735a8a9SMatthew G. Knepley           if (ierr) {
1670c3e24edfSBarry Smith             PetscErrorCode ierr;
1671*5f80ce2aSJacob Faibussowitsch             CHKERRQ(DMPlexVecRestoreClosure(dm, NULL, localX, c, NULL, &x));
1672*5f80ce2aSJacob Faibussowitsch             CHKERRQ(PetscFree6(funcVal,interpolant,coords,fegeom.detJ,fegeom.J,fegeom.invJ));
1673*5f80ce2aSJacob Faibussowitsch             CHKERRQ(DMRestoreLocalVector(dm, &localX));
1674e735a8a9SMatthew G. Knepley           }
1675c3e24edfSBarry Smith #endif
1676*5f80ce2aSJacob Faibussowitsch           if (id == PETSCFE_CLASSID)      CHKERRQ(PetscFEInterpolate_Static((PetscFE) obj, &x[fieldOffset], &qgeom, q, interpolant));
1677*5f80ce2aSJacob Faibussowitsch           else if (id == PETSCFV_CLASSID) CHKERRQ(PetscFVInterpolate_Static((PetscFV) obj, &x[fieldOffset], q, interpolant));
167898921bdaSJacob Faibussowitsch           else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", field);
1679e729f68cSMatthew G. Knepley           for (fc = 0; fc < Nc; ++fc) {
1680beaa55a6SMatthew G. Knepley             const PetscReal wt = quadWeights[q*qNc+(qNc == 1 ? 0 : qc+fc)];
16814bee2e38SMatthew G. Knepley             elemDiff += PetscSqr(PetscRealPart(interpolant[fc] - funcVal[fc]))*wt*fegeom.detJ[q];
1682e729f68cSMatthew G. Knepley           }
1683e729f68cSMatthew G. Knepley         }
168423f34ed2SToby Isaac       }
1685beaa55a6SMatthew G. Knepley       fieldOffset += Nb;
16869c3cf19fSMatthew G. Knepley       qc          += Nc;
1687e729f68cSMatthew G. Knepley     }
1688*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecRestoreClosure(dm, NULL, localX, c, NULL, &x));
1689*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecSetValue(D, c - cStart, elemDiff, INSERT_VALUES));
1690e729f68cSMatthew G. Knepley   }
1691*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree6(funcVal,interpolant,coords,fegeom.detJ,fegeom.J,fegeom.invJ));
1692*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreLocalVector(dm, &localX));
1693*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecSqrtAbs(D));
1694e729f68cSMatthew G. Knepley   PetscFunctionReturn(0);
1695e729f68cSMatthew G. Knepley }
1696e729f68cSMatthew G. Knepley 
16975f0b18bfSMatthew G. Knepley /*@
16985f0b18bfSMatthew G. Knepley   DMPlexComputeClementInterpolant - This function computes the L2 projection of the cellwise values of a function u onto P1, and stores it in a Vec.
16995f0b18bfSMatthew G. Knepley 
17005f0b18bfSMatthew G. Knepley   Collective on dm
17015f0b18bfSMatthew G. Knepley 
17025f0b18bfSMatthew G. Knepley   Input Parameters:
17035f0b18bfSMatthew G. Knepley + dm - The DM
17045f0b18bfSMatthew G. Knepley - locX  - The coefficient vector u_h
17055f0b18bfSMatthew G. Knepley 
17065f0b18bfSMatthew G. Knepley   Output Parameter:
17075f0b18bfSMatthew G. Knepley . locC - A Vec which holds the Clement interpolant of the function
17085f0b18bfSMatthew G. Knepley 
17095f0b18bfSMatthew G. Knepley   Notes:
17105f0b18bfSMatthew G. Knepley   u_h(v_i) = \sum_{T_i \in support(v_i)} |T_i| u_h(T_i) / \sum_{T_i \in support(v_i)} |T_i| where |T_i| is the cell volume
17115f0b18bfSMatthew G. Knepley 
17125f0b18bfSMatthew G. Knepley   Level: developer
17135f0b18bfSMatthew G. Knepley 
17145f0b18bfSMatthew G. Knepley .seealso: DMProjectFunction(), DMComputeL2Diff(), DMPlexComputeL2FieldDiff(), DMComputeL2GradientDiff()
17155f0b18bfSMatthew G. Knepley @*/
17165f0b18bfSMatthew G. Knepley PetscErrorCode DMPlexComputeClementInterpolant(DM dm, Vec locX, Vec locC)
17175f0b18bfSMatthew G. Knepley {
17185f0b18bfSMatthew G. Knepley   PetscInt         debug = ((DM_Plex *) dm->data)->printFEM;
17195f0b18bfSMatthew G. Knepley   DM               dmc;
17205f0b18bfSMatthew G. Knepley   PetscQuadrature  quad;
17215f0b18bfSMatthew G. Knepley   PetscScalar     *interpolant, *valsum;
17225f0b18bfSMatthew G. Knepley   PetscFEGeom      fegeom;
17235f0b18bfSMatthew G. Knepley   PetscReal       *coords;
17245f0b18bfSMatthew G. Knepley   const PetscReal *quadPoints, *quadWeights;
17255f0b18bfSMatthew G. Knepley   PetscInt         dim, cdim, Nf, f, Nc = 0, Nq, qNc, cStart, cEnd, vStart, vEnd, v;
17265f0b18bfSMatthew G. Knepley 
17275f0b18bfSMatthew G. Knepley   PetscFunctionBegin;
1728*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscCitationsRegister(ClementCitation, &Clementcite));
1729*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetDM(locC, &dmc));
1730*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecSet(locC, 0.0));
1731*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dm, &dim));
1732*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateDim(dm, &cdim));
17335f0b18bfSMatthew G. Knepley   fegeom.dimEmbed = cdim;
1734*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetNumFields(dm, &Nf));
17355f0b18bfSMatthew G. Knepley   PetscCheck(Nf > 0, PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of fields is zero!");
17365f0b18bfSMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
17375f0b18bfSMatthew G. Knepley     PetscObject  obj;
17385f0b18bfSMatthew G. Knepley     PetscClassId id;
17395f0b18bfSMatthew G. Knepley     PetscInt     fNc;
17405f0b18bfSMatthew G. Knepley 
1741*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetField(dm, f, NULL, &obj));
1742*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
17435f0b18bfSMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
17445f0b18bfSMatthew G. Knepley       PetscFE fe = (PetscFE) obj;
17455f0b18bfSMatthew G. Knepley 
1746*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetQuadrature(fe, &quad));
1747*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetNumComponents(fe, &fNc));
17485f0b18bfSMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
17495f0b18bfSMatthew G. Knepley       PetscFV fv = (PetscFV) obj;
17505f0b18bfSMatthew G. Knepley 
1751*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetQuadrature(fv, &quad));
1752*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetNumComponents(fv, &fNc));
17535f0b18bfSMatthew G. Knepley     } else SETERRQ(PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", f);
17545f0b18bfSMatthew G. Knepley     Nc += fNc;
17555f0b18bfSMatthew G. Knepley   }
1756*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscQuadratureGetData(quad, NULL, &qNc, &Nq, &quadPoints, &quadWeights));
17575f0b18bfSMatthew G. Knepley   PetscCheck(qNc == 1,PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_SIZ, "Quadrature components %D > 1", qNc);
1758*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc6(Nc*2, &valsum, Nc, &interpolant, cdim*Nq, &coords, Nq, &fegeom.detJ, cdim*cdim*Nq, &fegeom.J, cdim*cdim*Nq, &fegeom.invJ));
1759*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetDepthStratum(dm, 0, &vStart, &vEnd));
1760*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetSimplexOrBoxCells(dm, 0, &cStart, &cEnd));
17615f0b18bfSMatthew G. Knepley   for (v = vStart; v < vEnd; ++v) {
17625f0b18bfSMatthew G. Knepley     PetscScalar volsum = 0.0;
17635f0b18bfSMatthew G. Knepley     PetscInt   *star   = NULL;
17645f0b18bfSMatthew G. Knepley     PetscInt    starSize, st, fc;
17655f0b18bfSMatthew G. Knepley 
1766*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscArrayzero(valsum, Nc));
1767*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexGetTransitiveClosure(dm, v, PETSC_FALSE, &starSize, &star));
17685f0b18bfSMatthew G. Knepley     for (st = 0; st < starSize*2; st += 2) {
17695f0b18bfSMatthew G. Knepley       const PetscInt cell = star[st];
17705f0b18bfSMatthew G. Knepley       PetscScalar   *val  = &valsum[Nc];
17715f0b18bfSMatthew G. Knepley       PetscScalar   *x    = NULL;
17725f0b18bfSMatthew G. Knepley       PetscReal      vol  = 0.0;
17735f0b18bfSMatthew G. Knepley       PetscInt       foff = 0;
17745f0b18bfSMatthew G. Knepley 
17755f0b18bfSMatthew G. Knepley       if ((cell < cStart) || (cell >= cEnd)) continue;
1776*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexComputeCellGeometryFEM(dm, cell, quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
1777*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecGetClosure(dm, NULL, locX, cell, NULL, &x));
17785f0b18bfSMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
17795f0b18bfSMatthew G. Knepley         PetscObject  obj;
17805f0b18bfSMatthew G. Knepley         PetscClassId id;
17815f0b18bfSMatthew G. Knepley         PetscInt     Nb, fNc, q;
17825f0b18bfSMatthew G. Knepley 
1783*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscArrayzero(val, Nc));
1784*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMGetField(dm, f, NULL, &obj));
1785*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscObjectGetClassId(obj, &id));
1786*5f80ce2aSJacob Faibussowitsch         if (id == PETSCFE_CLASSID)      {CHKERRQ(PetscFEGetNumComponents((PetscFE) obj, &fNc));CHKERRQ(PetscFEGetDimension((PetscFE) obj, &Nb));}
1787*5f80ce2aSJacob Faibussowitsch         else if (id == PETSCFV_CLASSID) {CHKERRQ(PetscFVGetNumComponents((PetscFV) obj, &fNc));Nb = 1;}
17885f0b18bfSMatthew G. Knepley         else SETERRQ(PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", f);
17895f0b18bfSMatthew G. Knepley         for (q = 0; q < Nq; ++q) {
17905f0b18bfSMatthew G. Knepley           const PetscReal wt = quadWeights[q]*fegeom.detJ[q];
17915f0b18bfSMatthew G. Knepley           PetscFEGeom     qgeom;
17925f0b18bfSMatthew G. Knepley 
17935f0b18bfSMatthew G. Knepley           qgeom.dimEmbed = fegeom.dimEmbed;
17945f0b18bfSMatthew G. Knepley           qgeom.J        = &fegeom.J[q*cdim*cdim];
17955f0b18bfSMatthew G. Knepley           qgeom.invJ     = &fegeom.invJ[q*cdim*cdim];
17965f0b18bfSMatthew G. Knepley           qgeom.detJ     = &fegeom.detJ[q];
17975f0b18bfSMatthew G. Knepley           PetscCheck(fegeom.detJ[q] > 0.0, PETSC_COMM_SELF, PETSC_ERR_ARG_OUTOFRANGE, "Invalid determinant %g for element %D, quadrature points %D", (double) fegeom.detJ[q], cell, q);
1798*5f80ce2aSJacob Faibussowitsch           if (id == PETSCFE_CLASSID) CHKERRQ(PetscFEInterpolate_Static((PetscFE) obj, &x[foff], &qgeom, q, interpolant));
17995f0b18bfSMatthew G. Knepley           else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", f);
18005f0b18bfSMatthew G. Knepley           for (fc = 0; fc < fNc; ++fc) val[foff+fc] += interpolant[fc]*wt;
18015f0b18bfSMatthew G. Knepley           vol += wt;
18025f0b18bfSMatthew G. Knepley         }
18035f0b18bfSMatthew G. Knepley         foff += Nb;
18045f0b18bfSMatthew G. Knepley       }
1805*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecRestoreClosure(dm, NULL, locX, cell, NULL, &x));
18065f0b18bfSMatthew G. Knepley       for (fc = 0; fc < Nc; ++fc) valsum[fc] += val[fc];
18075f0b18bfSMatthew G. Knepley       volsum += vol;
18085f0b18bfSMatthew G. Knepley       if (debug) {
1809*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscPrintf(PETSC_COMM_SELF, "Vertex %" PetscInt_FMT " Cell %" PetscInt_FMT " value: [", v, cell));
18105f0b18bfSMatthew G. Knepley         for (fc = 0; fc < Nc; ++fc) {
1811*5f80ce2aSJacob Faibussowitsch           if (fc) CHKERRQ(PetscPrintf(PETSC_COMM_SELF, ", "));
1812*5f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscPrintf(PETSC_COMM_SELF, "%g", (double) PetscRealPart(val[fc])));
18135f0b18bfSMatthew G. Knepley         }
1814*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscPrintf(PETSC_COMM_SELF, "]\n"));
18155f0b18bfSMatthew G. Knepley       }
18165f0b18bfSMatthew G. Knepley     }
18175f0b18bfSMatthew G. Knepley     for (fc = 0; fc < Nc; ++fc) valsum[fc] /= volsum;
1818*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexRestoreTransitiveClosure(dm, v, PETSC_FALSE, &starSize, &star));
1819*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecSetClosure(dmc, NULL, locC, v, valsum, INSERT_VALUES));
18205f0b18bfSMatthew G. Knepley   }
1821*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree6(valsum, interpolant, coords, fegeom.detJ, fegeom.J, fegeom.invJ));
18225f0b18bfSMatthew G. Knepley   PetscFunctionReturn(0);
18235f0b18bfSMatthew G. Knepley }
18245f0b18bfSMatthew G. Knepley 
18255f0b18bfSMatthew G. Knepley /*@
18261555c271SMatthew G. Knepley   DMPlexComputeGradientClementInterpolant - This function computes the L2 projection of the cellwise gradient of a function u onto P1, and stores it in a Vec.
18271555c271SMatthew G. Knepley 
1828d083f849SBarry Smith   Collective on dm
1829c0f8e1fdSMatthew G. Knepley 
18301555c271SMatthew G. Knepley   Input Parameters:
18311555c271SMatthew G. Knepley + dm - The DM
18325f0b18bfSMatthew G. Knepley - locX  - The coefficient vector u_h
18331555c271SMatthew G. Knepley 
18341555c271SMatthew G. Knepley   Output Parameter:
18351555c271SMatthew G. Knepley . locC - A Vec which holds the Clement interpolant of the gradient
18361555c271SMatthew G. Knepley 
183795452b02SPatrick Sanan   Notes:
18381555c271SMatthew G. Knepley   \nabla u_h(v_i) = \sum_{T_i \in support(v_i)} |T_i| \nabla u_h(T_i) / \sum_{T_i \in support(v_i)} |T_i| where |T_i| is the cell volume
18391555c271SMatthew G. Knepley 
18401555c271SMatthew G. Knepley   Level: developer
18411555c271SMatthew G. Knepley 
18421555c271SMatthew G. Knepley .seealso: DMProjectFunction(), DMComputeL2Diff(), DMPlexComputeL2FieldDiff(), DMComputeL2GradientDiff()
18431555c271SMatthew G. Knepley @*/
18441555c271SMatthew G. Knepley PetscErrorCode DMPlexComputeGradientClementInterpolant(DM dm, Vec locX, Vec locC)
18451555c271SMatthew G. Knepley {
1846db1066baSMatthew G. Knepley   DM_Plex         *mesh  = (DM_Plex *) dm->data;
1847db1066baSMatthew G. Knepley   PetscInt         debug = mesh->printFEM;
18481555c271SMatthew G. Knepley   DM               dmC;
18491555c271SMatthew G. Knepley   PetscQuadrature  quad;
18501555c271SMatthew G. Knepley   PetscScalar     *interpolant, *gradsum;
18514bee2e38SMatthew G. Knepley   PetscFEGeom      fegeom;
18524bee2e38SMatthew G. Knepley   PetscReal       *coords;
18531555c271SMatthew G. Knepley   const PetscReal *quadPoints, *quadWeights;
1854485ad865SMatthew G. Knepley   PetscInt         dim, coordDim, numFields, numComponents = 0, qNc, Nq, cStart, cEnd, vStart, vEnd, v, field, fieldOffset;
18551555c271SMatthew G. Knepley 
18561555c271SMatthew G. Knepley   PetscFunctionBegin;
1857*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscCitationsRegister(ClementCitation, &Clementcite));
1858*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetDM(locC, &dmC));
1859*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecSet(locC, 0.0));
1860*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dm, &dim));
1861*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateDim(dm, &coordDim));
18624bee2e38SMatthew G. Knepley   fegeom.dimEmbed = coordDim;
1863*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetNumFields(dm, &numFields));
1864*5f80ce2aSJacob Faibussowitsch   PetscCheck(numFields,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of fields is zero!");
18651555c271SMatthew G. Knepley   for (field = 0; field < numFields; ++field) {
18661555c271SMatthew G. Knepley     PetscObject  obj;
18671555c271SMatthew G. Knepley     PetscClassId id;
18681555c271SMatthew G. Knepley     PetscInt     Nc;
18691555c271SMatthew G. Knepley 
1870*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetField(dm, field, NULL, &obj));
1871*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
18721555c271SMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
18731555c271SMatthew G. Knepley       PetscFE fe = (PetscFE) obj;
18741555c271SMatthew G. Knepley 
1875*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetQuadrature(fe, &quad));
1876*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetNumComponents(fe, &Nc));
18771555c271SMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
18781555c271SMatthew G. Knepley       PetscFV fv = (PetscFV) obj;
18791555c271SMatthew G. Knepley 
1880*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetQuadrature(fv, &quad));
1881*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetNumComponents(fv, &Nc));
188298921bdaSJacob Faibussowitsch     } else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", field);
18831555c271SMatthew G. Knepley     numComponents += Nc;
18841555c271SMatthew G. Knepley   }
1885*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscQuadratureGetData(quad, NULL, &qNc, &Nq, &quadPoints, &quadWeights));
18862c71b3e2SJacob Faibussowitsch   PetscCheckFalse((qNc != 1) && (qNc != numComponents),PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_SIZ, "Quadrature components %D != %D field components", qNc, numComponents);
1887*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc6(coordDim*numComponents*2,&gradsum,coordDim*numComponents,&interpolant,coordDim*Nq,&coords,Nq,&fegeom.detJ,coordDim*coordDim*Nq,&fegeom.J,coordDim*coordDim*Nq,&fegeom.invJ));
1888*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetDepthStratum(dm, 0, &vStart, &vEnd));
1889*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetSimplexOrBoxCells(dm, 0, &cStart, &cEnd));
18901555c271SMatthew G. Knepley   for (v = vStart; v < vEnd; ++v) {
18911555c271SMatthew G. Knepley     PetscScalar volsum = 0.0;
18921555c271SMatthew G. Knepley     PetscInt   *star   = NULL;
18931555c271SMatthew G. Knepley     PetscInt    starSize, st, d, fc;
18941555c271SMatthew G. Knepley 
1895*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscArrayzero(gradsum, coordDim*numComponents));
1896*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexGetTransitiveClosure(dm, v, PETSC_FALSE, &starSize, &star));
18971555c271SMatthew G. Knepley     for (st = 0; st < starSize*2; st += 2) {
18981555c271SMatthew G. Knepley       const PetscInt cell = star[st];
18991555c271SMatthew G. Knepley       PetscScalar   *grad = &gradsum[coordDim*numComponents];
19001555c271SMatthew G. Knepley       PetscScalar   *x    = NULL;
19011555c271SMatthew G. Knepley       PetscReal      vol  = 0.0;
19021555c271SMatthew G. Knepley 
19031555c271SMatthew G. Knepley       if ((cell < cStart) || (cell >= cEnd)) continue;
1904*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexComputeCellGeometryFEM(dm, cell, quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
1905*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecGetClosure(dm, NULL, locX, cell, NULL, &x));
19061555c271SMatthew G. Knepley       for (field = 0, fieldOffset = 0; field < numFields; ++field) {
19071555c271SMatthew G. Knepley         PetscObject  obj;
19081555c271SMatthew G. Knepley         PetscClassId id;
19091555c271SMatthew G. Knepley         PetscInt     Nb, Nc, q, qc = 0;
19101555c271SMatthew G. Knepley 
1911*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscArrayzero(grad, coordDim*numComponents));
1912*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMGetField(dm, field, NULL, &obj));
1913*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscObjectGetClassId(obj, &id));
1914*5f80ce2aSJacob Faibussowitsch         if (id == PETSCFE_CLASSID)      {CHKERRQ(PetscFEGetNumComponents((PetscFE) obj, &Nc));CHKERRQ(PetscFEGetDimension((PetscFE) obj, &Nb));}
1915*5f80ce2aSJacob Faibussowitsch         else if (id == PETSCFV_CLASSID) {CHKERRQ(PetscFVGetNumComponents((PetscFV) obj, &Nc));Nb = 1;}
191698921bdaSJacob Faibussowitsch         else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", field);
19171555c271SMatthew G. Knepley         for (q = 0; q < Nq; ++q) {
19182a4e142eSMatthew G. Knepley           PetscFEGeom qgeom;
19192a4e142eSMatthew G. Knepley 
19202a4e142eSMatthew G. Knepley           qgeom.dimEmbed = fegeom.dimEmbed;
19212a4e142eSMatthew G. Knepley           qgeom.J        = &fegeom.J[q*coordDim*coordDim];
19222a4e142eSMatthew G. Knepley           qgeom.invJ     = &fegeom.invJ[q*coordDim*coordDim];
19232a4e142eSMatthew G. Knepley           qgeom.detJ     = &fegeom.detJ[q];
1924*5f80ce2aSJacob Faibussowitsch           PetscCheck(fegeom.detJ[q] > 0.0,PETSC_COMM_SELF, PETSC_ERR_ARG_OUTOFRANGE, "Invalid determinant %g for element %D, quadrature points %D", (double)fegeom.detJ[q], cell, q);
1925*5f80ce2aSJacob Faibussowitsch           if (id == PETSCFE_CLASSID)      CHKERRQ(PetscFEInterpolateGradient_Static((PetscFE) obj, 1, &x[fieldOffset], &qgeom, q, interpolant));
192698921bdaSJacob Faibussowitsch           else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", field);
19271555c271SMatthew G. Knepley           for (fc = 0; fc < Nc; ++fc) {
192853d2db2dSJoe Wallwork             const PetscReal wt = quadWeights[q*qNc+qc];
19291555c271SMatthew G. Knepley 
19304bee2e38SMatthew G. Knepley             for (d = 0; d < coordDim; ++d) grad[fc*coordDim+d] += interpolant[fc*dim+d]*wt*fegeom.detJ[q];
19311555c271SMatthew G. Knepley           }
19324bee2e38SMatthew G. Knepley           vol += quadWeights[q*qNc]*fegeom.detJ[q];
19331555c271SMatthew G. Knepley         }
19341555c271SMatthew G. Knepley         fieldOffset += Nb;
19351555c271SMatthew G. Knepley         qc          += Nc;
19361555c271SMatthew G. Knepley       }
1937*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecRestoreClosure(dm, NULL, locX, cell, NULL, &x));
1938f8527842SMatthew G. Knepley       for (fc = 0; fc < numComponents; ++fc) {
1939f8527842SMatthew G. Knepley         for (d = 0; d < coordDim; ++d) {
1940f8527842SMatthew G. Knepley           gradsum[fc*coordDim+d] += grad[fc*coordDim+d];
1941f8527842SMatthew G. Knepley         }
1942f8527842SMatthew G. Knepley       }
1943f8527842SMatthew G. Knepley       volsum += vol;
1944db1066baSMatthew G. Knepley       if (debug) {
1945*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscPrintf(PETSC_COMM_SELF, "Vertex %" PetscInt_FMT " Cell %" PetscInt_FMT " gradient: [", v, cell));
19461555c271SMatthew G. Knepley         for (fc = 0; fc < numComponents; ++fc) {
19471555c271SMatthew G. Knepley           for (d = 0; d < coordDim; ++d) {
1948*5f80ce2aSJacob Faibussowitsch             if (fc || d > 0) CHKERRQ(PetscPrintf(PETSC_COMM_SELF, ", "));
1949*5f80ce2aSJacob Faibussowitsch             CHKERRQ(PetscPrintf(PETSC_COMM_SELF, "%g", (double)PetscRealPart(grad[fc*coordDim+d])));
19501555c271SMatthew G. Knepley           }
19511555c271SMatthew G. Knepley         }
1952*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscPrintf(PETSC_COMM_SELF, "]\n"));
1953db1066baSMatthew G. Knepley       }
19541555c271SMatthew G. Knepley     }
19551555c271SMatthew G. Knepley     for (fc = 0; fc < numComponents; ++fc) {
19561555c271SMatthew G. Knepley       for (d = 0; d < coordDim; ++d) gradsum[fc*coordDim+d] /= volsum;
19571555c271SMatthew G. Knepley     }
1958*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexRestoreTransitiveClosure(dm, v, PETSC_FALSE, &starSize, &star));
1959*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecSetClosure(dmC, NULL, locC, v, gradsum, INSERT_VALUES));
19601555c271SMatthew G. Knepley   }
1961*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree6(gradsum,interpolant,coords,fegeom.detJ,fegeom.J,fegeom.invJ));
19621555c271SMatthew G. Knepley   PetscFunctionReturn(0);
19631555c271SMatthew G. Knepley }
19641555c271SMatthew G. Knepley 
1965338f77d5SMatthew G. Knepley static PetscErrorCode DMPlexComputeIntegral_Internal(DM dm, Vec X, PetscInt cStart, PetscInt cEnd, PetscScalar *cintegral, void *user)
196673d901b8SMatthew G. Knepley {
1967338f77d5SMatthew G. Knepley   DM                 dmAux = NULL;
196861aaff12SToby Isaac   PetscDS            prob,    probAux = NULL;
196973d901b8SMatthew G. Knepley   PetscSection       section, sectionAux;
1970338f77d5SMatthew G. Knepley   Vec                locX,    locA;
1971c330f8ffSToby Isaac   PetscInt           dim, numCells = cEnd - cStart, c, f;
1972c330f8ffSToby Isaac   PetscBool          useFVM = PETSC_FALSE;
1973338f77d5SMatthew G. Knepley   /* DS */
1974338f77d5SMatthew G. Knepley   PetscInt           Nf,    totDim,    *uOff, *uOff_x, numConstants;
1975338f77d5SMatthew G. Knepley   PetscInt           NfAux, totDimAux, *aOff;
1976338f77d5SMatthew G. Knepley   PetscScalar       *u, *a;
1977338f77d5SMatthew G. Knepley   const PetscScalar *constants;
1978338f77d5SMatthew G. Knepley   /* Geometry */
1979c330f8ffSToby Isaac   PetscFEGeom       *cgeomFEM;
1980338f77d5SMatthew G. Knepley   DM                 dmGrad;
1981c330f8ffSToby Isaac   PetscQuadrature    affineQuad = NULL;
1982338f77d5SMatthew G. Knepley   Vec                cellGeometryFVM = NULL, faceGeometryFVM = NULL, locGrad = NULL;
1983b5a3613cSMatthew G. Knepley   PetscFVCellGeom   *cgeomFVM;
1984338f77d5SMatthew G. Knepley   const PetscScalar *lgrad;
1985b7260050SToby Isaac   PetscInt           maxDegree;
1986c330f8ffSToby Isaac   DMField            coordField;
1987c330f8ffSToby Isaac   IS                 cellIS;
198873d901b8SMatthew G. Knepley 
198973d901b8SMatthew G. Knepley   PetscFunctionBegin;
1990*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDS(dm, &prob));
1991*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dm, &dim));
1992*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &section));
1993*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetNumFields(dm, &Nf));
1994338f77d5SMatthew G. Knepley   /* Determine which discretizations we have */
1995b5a3613cSMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
1996b5a3613cSMatthew G. Knepley     PetscObject  obj;
1997b5a3613cSMatthew G. Knepley     PetscClassId id;
1998b5a3613cSMatthew G. Knepley 
1999*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, f, &obj));
2000*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
2001338f77d5SMatthew G. Knepley     if (id == PETSCFV_CLASSID) useFVM = PETSC_TRUE;
2002338f77d5SMatthew G. Knepley   }
2003338f77d5SMatthew G. Knepley   /* Get local solution with boundary values */
2004*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalVector(dm, &locX));
2005*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexInsertBoundaryValues(dm, PETSC_TRUE, locX, 0.0, NULL, NULL, NULL));
2006*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGlobalToLocalBegin(dm, X, INSERT_VALUES, locX));
2007*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGlobalToLocalEnd(dm, X, INSERT_VALUES, locX));
2008338f77d5SMatthew G. Knepley   /* Read DS information */
2009*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetTotalDimension(prob, &totDim));
2010*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetComponentOffsets(prob, &uOff));
2011*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetComponentDerivativeOffsets(prob, &uOff_x));
2012*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISCreateStride(PETSC_COMM_SELF,numCells,cStart,1,&cellIS));
2013*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetConstants(prob, &numConstants, &constants));
2014338f77d5SMatthew G. Knepley   /* Read Auxiliary DS information */
2015*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetAuxiliaryVec(dm, NULL, 0, 0, &locA));
20169a2a23afSMatthew G. Knepley   if (locA) {
2017*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetDM(locA, &dmAux));
2018*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetDS(dmAux, &probAux));
2019*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetNumFields(probAux, &NfAux));
2020*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetLocalSection(dmAux, &sectionAux));
2021*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetTotalDimension(probAux, &totDimAux));
2022*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetComponentOffsets(probAux, &aOff));
2023338f77d5SMatthew G. Knepley   }
2024338f77d5SMatthew G. Knepley   /* Allocate data  arrays */
2025*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscCalloc1(numCells*totDim, &u));
2026*5f80ce2aSJacob Faibussowitsch   if (dmAux) CHKERRQ(PetscMalloc1(numCells*totDimAux, &a));
2027338f77d5SMatthew G. Knepley   /* Read out geometry */
2028*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateField(dm,&coordField));
2029*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMFieldGetDegree(coordField,cellIS,NULL,&maxDegree));
2030b7260050SToby Isaac   if (maxDegree <= 1) {
2031*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMFieldCreateDefaultQuadrature(coordField,cellIS,&affineQuad));
2032c330f8ffSToby Isaac     if (affineQuad) {
2033*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMFieldCreateFEGeom(coordField,cellIS,affineQuad,PETSC_FALSE,&cgeomFEM));
2034338f77d5SMatthew G. Knepley     }
2035b5a3613cSMatthew G. Knepley   }
2036b5a3613cSMatthew G. Knepley   if (useFVM) {
2037338f77d5SMatthew G. Knepley     PetscFV   fv = NULL;
2038b5a3613cSMatthew G. Knepley     Vec       grad;
2039b5a3613cSMatthew G. Knepley     PetscInt  fStart, fEnd;
2040b5a3613cSMatthew G. Knepley     PetscBool compGrad;
2041b5a3613cSMatthew G. Knepley 
2042338f77d5SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
2043338f77d5SMatthew G. Knepley       PetscObject  obj;
2044338f77d5SMatthew G. Knepley       PetscClassId id;
2045338f77d5SMatthew G. Knepley 
2046*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetDiscretization(prob, f, &obj));
2047*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscObjectGetClassId(obj, &id));
2048338f77d5SMatthew G. Knepley       if (id == PETSCFV_CLASSID) {fv = (PetscFV) obj; break;}
2049338f77d5SMatthew G. Knepley     }
2050*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFVGetComputeGradients(fv, &compGrad));
2051*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFVSetComputeGradients(fv, PETSC_TRUE));
2052*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexComputeGeometryFVM(dm, &cellGeometryFVM, &faceGeometryFVM));
2053*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexComputeGradientFVM(dm, fv, faceGeometryFVM, cellGeometryFVM, &dmGrad));
2054*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFVSetComputeGradients(fv, compGrad));
2055*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetArrayRead(cellGeometryFVM, (const PetscScalar **) &cgeomFVM));
2056b5a3613cSMatthew G. Knepley     /* Reconstruct and limit cell gradients */
2057*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexGetHeightStratum(dm, 1, &fStart, &fEnd));
2058*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetGlobalVector(dmGrad, &grad));
2059*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexReconstructGradients_Internal(dm, fv, fStart, fEnd, faceGeometryFVM, cellGeometryFVM, locX, grad));
2060b5a3613cSMatthew G. Knepley     /* Communicate gradient values */
2061*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetLocalVector(dmGrad, &locGrad));
2062*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGlobalToLocalBegin(dmGrad, grad, INSERT_VALUES, locGrad));
2063*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGlobalToLocalEnd(dmGrad, grad, INSERT_VALUES, locGrad));
2064*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMRestoreGlobalVector(dmGrad, &grad));
2065b5a3613cSMatthew G. Knepley     /* Handle non-essential (e.g. outflow) boundary values */
2066*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexInsertBoundaryValues(dm, PETSC_FALSE, locX, 0.0, faceGeometryFVM, cellGeometryFVM, locGrad));
2067*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetArrayRead(locGrad, &lgrad));
2068b5a3613cSMatthew G. Knepley   }
2069338f77d5SMatthew G. Knepley   /* Read out data from inputs */
207073d901b8SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
207173d901b8SMatthew G. Knepley     PetscScalar *x = NULL;
207273d901b8SMatthew G. Knepley     PetscInt     i;
207373d901b8SMatthew G. Knepley 
2074*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecGetClosure(dm, section, locX, c, NULL, &x));
20750f2d7e86SMatthew G. Knepley     for (i = 0; i < totDim; ++i) u[c*totDim+i] = x[i];
2076*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecRestoreClosure(dm, section, locX, c, NULL, &x));
207773d901b8SMatthew G. Knepley     if (dmAux) {
2078*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecGetClosure(dmAux, sectionAux, locA, c, NULL, &x));
20790f2d7e86SMatthew G. Knepley       for (i = 0; i < totDimAux; ++i) a[c*totDimAux+i] = x[i];
2080*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecRestoreClosure(dmAux, sectionAux, locA, c, NULL, &x));
208173d901b8SMatthew G. Knepley     }
208273d901b8SMatthew G. Knepley   }
2083338f77d5SMatthew G. Knepley   /* Do integration for each field */
208473d901b8SMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
2085c1f031eeSMatthew G. Knepley     PetscObject  obj;
2086c1f031eeSMatthew G. Knepley     PetscClassId id;
2087c1f031eeSMatthew G. Knepley     PetscInt     numChunks, numBatches, batchSize, numBlocks, blockSize, Ne, Nr, offset;
208873d901b8SMatthew G. Knepley 
2089*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, f, &obj));
2090*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
2091c1f031eeSMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
2092c1f031eeSMatthew G. Knepley       PetscFE         fe = (PetscFE) obj;
2093c1f031eeSMatthew G. Knepley       PetscQuadrature q;
2094c330f8ffSToby Isaac       PetscFEGeom     *chunkGeom = NULL;
2095c1f031eeSMatthew G. Knepley       PetscInt        Nq, Nb;
2096c1f031eeSMatthew G. Knepley 
2097*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
2098*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetQuadrature(fe, &q));
2099*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscQuadratureGetData(q, NULL, NULL, &Nq, NULL, NULL));
2100*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetDimension(fe, &Nb));
2101c1f031eeSMatthew G. Knepley       blockSize = Nb*Nq;
210273d901b8SMatthew G. Knepley       batchSize = numBlocks * blockSize;
2103*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
210473d901b8SMatthew G. Knepley       numChunks = numCells / (numBatches*batchSize);
210573d901b8SMatthew G. Knepley       Ne        = numChunks*numBatches*batchSize;
210673d901b8SMatthew G. Knepley       Nr        = numCells % (numBatches*batchSize);
210773d901b8SMatthew G. Knepley       offset    = numCells - Nr;
2108c330f8ffSToby Isaac       if (!affineQuad) {
2109*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMFieldCreateFEGeom(coordField,cellIS,q,PETSC_FALSE,&cgeomFEM));
2110c330f8ffSToby Isaac       }
2111*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomGetChunk(cgeomFEM,0,offset,&chunkGeom));
2112*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEIntegrate(prob, f, Ne, chunkGeom, u, probAux, a, cintegral));
2113*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomGetChunk(cgeomFEM,offset,numCells,&chunkGeom));
2114*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEIntegrate(prob, f, Nr, chunkGeom, &u[offset*totDim], probAux, &a[offset*totDimAux], &cintegral[offset*Nf]));
2115*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomRestoreChunk(cgeomFEM,offset,numCells,&chunkGeom));
2116c330f8ffSToby Isaac       if (!affineQuad) {
2117*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGeomDestroy(&cgeomFEM));
2118c330f8ffSToby Isaac       }
2119c1f031eeSMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
2120c1f031eeSMatthew G. Knepley       PetscInt       foff;
2121420e96edSMatthew G. Knepley       PetscPointFunc obj_func;
2122b69edc29SMatthew G. Knepley       PetscScalar    lint;
2123c1f031eeSMatthew G. Knepley 
2124*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetObjective(prob, f, &obj_func));
2125*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetFieldOffset(prob, f, &foff));
2126c1f031eeSMatthew G. Knepley       if (obj_func) {
2127c1f031eeSMatthew G. Knepley         for (c = 0; c < numCells; ++c) {
2128b5a3613cSMatthew G. Knepley           PetscScalar *u_x;
2129b5a3613cSMatthew G. Knepley 
2130*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexPointLocalRead(dmGrad, c, lgrad, &u_x));
2131338f77d5SMatthew G. Knepley           obj_func(dim, Nf, NfAux, uOff, uOff_x, &u[totDim*c+foff], NULL, u_x, aOff, NULL, &a[totDimAux*c], NULL, NULL, 0.0, cgeomFVM[c].centroid, numConstants, constants, &lint);
2132338f77d5SMatthew G. Knepley           cintegral[c*Nf+f] += PetscRealPart(lint)*cgeomFVM[c].volume;
213373d901b8SMatthew G. Knepley         }
2134c1f031eeSMatthew G. Knepley       }
213598921bdaSJacob Faibussowitsch     } else SETERRQ(PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", f);
2136c1f031eeSMatthew G. Knepley   }
2137338f77d5SMatthew G. Knepley   /* Cleanup data arrays */
2138b5a3613cSMatthew G. Knepley   if (useFVM) {
2139*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecRestoreArrayRead(locGrad, &lgrad));
2140*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecRestoreArrayRead(cellGeometryFVM, (const PetscScalar **) &cgeomFVM));
2141*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMRestoreLocalVector(dmGrad, &locGrad));
2142*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecDestroy(&faceGeometryFVM));
2143*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecDestroy(&cellGeometryFVM));
2144*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMDestroy(&dmGrad));
2145b5a3613cSMatthew G. Knepley   }
2146*5f80ce2aSJacob Faibussowitsch   if (dmAux) CHKERRQ(PetscFree(a));
2147*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree(u));
2148338f77d5SMatthew G. Knepley   /* Cleanup */
2149f99c8401SToby Isaac   if (affineQuad) {
2150*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGeomDestroy(&cgeomFEM));
2151f99c8401SToby Isaac   }
2152*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscQuadratureDestroy(&affineQuad));
2153*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISDestroy(&cellIS));
2154*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreLocalVector(dm, &locX));
2155338f77d5SMatthew G. Knepley   PetscFunctionReturn(0);
2156338f77d5SMatthew G. Knepley }
2157338f77d5SMatthew G. Knepley 
2158338f77d5SMatthew G. Knepley /*@
2159338f77d5SMatthew G. Knepley   DMPlexComputeIntegralFEM - Form the integral over the domain from the global input X using pointwise functions specified by the user
2160338f77d5SMatthew G. Knepley 
2161338f77d5SMatthew G. Knepley   Input Parameters:
2162338f77d5SMatthew G. Knepley + dm - The mesh
2163338f77d5SMatthew G. Knepley . X  - Global input vector
2164338f77d5SMatthew G. Knepley - user - The user context
2165338f77d5SMatthew G. Knepley 
2166338f77d5SMatthew G. Knepley   Output Parameter:
2167338f77d5SMatthew G. Knepley . integral - Integral for each field
2168338f77d5SMatthew G. Knepley 
2169338f77d5SMatthew G. Knepley   Level: developer
2170338f77d5SMatthew G. Knepley 
2171446c23c1SPierre Jolivet .seealso: DMPlexSNESComputeResidualFEM()
2172338f77d5SMatthew G. Knepley @*/
2173b8feb594SMatthew G. Knepley PetscErrorCode DMPlexComputeIntegralFEM(DM dm, Vec X, PetscScalar *integral, void *user)
2174338f77d5SMatthew G. Knepley {
2175338f77d5SMatthew G. Knepley   DM_Plex       *mesh = (DM_Plex *) dm->data;
2176b8feb594SMatthew G. Knepley   PetscScalar   *cintegral, *lintegral;
2177412e9a14SMatthew G. Knepley   PetscInt       Nf, f, cellHeight, cStart, cEnd, cell;
2178338f77d5SMatthew G. Knepley 
2179338f77d5SMatthew G. Knepley   PetscFunctionBegin;
2180338f77d5SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
2181338f77d5SMatthew G. Knepley   PetscValidHeaderSpecific(X, VEC_CLASSID, 2);
2182338f77d5SMatthew G. Knepley   PetscValidPointer(integral, 3);
2183*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventBegin(DMPLEX_IntegralFEM,dm,0,0,0));
2184*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetNumFields(dm, &Nf));
2185*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetVTKCellHeight(dm, &cellHeight));
2186*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetSimplexOrBoxCells(dm, cellHeight, &cStart, &cEnd));
2187338f77d5SMatthew G. Knepley   /* TODO Introduce a loop over large chunks (right now this is a single chunk) */
2188*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscCalloc2(Nf, &lintegral, (cEnd-cStart)*Nf, &cintegral));
2189*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexComputeIntegral_Internal(dm, X, cStart, cEnd, cintegral, user));
2190338f77d5SMatthew G. Knepley   /* Sum up values */
2191338f77d5SMatthew G. Knepley   for (cell = cStart; cell < cEnd; ++cell) {
2192338f77d5SMatthew G. Knepley     const PetscInt c = cell - cStart;
2193338f77d5SMatthew G. Knepley 
2194*5f80ce2aSJacob Faibussowitsch     if (mesh->printFEM > 1) CHKERRQ(DMPrintCellVector(cell, "Cell Integral", Nf, &cintegral[c*Nf]));
2195b8feb594SMatthew G. Knepley     for (f = 0; f < Nf; ++f) lintegral[f] += cintegral[c*Nf+f];
2196338f77d5SMatthew G. Knepley   }
2197*5f80ce2aSJacob Faibussowitsch   CHKERRMPI(MPIU_Allreduce(lintegral, integral, Nf, MPIU_SCALAR, MPIU_SUM, PetscObjectComm((PetscObject) dm)));
219873d901b8SMatthew G. Knepley   if (mesh->printFEM) {
2199*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscPrintf(PetscObjectComm((PetscObject) dm), "Integral:"));
2200*5f80ce2aSJacob Faibussowitsch     for (f = 0; f < Nf; ++f) CHKERRQ(PetscPrintf(PetscObjectComm((PetscObject) dm), " %g", (double) PetscRealPart(integral[f])));
2201*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscPrintf(PetscObjectComm((PetscObject) dm), "\n"));
220273d901b8SMatthew G. Knepley   }
2203*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree2(lintegral, cintegral));
2204*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventEnd(DMPLEX_IntegralFEM,dm,0,0,0));
2205338f77d5SMatthew G. Knepley   PetscFunctionReturn(0);
2206338f77d5SMatthew G. Knepley }
2207338f77d5SMatthew G. Knepley 
2208338f77d5SMatthew G. Knepley /*@
2209338f77d5SMatthew G. Knepley   DMPlexComputeCellwiseIntegralFEM - Form the vector of cellwise integrals F from the global input X using pointwise functions specified by the user
2210338f77d5SMatthew G. Knepley 
2211338f77d5SMatthew G. Knepley   Input Parameters:
2212338f77d5SMatthew G. Knepley + dm - The mesh
2213338f77d5SMatthew G. Knepley . X  - Global input vector
2214338f77d5SMatthew G. Knepley - user - The user context
2215338f77d5SMatthew G. Knepley 
2216338f77d5SMatthew G. Knepley   Output Parameter:
2217338f77d5SMatthew G. Knepley . integral - Cellwise integrals for each field
2218338f77d5SMatthew G. Knepley 
2219338f77d5SMatthew G. Knepley   Level: developer
2220338f77d5SMatthew G. Knepley 
2221446c23c1SPierre Jolivet .seealso: DMPlexSNESComputeResidualFEM()
2222338f77d5SMatthew G. Knepley @*/
2223338f77d5SMatthew G. Knepley PetscErrorCode DMPlexComputeCellwiseIntegralFEM(DM dm, Vec X, Vec F, void *user)
2224338f77d5SMatthew G. Knepley {
2225338f77d5SMatthew G. Knepley   DM_Plex       *mesh = (DM_Plex *) dm->data;
2226338f77d5SMatthew G. Knepley   DM             dmF;
2227338f77d5SMatthew G. Knepley   PetscSection   sectionF;
2228338f77d5SMatthew G. Knepley   PetscScalar   *cintegral, *af;
2229412e9a14SMatthew G. Knepley   PetscInt       Nf, f, cellHeight, cStart, cEnd, cell;
2230338f77d5SMatthew G. Knepley 
2231338f77d5SMatthew G. Knepley   PetscFunctionBegin;
2232338f77d5SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
2233338f77d5SMatthew G. Knepley   PetscValidHeaderSpecific(X, VEC_CLASSID, 2);
2234338f77d5SMatthew G. Knepley   PetscValidHeaderSpecific(F, VEC_CLASSID, 3);
2235*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventBegin(DMPLEX_IntegralFEM,dm,0,0,0));
2236*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetNumFields(dm, &Nf));
2237*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetVTKCellHeight(dm, &cellHeight));
2238*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetSimplexOrBoxCells(dm, cellHeight, &cStart, &cEnd));
2239338f77d5SMatthew G. Knepley   /* TODO Introduce a loop over large chunks (right now this is a single chunk) */
2240*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscCalloc1((cEnd-cStart)*Nf, &cintegral));
2241*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexComputeIntegral_Internal(dm, X, cStart, cEnd, cintegral, user));
2242338f77d5SMatthew G. Knepley   /* Put values in F*/
2243*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetDM(F, &dmF));
2244*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dmF, &sectionF));
2245*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetArray(F, &af));
2246338f77d5SMatthew G. Knepley   for (cell = cStart; cell < cEnd; ++cell) {
2247338f77d5SMatthew G. Knepley     const PetscInt c = cell - cStart;
2248338f77d5SMatthew G. Knepley     PetscInt       dof, off;
2249338f77d5SMatthew G. Knepley 
2250*5f80ce2aSJacob Faibussowitsch     if (mesh->printFEM > 1) CHKERRQ(DMPrintCellVector(cell, "Cell Integral", Nf, &cintegral[c*Nf]));
2251*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscSectionGetDof(sectionF, cell, &dof));
2252*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscSectionGetOffset(sectionF, cell, &off));
2253*5f80ce2aSJacob Faibussowitsch     PetscCheck(dof == Nf,PETSC_COMM_SELF, PETSC_ERR_ARG_SIZ, "The number of cell dofs %D != %D", dof, Nf);
2254338f77d5SMatthew G. Knepley     for (f = 0; f < Nf; ++f) af[off+f] = cintegral[c*Nf+f];
2255338f77d5SMatthew G. Knepley   }
2256*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecRestoreArray(F, &af));
2257*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree(cintegral));
2258*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventEnd(DMPLEX_IntegralFEM,dm,0,0,0));
225973d901b8SMatthew G. Knepley   PetscFunctionReturn(0);
226073d901b8SMatthew G. Knepley }
226173d901b8SMatthew G. Knepley 
22629b6f715bSMatthew G. Knepley static PetscErrorCode DMPlexComputeBdIntegral_Internal(DM dm, Vec locX, IS pointIS,
22639b6f715bSMatthew G. Knepley                                                        void (*func)(PetscInt, PetscInt, PetscInt,
226464c72086SMatthew G. Knepley                                                                     const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
226564c72086SMatthew G. Knepley                                                                     const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
226664c72086SMatthew G. Knepley                                                                     PetscReal, const PetscReal[], const PetscReal[], PetscInt, const PetscScalar[], PetscScalar[]),
226764c72086SMatthew G. Knepley                                                        PetscScalar *fintegral, void *user)
226864c72086SMatthew G. Knepley {
22699b6f715bSMatthew G. Knepley   DM                 plex = NULL, plexA = NULL;
2270a6e0b375SMatthew G. Knepley   DMEnclosureType    encAux;
22719b6f715bSMatthew G. Knepley   PetscDS            prob, probAux = NULL;
22729b6f715bSMatthew G. Knepley   PetscSection       section, sectionAux = NULL;
22739b6f715bSMatthew G. Knepley   Vec                locA = NULL;
22749b6f715bSMatthew G. Knepley   DMField            coordField;
22759b6f715bSMatthew G. Knepley   PetscInt           Nf,        totDim,        *uOff, *uOff_x;
22769b6f715bSMatthew G. Knepley   PetscInt           NfAux = 0, totDimAux = 0, *aOff = NULL;
22779b6f715bSMatthew G. Knepley   PetscScalar       *u, *a = NULL;
227864c72086SMatthew G. Knepley   const PetscScalar *constants;
22799b6f715bSMatthew G. Knepley   PetscInt           numConstants, f;
228064c72086SMatthew G. Knepley 
228164c72086SMatthew G. Knepley   PetscFunctionBegin;
2282*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateField(dm, &coordField));
2283*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMConvert(dm, DMPLEX, &plex));
2284*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDS(dm, &prob));
2285*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &section));
2286*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetNumFields(section, &Nf));
228764c72086SMatthew G. Knepley   /* Determine which discretizations we have */
22889b6f715bSMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
228964c72086SMatthew G. Knepley     PetscObject  obj;
229064c72086SMatthew G. Knepley     PetscClassId id;
229164c72086SMatthew G. Knepley 
2292*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, f, &obj));
2293*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
2294*5f80ce2aSJacob Faibussowitsch     PetscCheck(id != PETSCFV_CLASSID,PetscObjectComm((PetscObject) dm), PETSC_ERR_SUP, "Not supported for FVM (field %D)", f);
229564c72086SMatthew G. Knepley   }
229664c72086SMatthew G. Knepley   /* Read DS information */
2297*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetTotalDimension(prob, &totDim));
2298*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetComponentOffsets(prob, &uOff));
2299*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetComponentDerivativeOffsets(prob, &uOff_x));
2300*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetConstants(prob, &numConstants, &constants));
230164c72086SMatthew G. Knepley   /* Read Auxiliary DS information */
2302*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetAuxiliaryVec(dm, NULL, 0, 0, &locA));
23039b6f715bSMatthew G. Knepley   if (locA) {
23049b6f715bSMatthew G. Knepley     DM dmAux;
23059b6f715bSMatthew G. Knepley 
2306*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetDM(locA, &dmAux));
2307*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetEnclosureRelation(dmAux, dm, &encAux));
2308*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMConvert(dmAux, DMPLEX, &plexA));
2309*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetDS(dmAux, &probAux));
2310*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetNumFields(probAux, &NfAux));
2311*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetLocalSection(dmAux, &sectionAux));
2312*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetTotalDimension(probAux, &totDimAux));
2313*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetComponentOffsets(probAux, &aOff));
231464c72086SMatthew G. Knepley   }
23159b6f715bSMatthew G. Knepley   /* Integrate over points */
23169b6f715bSMatthew G. Knepley   {
23179b6f715bSMatthew G. Knepley     PetscFEGeom    *fgeom, *chunkGeom = NULL;
2318b7260050SToby Isaac     PetscInt        maxDegree;
23199b6f715bSMatthew G. Knepley     PetscQuadrature qGeom = NULL;
23209b6f715bSMatthew G. Knepley     const PetscInt *points;
23219b6f715bSMatthew G. Knepley     PetscInt        numFaces, face, Nq, field;
23229b6f715bSMatthew G. Knepley     PetscInt        numChunks, chunkSize, chunk, Nr, offset;
232364c72086SMatthew G. Knepley 
2324*5f80ce2aSJacob Faibussowitsch     CHKERRQ(ISGetLocalSize(pointIS, &numFaces));
2325*5f80ce2aSJacob Faibussowitsch     CHKERRQ(ISGetIndices(pointIS, &points));
2326*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscCalloc2(numFaces*totDim, &u, locA ? numFaces*totDimAux : 0, &a));
2327*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMFieldGetDegree(coordField, pointIS, NULL, &maxDegree));
232864c72086SMatthew G. Knepley     for (field = 0; field < Nf; ++field) {
232964c72086SMatthew G. Knepley       PetscFE fe;
233064c72086SMatthew G. Knepley 
2331*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetDiscretization(prob, field, (PetscObject *) &fe));
2332*5f80ce2aSJacob Faibussowitsch       if (maxDegree <= 1) CHKERRQ(DMFieldCreateDefaultQuadrature(coordField, pointIS, &qGeom));
23339b6f715bSMatthew G. Knepley       if (!qGeom) {
2334*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGetFaceQuadrature(fe, &qGeom));
2335*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscObjectReference((PetscObject) qGeom));
23369b6f715bSMatthew G. Knepley       }
2337*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscQuadratureGetData(qGeom, NULL, NULL, &Nq, NULL, NULL));
2338*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetFEGeom(coordField, pointIS, qGeom, PETSC_TRUE, &fgeom));
23399b6f715bSMatthew G. Knepley       for (face = 0; face < numFaces; ++face) {
2340f15274beSMatthew Knepley         const PetscInt point = points[face], *support;
23419b6f715bSMatthew G. Knepley         PetscScalar    *x    = NULL;
2342f15274beSMatthew Knepley         PetscInt       i;
23439b6f715bSMatthew G. Knepley 
2344*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexGetSupport(dm, point, &support));
2345*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecGetClosure(plex, section, locX, support[0], NULL, &x));
23469b6f715bSMatthew G. Knepley         for (i = 0; i < totDim; ++i) u[face*totDim+i] = x[i];
2347*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecRestoreClosure(plex, section, locX, support[0], NULL, &x));
23489b6f715bSMatthew G. Knepley         if (locA) {
23499b6f715bSMatthew G. Knepley           PetscInt subp;
2350*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMGetEnclosurePoint(plexA, dm, encAux, support[0], &subp));
2351*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexVecGetClosure(plexA, sectionAux, locA, subp, NULL, &x));
23529b6f715bSMatthew G. Knepley           for (i = 0; i < totDimAux; ++i) a[f*totDimAux+i] = x[i];
2353*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexVecRestoreClosure(plexA, sectionAux, locA, subp, NULL, &x));
23549b6f715bSMatthew G. Knepley         }
23559b6f715bSMatthew G. Knepley       }
23569b6f715bSMatthew G. Knepley       /* Get blocking */
23579b6f715bSMatthew G. Knepley       {
23589b6f715bSMatthew G. Knepley         PetscQuadrature q;
23599b6f715bSMatthew G. Knepley         PetscInt        numBatches, batchSize, numBlocks, blockSize;
23609b6f715bSMatthew G. Knepley         PetscInt        Nq, Nb;
23619b6f715bSMatthew G. Knepley 
2362*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
2363*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGetQuadrature(fe, &q));
2364*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscQuadratureGetData(q, NULL, NULL, &Nq, NULL, NULL));
2365*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGetDimension(fe, &Nb));
236664c72086SMatthew G. Knepley         blockSize = Nb*Nq;
236764c72086SMatthew G. Knepley         batchSize = numBlocks * blockSize;
23689b6f715bSMatthew G. Knepley         chunkSize = numBatches*batchSize;
2369*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
23709b6f715bSMatthew G. Knepley         numChunks = numFaces / chunkSize;
23719b6f715bSMatthew G. Knepley         Nr        = numFaces % chunkSize;
237264c72086SMatthew G. Knepley         offset    = numFaces - Nr;
237364c72086SMatthew G. Knepley       }
23749b6f715bSMatthew G. Knepley       /* Do integration for each field */
23759b6f715bSMatthew G. Knepley       for (chunk = 0; chunk < numChunks; ++chunk) {
2376*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGeomGetChunk(fgeom, chunk*chunkSize, (chunk+1)*chunkSize, &chunkGeom));
2377*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEIntegrateBd(prob, field, func, chunkSize, chunkGeom, u, probAux, a, fintegral));
2378*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGeomRestoreChunk(fgeom, 0, offset, &chunkGeom));
237964c72086SMatthew G. Knepley       }
2380*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomGetChunk(fgeom, offset, numFaces, &chunkGeom));
2381*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEIntegrateBd(prob, field, func, Nr, chunkGeom, &u[offset*totDim], probAux, a ? &a[offset*totDimAux] : NULL, &fintegral[offset*Nf]));
2382*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomRestoreChunk(fgeom, offset, numFaces, &chunkGeom));
238364c72086SMatthew G. Knepley       /* Cleanup data arrays */
2384*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexRestoreFEGeom(coordField, pointIS, qGeom, PETSC_TRUE, &fgeom));
2385*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscQuadratureDestroy(&qGeom));
2386*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFree2(u, a));
2387*5f80ce2aSJacob Faibussowitsch       CHKERRQ(ISRestoreIndices(pointIS, &points));
238864c72086SMatthew G. Knepley     }
238964c72086SMatthew G. Knepley   }
2390*5f80ce2aSJacob Faibussowitsch   if (plex)  CHKERRQ(DMDestroy(&plex));
2391*5f80ce2aSJacob Faibussowitsch   if (plexA) CHKERRQ(DMDestroy(&plexA));
23929b6f715bSMatthew G. Knepley   PetscFunctionReturn(0);
23939b6f715bSMatthew G. Knepley }
23949b6f715bSMatthew G. Knepley 
23959b6f715bSMatthew G. Knepley /*@
23969b6f715bSMatthew G. Knepley   DMPlexComputeBdIntegral - Form the integral over the specified boundary from the global input X using pointwise functions specified by the user
23979b6f715bSMatthew G. Knepley 
23989b6f715bSMatthew G. Knepley   Input Parameters:
23999b6f715bSMatthew G. Knepley + dm      - The mesh
24009b6f715bSMatthew G. Knepley . X       - Global input vector
24019b6f715bSMatthew G. Knepley . label   - The boundary DMLabel
24029b6f715bSMatthew G. Knepley . numVals - The number of label values to use, or PETSC_DETERMINE for all values
24039b6f715bSMatthew G. Knepley . vals    - The label values to use, or PETSC_NULL for all values
240467b8a455SSatish Balay . func    - The function to integrate along the boundary
24059b6f715bSMatthew G. Knepley - user    - The user context
24069b6f715bSMatthew G. Knepley 
24079b6f715bSMatthew G. Knepley   Output Parameter:
24089b6f715bSMatthew G. Knepley . integral - Integral for each field
24099b6f715bSMatthew G. Knepley 
24109b6f715bSMatthew G. Knepley   Level: developer
24119b6f715bSMatthew G. Knepley 
24129b6f715bSMatthew G. Knepley .seealso: DMPlexComputeIntegralFEM(), DMPlexComputeBdResidualFEM()
24139b6f715bSMatthew G. Knepley @*/
24149b6f715bSMatthew G. Knepley PetscErrorCode DMPlexComputeBdIntegral(DM dm, Vec X, DMLabel label, PetscInt numVals, const PetscInt vals[],
24159b6f715bSMatthew G. Knepley                                        void (*func)(PetscInt, PetscInt, PetscInt,
24169b6f715bSMatthew G. Knepley                                                     const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
24179b6f715bSMatthew G. Knepley                                                     const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
24189b6f715bSMatthew G. Knepley                                                     PetscReal, const PetscReal[], const PetscReal[], PetscInt, const PetscScalar[], PetscScalar[]),
24199b6f715bSMatthew G. Knepley                                        PetscScalar *integral, void *user)
24209b6f715bSMatthew G. Knepley {
24219b6f715bSMatthew G. Knepley   Vec            locX;
24229b6f715bSMatthew G. Knepley   PetscSection   section;
24239b6f715bSMatthew G. Knepley   DMLabel        depthLabel;
24249b6f715bSMatthew G. Knepley   IS             facetIS;
24259b6f715bSMatthew G. Knepley   PetscInt       dim, Nf, f, v;
24269b6f715bSMatthew G. Knepley 
24279b6f715bSMatthew G. Knepley   PetscFunctionBegin;
24289b6f715bSMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
24299b6f715bSMatthew G. Knepley   PetscValidHeaderSpecific(X, VEC_CLASSID, 2);
24309b6f715bSMatthew G. Knepley   PetscValidPointer(label, 3);
24319b6f715bSMatthew G. Knepley   if (vals) PetscValidPointer(vals, 5);
2432064a246eSJacob Faibussowitsch   PetscValidPointer(integral, 7);
2433*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventBegin(DMPLEX_IntegralFEM,dm,0,0,0));
2434*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetDepthLabel(dm, &depthLabel));
2435*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dm, &dim));
2436*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMLabelGetStratumIS(depthLabel, dim-1, &facetIS));
2437*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &section));
2438*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetNumFields(section, &Nf));
24399b6f715bSMatthew G. Knepley   /* Get local solution with boundary values */
2440*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalVector(dm, &locX));
2441*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexInsertBoundaryValues(dm, PETSC_TRUE, locX, 0.0, NULL, NULL, NULL));
2442*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGlobalToLocalBegin(dm, X, INSERT_VALUES, locX));
2443*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGlobalToLocalEnd(dm, X, INSERT_VALUES, locX));
24449b6f715bSMatthew G. Knepley   /* Loop over label values */
2445*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscArrayzero(integral, Nf));
24469b6f715bSMatthew G. Knepley   for (v = 0; v < numVals; ++v) {
24479b6f715bSMatthew G. Knepley     IS           pointIS;
24489b6f715bSMatthew G. Knepley     PetscInt     numFaces, face;
24499b6f715bSMatthew G. Knepley     PetscScalar *fintegral;
24509b6f715bSMatthew G. Knepley 
2451*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMLabelGetStratumIS(label, vals[v], &pointIS));
24529b6f715bSMatthew G. Knepley     if (!pointIS) continue; /* No points with that id on this process */
24539b6f715bSMatthew G. Knepley     {
24549b6f715bSMatthew G. Knepley       IS isectIS;
24559b6f715bSMatthew G. Knepley 
24569b6f715bSMatthew G. Knepley       /* TODO: Special cases of ISIntersect where it is quick to check a priori if one is a superset of the other */
2457*5f80ce2aSJacob Faibussowitsch       CHKERRQ(ISIntersect_Caching_Internal(facetIS, pointIS, &isectIS));
2458*5f80ce2aSJacob Faibussowitsch       CHKERRQ(ISDestroy(&pointIS));
24599b6f715bSMatthew G. Knepley       pointIS = isectIS;
24609b6f715bSMatthew G. Knepley     }
2461*5f80ce2aSJacob Faibussowitsch     CHKERRQ(ISGetLocalSize(pointIS, &numFaces));
2462*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscCalloc1(numFaces*Nf, &fintegral));
2463*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexComputeBdIntegral_Internal(dm, locX, pointIS, func, fintegral, user));
24649b6f715bSMatthew G. Knepley     /* Sum point contributions into integral */
24659b6f715bSMatthew G. Knepley     for (f = 0; f < Nf; ++f) for (face = 0; face < numFaces; ++face) integral[f] += fintegral[face*Nf+f];
2466*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFree(fintegral));
2467*5f80ce2aSJacob Faibussowitsch     CHKERRQ(ISDestroy(&pointIS));
24689b6f715bSMatthew G. Knepley   }
2469*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreLocalVector(dm, &locX));
2470*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISDestroy(&facetIS));
2471*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventEnd(DMPLEX_IntegralFEM,dm,0,0,0));
247264c72086SMatthew G. Knepley   PetscFunctionReturn(0);
247364c72086SMatthew G. Knepley }
247464c72086SMatthew G. Knepley 
2475d69c5d34SMatthew G. Knepley /*@
2476cf51de39SMatthew G. Knepley   DMPlexComputeInterpolatorNested - Form the local portion of the interpolation matrix I from the coarse DM to a uniformly refined DM.
2477d69c5d34SMatthew G. Knepley 
2478d69c5d34SMatthew G. Knepley   Input Parameters:
2479cf51de39SMatthew G. Knepley + dmc  - The coarse mesh
2480cf51de39SMatthew G. Knepley . dmf  - The fine mesh
2481cf51de39SMatthew G. Knepley . isRefined - Flag indicating regular refinement, rather than the same topology
2482d69c5d34SMatthew G. Knepley - user - The user context
2483d69c5d34SMatthew G. Knepley 
2484d69c5d34SMatthew G. Knepley   Output Parameter:
2485934789fcSMatthew G. Knepley . In  - The interpolation matrix
2486d69c5d34SMatthew G. Knepley 
2487d69c5d34SMatthew G. Knepley   Level: developer
2488d69c5d34SMatthew G. Knepley 
248968132eb9SMatthew G. Knepley .seealso: DMPlexComputeInterpolatorGeneral(), DMPlexComputeJacobianFEM()
2490d69c5d34SMatthew G. Knepley @*/
2491cf51de39SMatthew G. Knepley PetscErrorCode DMPlexComputeInterpolatorNested(DM dmc, DM dmf, PetscBool isRefined, Mat In, void *user)
2492d69c5d34SMatthew G. Knepley {
2493d69c5d34SMatthew G. Knepley   DM_Plex          *mesh  = (DM_Plex *) dmc->data;
2494d69c5d34SMatthew G. Knepley   const char       *name  = "Interpolator";
2495d69c5d34SMatthew G. Knepley   PetscFE          *feRef;
249697c42addSMatthew G. Knepley   PetscFV          *fvRef;
2497d69c5d34SMatthew G. Knepley   PetscSection      fsection, fglobalSection;
2498d69c5d34SMatthew G. Knepley   PetscSection      csection, cglobalSection;
2499d69c5d34SMatthew G. Knepley   PetscScalar      *elemMat;
2500485ad865SMatthew G. Knepley   PetscInt          dim, Nf, f, fieldI, fieldJ, offsetI, offsetJ, cStart, cEnd, c;
25012ea9c922SToby Isaac   PetscInt          cTotDim=0, rTotDim = 0;
2502d69c5d34SMatthew G. Knepley 
2503d69c5d34SMatthew G. Knepley   PetscFunctionBegin;
2504*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventBegin(DMPLEX_InterpolatorFEM,dmc,dmf,0,0));
2505*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dmf, &dim));
2506*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dmf, &fsection));
2507*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetGlobalSection(dmf, &fglobalSection));
2508*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dmc, &csection));
2509*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetGlobalSection(dmc, &cglobalSection));
2510*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetNumFields(fsection, &Nf));
2511*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetSimplexOrBoxCells(dmc, 0, &cStart, &cEnd));
2512*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscCalloc2(Nf, &feRef, Nf, &fvRef));
2513d69c5d34SMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
25142ea9c922SToby Isaac     PetscObject  obj, objc;
25152ea9c922SToby Isaac     PetscClassId id, idc;
25162ea9c922SToby Isaac     PetscInt     rNb = 0, Nc = 0, cNb = 0;
2517d69c5d34SMatthew G. Knepley 
2518*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetField(dmf, f, NULL, &obj));
2519*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
252097c42addSMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
252197c42addSMatthew G. Knepley       PetscFE fe = (PetscFE) obj;
252297c42addSMatthew G. Knepley 
2523cf51de39SMatthew G. Knepley       if (isRefined) {
2524*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFERefine(fe, &feRef[f]));
2525cf51de39SMatthew G. Knepley       } else {
2526*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscObjectReference((PetscObject) fe));
2527cf51de39SMatthew G. Knepley         feRef[f] = fe;
2528cf51de39SMatthew G. Knepley       }
2529*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetDimension(feRef[f], &rNb));
2530*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetNumComponents(fe, &Nc));
253197c42addSMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
253297c42addSMatthew G. Knepley       PetscFV        fv = (PetscFV) obj;
253397c42addSMatthew G. Knepley       PetscDualSpace Q;
253497c42addSMatthew G. Knepley 
2535cf51de39SMatthew G. Knepley       if (isRefined) {
2536*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFVRefine(fv, &fvRef[f]));
2537cf51de39SMatthew G. Knepley       } else {
2538*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscObjectReference((PetscObject) fv));
2539cf51de39SMatthew G. Knepley         fvRef[f] = fv;
2540cf51de39SMatthew G. Knepley       }
2541*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetDualSpace(fvRef[f], &Q));
2542*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDualSpaceGetDimension(Q, &rNb));
2543*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetDualSpace(fv, &Q));
2544*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetNumComponents(fv, &Nc));
254597c42addSMatthew G. Knepley     }
2546*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetField(dmc, f, NULL, &objc));
2547*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(objc, &idc));
25482ea9c922SToby Isaac     if (idc == PETSCFE_CLASSID) {
25492ea9c922SToby Isaac       PetscFE fe = (PetscFE) objc;
25502ea9c922SToby Isaac 
2551*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetDimension(fe, &cNb));
25522ea9c922SToby Isaac     } else if (id == PETSCFV_CLASSID) {
25532ea9c922SToby Isaac       PetscFV        fv = (PetscFV) obj;
25542ea9c922SToby Isaac       PetscDualSpace Q;
25552ea9c922SToby Isaac 
2556*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetDualSpace(fv, &Q));
2557*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDualSpaceGetDimension(Q, &cNb));
2558d69c5d34SMatthew G. Knepley     }
25592ea9c922SToby Isaac     rTotDim += rNb;
25602ea9c922SToby Isaac     cTotDim += cNb;
25612ea9c922SToby Isaac   }
2562*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc1(rTotDim*cTotDim,&elemMat));
2563*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscArrayzero(elemMat, rTotDim*cTotDim));
2564d69c5d34SMatthew G. Knepley   for (fieldI = 0, offsetI = 0; fieldI < Nf; ++fieldI) {
2565d69c5d34SMatthew G. Knepley     PetscDualSpace   Qref;
2566d69c5d34SMatthew G. Knepley     PetscQuadrature  f;
2567d69c5d34SMatthew G. Knepley     const PetscReal *qpoints, *qweights;
2568d69c5d34SMatthew G. Knepley     PetscReal       *points;
2569d69c5d34SMatthew G. Knepley     PetscInt         npoints = 0, Nc, Np, fpdim, i, k, p, d;
2570d69c5d34SMatthew G. Knepley 
2571d69c5d34SMatthew G. Knepley     /* Compose points from all dual basis functionals */
257297c42addSMatthew G. Knepley     if (feRef[fieldI]) {
2573*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetDualSpace(feRef[fieldI], &Qref));
2574*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetNumComponents(feRef[fieldI], &Nc));
257597c42addSMatthew G. Knepley     } else {
2576*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetDualSpace(fvRef[fieldI], &Qref));
2577*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetNumComponents(fvRef[fieldI], &Nc));
257897c42addSMatthew G. Knepley     }
2579*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDualSpaceGetDimension(Qref, &fpdim));
2580d69c5d34SMatthew G. Knepley     for (i = 0; i < fpdim; ++i) {
2581*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDualSpaceGetFunctional(Qref, i, &f));
2582*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscQuadratureGetData(f, NULL, NULL, &Np, NULL, NULL));
2583d69c5d34SMatthew G. Knepley       npoints += Np;
2584d69c5d34SMatthew G. Knepley     }
2585*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscMalloc1(npoints*dim,&points));
2586d69c5d34SMatthew G. Knepley     for (i = 0, k = 0; i < fpdim; ++i) {
2587*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDualSpaceGetFunctional(Qref, i, &f));
2588*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscQuadratureGetData(f, NULL, NULL, &Np, &qpoints, NULL));
2589d69c5d34SMatthew G. Knepley       for (p = 0; p < Np; ++p, ++k) for (d = 0; d < dim; ++d) points[k*dim+d] = qpoints[p*dim+d];
2590d69c5d34SMatthew G. Knepley     }
2591d69c5d34SMatthew G. Knepley 
2592d69c5d34SMatthew G. Knepley     for (fieldJ = 0, offsetJ = 0; fieldJ < Nf; ++fieldJ) {
259397c42addSMatthew G. Knepley       PetscObject  obj;
259497c42addSMatthew G. Knepley       PetscClassId id;
25959c3cf19fSMatthew G. Knepley       PetscInt     NcJ = 0, cpdim = 0, j, qNc;
2596d69c5d34SMatthew G. Knepley 
2597*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMGetField(dmc, fieldJ, NULL, &obj));
2598*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscObjectGetClassId(obj, &id));
259997c42addSMatthew G. Knepley       if (id == PETSCFE_CLASSID) {
260097c42addSMatthew G. Knepley         PetscFE           fe = (PetscFE) obj;
2601ef0bb6c7SMatthew G. Knepley         PetscTabulation T  = NULL;
2602d69c5d34SMatthew G. Knepley 
2603d69c5d34SMatthew G. Knepley         /* Evaluate basis at points */
2604*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGetNumComponents(fe, &NcJ));
2605*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGetDimension(fe, &cpdim));
2606ffe73a53SMatthew G. Knepley         /* For now, fields only interpolate themselves */
2607ffe73a53SMatthew G. Knepley         if (fieldI == fieldJ) {
2608*5f80ce2aSJacob Faibussowitsch           PetscCheck(Nc == NcJ,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of components in fine space field %D does not match coarse field %D", Nc, NcJ);
2609*5f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFECreateTabulation(fe, 1, npoints, points, 0, &T));
2610d69c5d34SMatthew G. Knepley           for (i = 0, k = 0; i < fpdim; ++i) {
2611*5f80ce2aSJacob Faibussowitsch             CHKERRQ(PetscDualSpaceGetFunctional(Qref, i, &f));
2612*5f80ce2aSJacob Faibussowitsch             CHKERRQ(PetscQuadratureGetData(f, NULL, &qNc, &Np, NULL, &qweights));
2613*5f80ce2aSJacob Faibussowitsch             PetscCheck(qNc == NcJ,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of components in quadrature %D does not match coarse field %D", qNc, NcJ);
2614d69c5d34SMatthew G. Knepley             for (p = 0; p < Np; ++p, ++k) {
261536a6d9c0SMatthew G. Knepley               for (j = 0; j < cpdim; ++j) {
2616d172c84bSMatthew G. Knepley                 /*
2617d172c84bSMatthew G. Knepley                    cTotDim:            Total columns in element interpolation matrix, sum of number of dual basis functionals in each field
2618d172c84bSMatthew G. Knepley                    offsetI, offsetJ:   Offsets into the larger element interpolation matrix for different fields
2619d172c84bSMatthew G. Knepley                    fpdim, i, cpdim, j: Dofs for fine and coarse grids, correspond to dual space basis functionals
2620d172c84bSMatthew G. Knepley                    qNC, Nc, Ncj, c:    Number of components in this field
2621d172c84bSMatthew G. Knepley                    Np, p:              Number of quad points in the fine grid functional i
2622d172c84bSMatthew G. Knepley                    k:                  i*Np + p, overall point number for the interpolation
2623d172c84bSMatthew G. Knepley                 */
2624ef0bb6c7SMatthew G. Knepley                 for (c = 0; c < Nc; ++c) elemMat[(offsetI + i)*cTotDim + offsetJ + j] += T->T[0][k*cpdim*NcJ+j*Nc+c]*qweights[p*qNc+c];
262536a6d9c0SMatthew G. Knepley               }
2626d69c5d34SMatthew G. Knepley             }
2627d69c5d34SMatthew G. Knepley           }
2628*5f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscTabulationDestroy(&T));
2629ffe73a53SMatthew G. Knepley         }
263097c42addSMatthew G. Knepley       } else if (id == PETSCFV_CLASSID) {
263197c42addSMatthew G. Knepley         PetscFV        fv = (PetscFV) obj;
263297c42addSMatthew G. Knepley 
263397c42addSMatthew G. Knepley         /* Evaluate constant function at points */
2634*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFVGetNumComponents(fv, &NcJ));
263597c42addSMatthew G. Knepley         cpdim = 1;
263697c42addSMatthew G. Knepley         /* For now, fields only interpolate themselves */
263797c42addSMatthew G. Knepley         if (fieldI == fieldJ) {
2638*5f80ce2aSJacob Faibussowitsch           PetscCheck(Nc == NcJ,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of components in fine space field %D does not match coarse field %D", Nc, NcJ);
263997c42addSMatthew G. Knepley           for (i = 0, k = 0; i < fpdim; ++i) {
2640*5f80ce2aSJacob Faibussowitsch             CHKERRQ(PetscDualSpaceGetFunctional(Qref, i, &f));
2641*5f80ce2aSJacob Faibussowitsch             CHKERRQ(PetscQuadratureGetData(f, NULL, &qNc, &Np, NULL, &qweights));
2642*5f80ce2aSJacob Faibussowitsch             PetscCheck(qNc == NcJ,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of components in quadrature %D does not match coarse field %D", qNc, NcJ);
264397c42addSMatthew G. Knepley             for (p = 0; p < Np; ++p, ++k) {
264497c42addSMatthew G. Knepley               for (j = 0; j < cpdim; ++j) {
2645458eb97cSMatthew G. Knepley                 for (c = 0; c < Nc; ++c) elemMat[(offsetI + i)*cTotDim + offsetJ + j] += 1.0*qweights[p*qNc+c];
264697c42addSMatthew G. Knepley               }
264797c42addSMatthew G. Knepley             }
264897c42addSMatthew G. Knepley           }
264997c42addSMatthew G. Knepley         }
265097c42addSMatthew G. Knepley       }
2651d172c84bSMatthew G. Knepley       offsetJ += cpdim;
2652d69c5d34SMatthew G. Knepley     }
2653d172c84bSMatthew G. Knepley     offsetI += fpdim;
2654*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFree(points));
2655d69c5d34SMatthew G. Knepley   }
2656*5f80ce2aSJacob Faibussowitsch   if (mesh->printFEM > 1) CHKERRQ(DMPrintCellMatrix(0, name, rTotDim, cTotDim, elemMat));
26577f5b169aSMatthew G. Knepley   /* Preallocate matrix */
26587f5b169aSMatthew G. Knepley   {
2659c094ef40SMatthew G. Knepley     Mat          preallocator;
2660c094ef40SMatthew G. Knepley     PetscScalar *vals;
2661c094ef40SMatthew G. Knepley     PetscInt    *cellCIndices, *cellFIndices;
2662c094ef40SMatthew G. Knepley     PetscInt     locRows, locCols, cell;
26637f5b169aSMatthew G. Knepley 
2664*5f80ce2aSJacob Faibussowitsch     CHKERRQ(MatGetLocalSize(In, &locRows, &locCols));
2665*5f80ce2aSJacob Faibussowitsch     CHKERRQ(MatCreate(PetscObjectComm((PetscObject) In), &preallocator));
2666*5f80ce2aSJacob Faibussowitsch     CHKERRQ(MatSetType(preallocator, MATPREALLOCATOR));
2667*5f80ce2aSJacob Faibussowitsch     CHKERRQ(MatSetSizes(preallocator, locRows, locCols, PETSC_DETERMINE, PETSC_DETERMINE));
2668*5f80ce2aSJacob Faibussowitsch     CHKERRQ(MatSetUp(preallocator));
2669*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscCalloc3(rTotDim*cTotDim, &vals,cTotDim,&cellCIndices,rTotDim,&cellFIndices));
26707f5b169aSMatthew G. Knepley     for (cell = cStart; cell < cEnd; ++cell) {
2671cf51de39SMatthew G. Knepley       if (isRefined) {
2672*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexMatGetClosureIndicesRefined(dmf, fsection, fglobalSection, dmc, csection, cglobalSection, cell, cellCIndices, cellFIndices));
2673*5f80ce2aSJacob Faibussowitsch         CHKERRQ(MatSetValues(preallocator, rTotDim, cellFIndices, cTotDim, cellCIndices, vals, INSERT_VALUES));
2674cf51de39SMatthew G. Knepley       } else {
2675*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexMatSetClosureGeneral(dmf, fsection, fglobalSection, dmc, csection, cglobalSection, preallocator, cell, vals, INSERT_VALUES));
2676cf51de39SMatthew G. Knepley       }
26777f5b169aSMatthew G. Knepley     }
2678*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFree3(vals,cellCIndices,cellFIndices));
2679*5f80ce2aSJacob Faibussowitsch     CHKERRQ(MatAssemblyBegin(preallocator, MAT_FINAL_ASSEMBLY));
2680*5f80ce2aSJacob Faibussowitsch     CHKERRQ(MatAssemblyEnd(preallocator, MAT_FINAL_ASSEMBLY));
2681*5f80ce2aSJacob Faibussowitsch     CHKERRQ(MatPreallocatorPreallocate(preallocator, PETSC_TRUE, In));
2682*5f80ce2aSJacob Faibussowitsch     CHKERRQ(MatDestroy(&preallocator));
26837f5b169aSMatthew G. Knepley   }
26847f5b169aSMatthew G. Knepley   /* Fill matrix */
2685*5f80ce2aSJacob Faibussowitsch   CHKERRQ(MatZeroEntries(In));
2686d69c5d34SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
2687cf51de39SMatthew G. Knepley     if (isRefined) {
2688*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexMatSetClosureRefined(dmf, fsection, fglobalSection, dmc, csection, cglobalSection, In, c, elemMat, INSERT_VALUES));
2689cf51de39SMatthew G. Knepley     } else {
2690*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexMatSetClosureGeneral(dmf, fsection, fglobalSection, dmc, csection, cglobalSection, In, c, elemMat, INSERT_VALUES));
2691cf51de39SMatthew G. Knepley     }
2692d69c5d34SMatthew G. Knepley   }
2693*5f80ce2aSJacob Faibussowitsch   for (f = 0; f < Nf; ++f) CHKERRQ(PetscFEDestroy(&feRef[f]));
2694*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree2(feRef,fvRef));
2695*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree(elemMat));
2696*5f80ce2aSJacob Faibussowitsch   CHKERRQ(MatAssemblyBegin(In, MAT_FINAL_ASSEMBLY));
2697*5f80ce2aSJacob Faibussowitsch   CHKERRQ(MatAssemblyEnd(In, MAT_FINAL_ASSEMBLY));
26989318fe57SMatthew G. Knepley   if (mesh->printFEM > 1) {
2699*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscPrintf(PetscObjectComm((PetscObject)In), "%s:\n", name));
2700*5f80ce2aSJacob Faibussowitsch     CHKERRQ(MatChop(In, 1.0e-10));
2701*5f80ce2aSJacob Faibussowitsch     CHKERRQ(MatView(In, NULL));
2702d69c5d34SMatthew G. Knepley   }
2703*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventEnd(DMPLEX_InterpolatorFEM,dmc,dmf,0,0));
2704d69c5d34SMatthew G. Knepley   PetscFunctionReturn(0);
2705d69c5d34SMatthew G. Knepley }
27066c73c22cSMatthew G. Knepley 
2707bd041c0cSMatthew G. Knepley PetscErrorCode DMPlexComputeMassMatrixNested(DM dmc, DM dmf, Mat mass, void *user)
2708bd041c0cSMatthew G. Knepley {
2709bd041c0cSMatthew G. Knepley   SETERRQ(PetscObjectComm((PetscObject) dmc), PETSC_ERR_SUP, "Laziness");
2710bd041c0cSMatthew G. Knepley }
2711bd041c0cSMatthew G. Knepley 
271268132eb9SMatthew G. Knepley /*@
271368132eb9SMatthew G. Knepley   DMPlexComputeInterpolatorGeneral - Form the local portion of the interpolation matrix I from the coarse DM to a non-nested fine DM.
271468132eb9SMatthew G. Knepley 
271568132eb9SMatthew G. Knepley   Input Parameters:
271668132eb9SMatthew G. Knepley + dmf  - The fine mesh
271768132eb9SMatthew G. Knepley . dmc  - The coarse mesh
271868132eb9SMatthew G. Knepley - user - The user context
271968132eb9SMatthew G. Knepley 
272068132eb9SMatthew G. Knepley   Output Parameter:
272168132eb9SMatthew G. Knepley . In  - The interpolation matrix
272268132eb9SMatthew G. Knepley 
272368132eb9SMatthew G. Knepley   Level: developer
272468132eb9SMatthew G. Knepley 
272568132eb9SMatthew G. Knepley .seealso: DMPlexComputeInterpolatorNested(), DMPlexComputeJacobianFEM()
272668132eb9SMatthew G. Knepley @*/
272768132eb9SMatthew G. Knepley PetscErrorCode DMPlexComputeInterpolatorGeneral(DM dmc, DM dmf, Mat In, void *user)
27284ef9d792SMatthew G. Knepley {
272964e98e1dSMatthew G. Knepley   DM_Plex       *mesh = (DM_Plex *) dmf->data;
273064e98e1dSMatthew G. Knepley   const char    *name = "Interpolator";
27314ef9d792SMatthew G. Knepley   PetscDS        prob;
27324ef9d792SMatthew G. Knepley   PetscSection   fsection, csection, globalFSection, globalCSection;
2733e8f14785SLisandro Dalcin   PetscHSetIJ    ht;
27344ef9d792SMatthew G. Knepley   PetscLayout    rLayout;
27354ef9d792SMatthew G. Knepley   PetscInt      *dnz, *onz;
27364ef9d792SMatthew G. Knepley   PetscInt       locRows, rStart, rEnd;
27374ef9d792SMatthew G. Knepley   PetscReal     *x, *v0, *J, *invJ, detJ;
27384ef9d792SMatthew G. Knepley   PetscReal     *v0c, *Jc, *invJc, detJc;
27394ef9d792SMatthew G. Knepley   PetscScalar   *elemMat;
27404ef9d792SMatthew G. Knepley   PetscInt       dim, Nf, field, totDim, cStart, cEnd, cell, ccell;
27414ef9d792SMatthew G. Knepley 
27424ef9d792SMatthew G. Knepley   PetscFunctionBegin;
2743*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventBegin(DMPLEX_InterpolatorFEM,dmc,dmf,0,0));
2744*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateDim(dmc, &dim));
2745*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDS(dmc, &prob));
2746*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetWorkspace(prob, &x, NULL, NULL, NULL, NULL));
2747*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetNumFields(prob, &Nf));
2748*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc3(dim,&v0,dim*dim,&J,dim*dim,&invJ));
2749*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc3(dim,&v0c,dim*dim,&Jc,dim*dim,&invJc));
2750*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dmf, &fsection));
2751*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetGlobalSection(dmf, &globalFSection));
2752*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dmc, &csection));
2753*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetGlobalSection(dmc, &globalCSection));
2754*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetHeightStratum(dmf, 0, &cStart, &cEnd));
2755*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetTotalDimension(prob, &totDim));
2756*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc1(totDim, &elemMat));
27574ef9d792SMatthew G. Knepley 
2758*5f80ce2aSJacob Faibussowitsch   CHKERRQ(MatGetLocalSize(In, &locRows, NULL));
2759*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLayoutCreate(PetscObjectComm((PetscObject) In), &rLayout));
2760*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLayoutSetLocalSize(rLayout, locRows));
2761*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLayoutSetBlockSize(rLayout, 1));
2762*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLayoutSetUp(rLayout));
2763*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLayoutGetRange(rLayout, &rStart, &rEnd));
2764*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLayoutDestroy(&rLayout));
2765*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscCalloc2(locRows,&dnz,locRows,&onz));
2766*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscHSetIJCreate(&ht));
27674ef9d792SMatthew G. Knepley   for (field = 0; field < Nf; ++field) {
27684ef9d792SMatthew G. Knepley     PetscObject      obj;
27694ef9d792SMatthew G. Knepley     PetscClassId     id;
2770c0d7054bSMatthew G. Knepley     PetscDualSpace   Q = NULL;
27714ef9d792SMatthew G. Knepley     PetscQuadrature  f;
277217f047d8SMatthew G. Knepley     const PetscReal *qpoints;
277317f047d8SMatthew G. Knepley     PetscInt         Nc, Np, fpdim, i, d;
27744ef9d792SMatthew G. Knepley 
2775*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, field, &obj));
2776*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
27774ef9d792SMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
27784ef9d792SMatthew G. Knepley       PetscFE fe = (PetscFE) obj;
27794ef9d792SMatthew G. Knepley 
2780*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetDualSpace(fe, &Q));
2781*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetNumComponents(fe, &Nc));
27824ef9d792SMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
27834ef9d792SMatthew G. Knepley       PetscFV fv = (PetscFV) obj;
27844ef9d792SMatthew G. Knepley 
2785*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetDualSpace(fv, &Q));
27864ef9d792SMatthew G. Knepley       Nc   = 1;
27874ef9d792SMatthew G. Knepley     }
2788*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDualSpaceGetDimension(Q, &fpdim));
27894ef9d792SMatthew G. Knepley     /* For each fine grid cell */
27904ef9d792SMatthew G. Knepley     for (cell = cStart; cell < cEnd; ++cell) {
27914ef9d792SMatthew G. Knepley       PetscInt *findices,   *cindices;
27924ef9d792SMatthew G. Knepley       PetscInt  numFIndices, numCIndices;
27934ef9d792SMatthew G. Knepley 
2794*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
2795*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexComputeCellGeometryFEM(dmf, cell, NULL, v0, J, invJ, &detJ));
2796*5f80ce2aSJacob Faibussowitsch       PetscCheck(numFIndices == fpdim,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of fine indices %D != %D dual basis vecs", numFIndices, fpdim);
27974ef9d792SMatthew G. Knepley       for (i = 0; i < fpdim; ++i) {
27984ef9d792SMatthew G. Knepley         Vec             pointVec;
27994ef9d792SMatthew G. Knepley         PetscScalar    *pV;
28003a93e3b7SToby Isaac         PetscSF         coarseCellSF = NULL;
28013a93e3b7SToby Isaac         const PetscSFNode *coarseCells;
28029c3cf19fSMatthew G. Knepley         PetscInt        numCoarseCells, q, c;
28034ef9d792SMatthew G. Knepley 
28044ef9d792SMatthew G. Knepley         /* Get points from the dual basis functional quadrature */
2805*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDualSpaceGetFunctional(Q, i, &f));
2806*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscQuadratureGetData(f, NULL, NULL, &Np, &qpoints, NULL));
2807*5f80ce2aSJacob Faibussowitsch         CHKERRQ(VecCreateSeq(PETSC_COMM_SELF, Np*dim, &pointVec));
2808*5f80ce2aSJacob Faibussowitsch         CHKERRQ(VecSetBlockSize(pointVec, dim));
2809*5f80ce2aSJacob Faibussowitsch         CHKERRQ(VecGetArray(pointVec, &pV));
28104ef9d792SMatthew G. Knepley         for (q = 0; q < Np; ++q) {
2811c330f8ffSToby Isaac           const PetscReal xi0[3] = {-1., -1., -1.};
2812c330f8ffSToby Isaac 
28134ef9d792SMatthew G. Knepley           /* Transform point to real space */
2814c330f8ffSToby Isaac           CoordinatesRefToReal(dim, dim, xi0, v0, J, &qpoints[q*dim], x);
28154ef9d792SMatthew G. Knepley           for (d = 0; d < dim; ++d) pV[q*dim+d] = x[d];
28164ef9d792SMatthew G. Knepley         }
2817*5f80ce2aSJacob Faibussowitsch         CHKERRQ(VecRestoreArray(pointVec, &pV));
28184ef9d792SMatthew G. Knepley         /* Get set of coarse cells that overlap points (would like to group points by coarse cell) */
28191555c271SMatthew G. Knepley         /* OPT: Pack all quad points from fine cell */
2820*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMLocatePoints(dmc, pointVec, DM_POINTLOCATION_NEAREST, &coarseCellSF));
2821*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscSFViewFromOptions(coarseCellSF, NULL, "-interp_sf_view"));
28224ef9d792SMatthew G. Knepley         /* Update preallocation info */
2823*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscSFGetGraph(coarseCellSF, NULL, &numCoarseCells, NULL, &coarseCells));
2824*5f80ce2aSJacob Faibussowitsch         PetscCheck(numCoarseCells == Np,PETSC_COMM_SELF,PETSC_ERR_PLIB,"Not all closure points located");
28259c3cf19fSMatthew G. Knepley         {
2826e8f14785SLisandro Dalcin           PetscHashIJKey key;
2827e8f14785SLisandro Dalcin           PetscBool      missing;
28284ef9d792SMatthew G. Knepley 
2829e8f14785SLisandro Dalcin           key.i = findices[i];
2830e8f14785SLisandro Dalcin           if (key.i >= 0) {
28314ef9d792SMatthew G. Knepley             /* Get indices for coarse elements */
28324ef9d792SMatthew G. Knepley             for (ccell = 0; ccell < numCoarseCells; ++ccell) {
2833*5f80ce2aSJacob Faibussowitsch               CHKERRQ(DMPlexGetClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
28344ef9d792SMatthew G. Knepley               for (c = 0; c < numCIndices; ++c) {
2835e8f14785SLisandro Dalcin                 key.j = cindices[c];
2836e8f14785SLisandro Dalcin                 if (key.j < 0) continue;
2837*5f80ce2aSJacob Faibussowitsch                 CHKERRQ(PetscHSetIJQueryAdd(ht, key, &missing));
28384ef9d792SMatthew G. Knepley                 if (missing) {
2839e8f14785SLisandro Dalcin                   if ((key.j >= rStart) && (key.j < rEnd)) ++dnz[key.i-rStart];
2840e8f14785SLisandro Dalcin                   else                                     ++onz[key.i-rStart];
28414ef9d792SMatthew G. Knepley                 }
28424ef9d792SMatthew G. Knepley               }
2843*5f80ce2aSJacob Faibussowitsch               CHKERRQ(DMPlexRestoreClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
28444ef9d792SMatthew G. Knepley             }
28454ef9d792SMatthew G. Knepley           }
28468c543595SMatthew G. Knepley         }
2847*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscSFDestroy(&coarseCellSF));
2848*5f80ce2aSJacob Faibussowitsch         CHKERRQ(VecDestroy(&pointVec));
28494ef9d792SMatthew G. Knepley       }
2850*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexRestoreClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
28514ef9d792SMatthew G. Knepley     }
28524ef9d792SMatthew G. Knepley   }
2853*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscHSetIJDestroy(&ht));
2854*5f80ce2aSJacob Faibussowitsch   CHKERRQ(MatXAIJSetPreallocation(In, 1, dnz, onz, NULL, NULL));
2855*5f80ce2aSJacob Faibussowitsch   CHKERRQ(MatSetOption(In, MAT_NEW_NONZERO_ALLOCATION_ERR,PETSC_TRUE));
2856*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree2(dnz,onz));
28574ef9d792SMatthew G. Knepley   for (field = 0; field < Nf; ++field) {
28584ef9d792SMatthew G. Knepley     PetscObject       obj;
28594ef9d792SMatthew G. Knepley     PetscClassId      id;
2860c0d7054bSMatthew G. Knepley     PetscDualSpace    Q = NULL;
2861ef0bb6c7SMatthew G. Knepley     PetscTabulation T = NULL;
28624ef9d792SMatthew G. Knepley     PetscQuadrature   f;
28634ef9d792SMatthew G. Knepley     const PetscReal  *qpoints, *qweights;
28649c3cf19fSMatthew G. Knepley     PetscInt          Nc, qNc, Np, fpdim, i, d;
28654ef9d792SMatthew G. Knepley 
2866*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, field, &obj));
2867*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
28684ef9d792SMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
28694ef9d792SMatthew G. Knepley       PetscFE fe = (PetscFE) obj;
28704ef9d792SMatthew G. Knepley 
2871*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetDualSpace(fe, &Q));
2872*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetNumComponents(fe, &Nc));
2873*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFECreateTabulation(fe, 1, 1, x, 0, &T));
28744ef9d792SMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
28754ef9d792SMatthew G. Knepley       PetscFV fv = (PetscFV) obj;
28764ef9d792SMatthew G. Knepley 
2877*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetDualSpace(fv, &Q));
28784ef9d792SMatthew G. Knepley       Nc   = 1;
287998921bdaSJacob Faibussowitsch     } else SETERRQ(PetscObjectComm((PetscObject)dmc),PETSC_ERR_ARG_WRONG,"Unknown discretization type for field %D",field);
2880*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDualSpaceGetDimension(Q, &fpdim));
28814ef9d792SMatthew G. Knepley     /* For each fine grid cell */
28824ef9d792SMatthew G. Knepley     for (cell = cStart; cell < cEnd; ++cell) {
28834ef9d792SMatthew G. Knepley       PetscInt *findices,   *cindices;
28844ef9d792SMatthew G. Knepley       PetscInt  numFIndices, numCIndices;
28854ef9d792SMatthew G. Knepley 
2886*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
2887*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexComputeCellGeometryFEM(dmf, cell, NULL, v0, J, invJ, &detJ));
2888*5f80ce2aSJacob Faibussowitsch       PetscCheck(numFIndices == fpdim,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of fine indices %D != %D dual basis vecs", numFIndices, fpdim);
28894ef9d792SMatthew G. Knepley       for (i = 0; i < fpdim; ++i) {
28904ef9d792SMatthew G. Knepley         Vec             pointVec;
28914ef9d792SMatthew G. Knepley         PetscScalar    *pV;
289212111d7cSToby Isaac         PetscSF         coarseCellSF = NULL;
28933a93e3b7SToby Isaac         const PetscSFNode *coarseCells;
289417f047d8SMatthew G. Knepley         PetscInt        numCoarseCells, cpdim, q, c, j;
28954ef9d792SMatthew G. Knepley 
28964ef9d792SMatthew G. Knepley         /* Get points from the dual basis functional quadrature */
2897*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDualSpaceGetFunctional(Q, i, &f));
2898*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscQuadratureGetData(f, NULL, &qNc, &Np, &qpoints, &qweights));
2899*5f80ce2aSJacob Faibussowitsch         PetscCheck(qNc == Nc,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of components in quadrature %D does not match coarse field %D", qNc, Nc);
2900*5f80ce2aSJacob Faibussowitsch         CHKERRQ(VecCreateSeq(PETSC_COMM_SELF, Np*dim, &pointVec));
2901*5f80ce2aSJacob Faibussowitsch         CHKERRQ(VecSetBlockSize(pointVec, dim));
2902*5f80ce2aSJacob Faibussowitsch         CHKERRQ(VecGetArray(pointVec, &pV));
29034ef9d792SMatthew G. Knepley         for (q = 0; q < Np; ++q) {
2904c330f8ffSToby Isaac           const PetscReal xi0[3] = {-1., -1., -1.};
2905c330f8ffSToby Isaac 
29064ef9d792SMatthew G. Knepley           /* Transform point to real space */
2907c330f8ffSToby Isaac           CoordinatesRefToReal(dim, dim, xi0, v0, J, &qpoints[q*dim], x);
29084ef9d792SMatthew G. Knepley           for (d = 0; d < dim; ++d) pV[q*dim+d] = x[d];
29094ef9d792SMatthew G. Knepley         }
2910*5f80ce2aSJacob Faibussowitsch         CHKERRQ(VecRestoreArray(pointVec, &pV));
29114ef9d792SMatthew G. Knepley         /* Get set of coarse cells that overlap points (would like to group points by coarse cell) */
29121555c271SMatthew G. Knepley         /* OPT: Read this out from preallocation information */
2913*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMLocatePoints(dmc, pointVec, DM_POINTLOCATION_NEAREST, &coarseCellSF));
29144ef9d792SMatthew G. Knepley         /* Update preallocation info */
2915*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscSFGetGraph(coarseCellSF, NULL, &numCoarseCells, NULL, &coarseCells));
2916*5f80ce2aSJacob Faibussowitsch         PetscCheck(numCoarseCells == Np,PETSC_COMM_SELF,PETSC_ERR_PLIB,"Not all closure points located");
2917*5f80ce2aSJacob Faibussowitsch         CHKERRQ(VecGetArray(pointVec, &pV));
29184ef9d792SMatthew G. Knepley         for (ccell = 0; ccell < numCoarseCells; ++ccell) {
2919826eb36dSMatthew G. Knepley           PetscReal pVReal[3];
2920c330f8ffSToby Isaac           const PetscReal xi0[3] = {-1., -1., -1.};
2921826eb36dSMatthew G. Knepley 
2922*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexGetClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
29234ef9d792SMatthew G. Knepley           /* Transform points from real space to coarse reference space */
2924*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexComputeCellGeometryFEM(dmc, coarseCells[ccell].index, NULL, v0c, Jc, invJc, &detJc));
2925e2d86523SMatthew G. Knepley           for (d = 0; d < dim; ++d) pVReal[d] = PetscRealPart(pV[ccell*dim+d]);
2926c330f8ffSToby Isaac           CoordinatesRealToRef(dim, dim, xi0, v0c, invJc, pVReal, x);
29274ef9d792SMatthew G. Knepley 
29284ef9d792SMatthew G. Knepley           if (id == PETSCFE_CLASSID) {
29294ef9d792SMatthew G. Knepley             PetscFE fe = (PetscFE) obj;
29304ef9d792SMatthew G. Knepley 
29314ef9d792SMatthew G. Knepley             /* Evaluate coarse basis on contained point */
2932*5f80ce2aSJacob Faibussowitsch             CHKERRQ(PetscFEGetDimension(fe, &cpdim));
2933*5f80ce2aSJacob Faibussowitsch             CHKERRQ(PetscFEComputeTabulation(fe, 1, x, 0, T));
2934*5f80ce2aSJacob Faibussowitsch             CHKERRQ(PetscArrayzero(elemMat, cpdim));
29354ef9d792SMatthew G. Knepley             /* Get elemMat entries by multiplying by weight */
29364ef9d792SMatthew G. Knepley             for (j = 0; j < cpdim; ++j) {
2937ef0bb6c7SMatthew G. Knepley               for (c = 0; c < Nc; ++c) elemMat[j] += T->T[0][j*Nc + c]*qweights[ccell*qNc + c];
29384ef9d792SMatthew G. Knepley             }
29394ef9d792SMatthew G. Knepley           } else {
29404ef9d792SMatthew G. Knepley             cpdim = 1;
29414ef9d792SMatthew G. Knepley             for (j = 0; j < cpdim; ++j) {
29429c3cf19fSMatthew G. Knepley               for (c = 0; c < Nc; ++c) elemMat[j] += 1.0*qweights[ccell*qNc + c];
29434ef9d792SMatthew G. Knepley             }
29444ef9d792SMatthew G. Knepley           }
29454ef9d792SMatthew G. Knepley           /* Update interpolator */
2946*5f80ce2aSJacob Faibussowitsch           if (mesh->printFEM > 1) CHKERRQ(DMPrintCellMatrix(cell, name, 1, numCIndices, elemMat));
2947*5f80ce2aSJacob Faibussowitsch           PetscCheck(numCIndices == cpdim,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Number of element matrix columns %D != %D", numCIndices, cpdim);
2948*5f80ce2aSJacob Faibussowitsch           CHKERRQ(MatSetValues(In, 1, &findices[i], numCIndices, cindices, elemMat, INSERT_VALUES));
2949*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexRestoreClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
29504ef9d792SMatthew G. Knepley         }
2951*5f80ce2aSJacob Faibussowitsch         CHKERRQ(VecRestoreArray(pointVec, &pV));
2952*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscSFDestroy(&coarseCellSF));
2953*5f80ce2aSJacob Faibussowitsch         CHKERRQ(VecDestroy(&pointVec));
29544ef9d792SMatthew G. Knepley       }
2955*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexRestoreClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
29564ef9d792SMatthew G. Knepley     }
2957*5f80ce2aSJacob Faibussowitsch     if (id == PETSCFE_CLASSID) CHKERRQ(PetscTabulationDestroy(&T));
29584ef9d792SMatthew G. Knepley   }
2959*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree3(v0,J,invJ));
2960*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree3(v0c,Jc,invJc));
2961*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree(elemMat));
2962*5f80ce2aSJacob Faibussowitsch   CHKERRQ(MatAssemblyBegin(In, MAT_FINAL_ASSEMBLY));
2963*5f80ce2aSJacob Faibussowitsch   CHKERRQ(MatAssemblyEnd(In, MAT_FINAL_ASSEMBLY));
2964*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventEnd(DMPLEX_InterpolatorFEM,dmc,dmf,0,0));
29654ef9d792SMatthew G. Knepley   PetscFunctionReturn(0);
29664ef9d792SMatthew G. Knepley }
29674ef9d792SMatthew G. Knepley 
296846fa42a0SMatthew G. Knepley /*@
2969bd041c0cSMatthew G. Knepley   DMPlexComputeMassMatrixGeneral - Form the local portion of the mass matrix M from the coarse DM to a non-nested fine DM.
2970bd041c0cSMatthew G. Knepley 
2971bd041c0cSMatthew G. Knepley   Input Parameters:
2972bd041c0cSMatthew G. Knepley + dmf  - The fine mesh
2973bd041c0cSMatthew G. Knepley . dmc  - The coarse mesh
2974bd041c0cSMatthew G. Knepley - user - The user context
2975bd041c0cSMatthew G. Knepley 
2976bd041c0cSMatthew G. Knepley   Output Parameter:
2977bd041c0cSMatthew G. Knepley . mass  - The mass matrix
2978bd041c0cSMatthew G. Knepley 
2979bd041c0cSMatthew G. Knepley   Level: developer
2980bd041c0cSMatthew G. Knepley 
2981bd041c0cSMatthew G. Knepley .seealso: DMPlexComputeMassMatrixNested(), DMPlexComputeInterpolatorNested(), DMPlexComputeInterpolatorGeneral(), DMPlexComputeJacobianFEM()
2982bd041c0cSMatthew G. Knepley @*/
2983bd041c0cSMatthew G. Knepley PetscErrorCode DMPlexComputeMassMatrixGeneral(DM dmc, DM dmf, Mat mass, void *user)
2984bd041c0cSMatthew G. Knepley {
2985bd041c0cSMatthew G. Knepley   DM_Plex       *mesh = (DM_Plex *) dmf->data;
2986bd041c0cSMatthew G. Knepley   const char    *name = "Mass Matrix";
2987bd041c0cSMatthew G. Knepley   PetscDS        prob;
2988bd041c0cSMatthew G. Knepley   PetscSection   fsection, csection, globalFSection, globalCSection;
2989e8f14785SLisandro Dalcin   PetscHSetIJ    ht;
2990bd041c0cSMatthew G. Knepley   PetscLayout    rLayout;
2991bd041c0cSMatthew G. Knepley   PetscInt      *dnz, *onz;
2992bd041c0cSMatthew G. Knepley   PetscInt       locRows, rStart, rEnd;
2993bd041c0cSMatthew G. Knepley   PetscReal     *x, *v0, *J, *invJ, detJ;
2994bd041c0cSMatthew G. Knepley   PetscReal     *v0c, *Jc, *invJc, detJc;
2995bd041c0cSMatthew G. Knepley   PetscScalar   *elemMat;
2996bd041c0cSMatthew G. Knepley   PetscInt       dim, Nf, field, totDim, cStart, cEnd, cell, ccell;
2997bd041c0cSMatthew G. Knepley 
2998bd041c0cSMatthew G. Knepley   PetscFunctionBegin;
2999*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateDim(dmc, &dim));
3000*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDS(dmc, &prob));
3001*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetWorkspace(prob, &x, NULL, NULL, NULL, NULL));
3002*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetNumFields(prob, &Nf));
3003*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc3(dim,&v0,dim*dim,&J,dim*dim,&invJ));
3004*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc3(dim,&v0c,dim*dim,&Jc,dim*dim,&invJc));
3005*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dmf, &fsection));
3006*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetGlobalSection(dmf, &globalFSection));
3007*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dmc, &csection));
3008*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetGlobalSection(dmc, &globalCSection));
3009*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetHeightStratum(dmf, 0, &cStart, &cEnd));
3010*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetTotalDimension(prob, &totDim));
3011*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc1(totDim, &elemMat));
3012bd041c0cSMatthew G. Knepley 
3013*5f80ce2aSJacob Faibussowitsch   CHKERRQ(MatGetLocalSize(mass, &locRows, NULL));
3014*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLayoutCreate(PetscObjectComm((PetscObject) mass), &rLayout));
3015*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLayoutSetLocalSize(rLayout, locRows));
3016*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLayoutSetBlockSize(rLayout, 1));
3017*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLayoutSetUp(rLayout));
3018*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLayoutGetRange(rLayout, &rStart, &rEnd));
3019*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLayoutDestroy(&rLayout));
3020*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscCalloc2(locRows,&dnz,locRows,&onz));
3021*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscHSetIJCreate(&ht));
3022bd041c0cSMatthew G. Knepley   for (field = 0; field < Nf; ++field) {
3023bd041c0cSMatthew G. Knepley     PetscObject      obj;
3024bd041c0cSMatthew G. Knepley     PetscClassId     id;
3025bd041c0cSMatthew G. Knepley     PetscQuadrature  quad;
3026bd041c0cSMatthew G. Knepley     const PetscReal *qpoints;
3027bd041c0cSMatthew G. Knepley     PetscInt         Nq, Nc, i, d;
3028bd041c0cSMatthew G. Knepley 
3029*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, field, &obj));
3030*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
3031*5f80ce2aSJacob Faibussowitsch     if (id == PETSCFE_CLASSID) CHKERRQ(PetscFEGetQuadrature((PetscFE) obj, &quad));
3032*5f80ce2aSJacob Faibussowitsch     else                       CHKERRQ(PetscFVGetQuadrature((PetscFV) obj, &quad));
3033*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscQuadratureGetData(quad, NULL, &Nc, &Nq, &qpoints, NULL));
3034bd041c0cSMatthew G. Knepley     /* For each fine grid cell */
3035bd041c0cSMatthew G. Knepley     for (cell = cStart; cell < cEnd; ++cell) {
3036bd041c0cSMatthew G. Knepley       Vec                pointVec;
3037bd041c0cSMatthew G. Knepley       PetscScalar       *pV;
3038bd041c0cSMatthew G. Knepley       PetscSF            coarseCellSF = NULL;
3039bd041c0cSMatthew G. Knepley       const PetscSFNode *coarseCells;
3040bd041c0cSMatthew G. Knepley       PetscInt           numCoarseCells, q, c;
3041bd041c0cSMatthew G. Knepley       PetscInt          *findices,   *cindices;
3042bd041c0cSMatthew G. Knepley       PetscInt           numFIndices, numCIndices;
3043bd041c0cSMatthew G. Knepley 
3044*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
3045*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexComputeCellGeometryFEM(dmf, cell, NULL, v0, J, invJ, &detJ));
3046bd041c0cSMatthew G. Knepley       /* Get points from the quadrature */
3047*5f80ce2aSJacob Faibussowitsch       CHKERRQ(VecCreateSeq(PETSC_COMM_SELF, Nq*dim, &pointVec));
3048*5f80ce2aSJacob Faibussowitsch       CHKERRQ(VecSetBlockSize(pointVec, dim));
3049*5f80ce2aSJacob Faibussowitsch       CHKERRQ(VecGetArray(pointVec, &pV));
3050bd041c0cSMatthew G. Knepley       for (q = 0; q < Nq; ++q) {
3051c330f8ffSToby Isaac         const PetscReal xi0[3] = {-1., -1., -1.};
3052c330f8ffSToby Isaac 
3053bd041c0cSMatthew G. Knepley         /* Transform point to real space */
3054c330f8ffSToby Isaac         CoordinatesRefToReal(dim, dim, xi0, v0, J, &qpoints[q*dim], x);
3055bd041c0cSMatthew G. Knepley         for (d = 0; d < dim; ++d) pV[q*dim+d] = x[d];
3056bd041c0cSMatthew G. Knepley       }
3057*5f80ce2aSJacob Faibussowitsch       CHKERRQ(VecRestoreArray(pointVec, &pV));
3058bd041c0cSMatthew G. Knepley       /* Get set of coarse cells that overlap points (would like to group points by coarse cell) */
3059*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMLocatePoints(dmc, pointVec, DM_POINTLOCATION_NEAREST, &coarseCellSF));
3060*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscSFViewFromOptions(coarseCellSF, NULL, "-interp_sf_view"));
3061bd041c0cSMatthew G. Knepley       /* Update preallocation info */
3062*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscSFGetGraph(coarseCellSF, NULL, &numCoarseCells, NULL, &coarseCells));
3063*5f80ce2aSJacob Faibussowitsch       PetscCheck(numCoarseCells == Nq,PETSC_COMM_SELF,PETSC_ERR_PLIB,"Not all closure points located");
3064bd041c0cSMatthew G. Knepley       {
3065e8f14785SLisandro Dalcin         PetscHashIJKey key;
3066e8f14785SLisandro Dalcin         PetscBool      missing;
3067bd041c0cSMatthew G. Knepley 
3068bd041c0cSMatthew G. Knepley         for (i = 0; i < numFIndices; ++i) {
3069e8f14785SLisandro Dalcin           key.i = findices[i];
3070e8f14785SLisandro Dalcin           if (key.i >= 0) {
3071bd041c0cSMatthew G. Knepley             /* Get indices for coarse elements */
3072bd041c0cSMatthew G. Knepley             for (ccell = 0; ccell < numCoarseCells; ++ccell) {
3073*5f80ce2aSJacob Faibussowitsch               CHKERRQ(DMPlexGetClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
3074bd041c0cSMatthew G. Knepley               for (c = 0; c < numCIndices; ++c) {
3075e8f14785SLisandro Dalcin                 key.j = cindices[c];
3076e8f14785SLisandro Dalcin                 if (key.j < 0) continue;
3077*5f80ce2aSJacob Faibussowitsch                 CHKERRQ(PetscHSetIJQueryAdd(ht, key, &missing));
3078bd041c0cSMatthew G. Knepley                 if (missing) {
3079e8f14785SLisandro Dalcin                   if ((key.j >= rStart) && (key.j < rEnd)) ++dnz[key.i-rStart];
3080e8f14785SLisandro Dalcin                   else                                     ++onz[key.i-rStart];
3081bd041c0cSMatthew G. Knepley                 }
3082bd041c0cSMatthew G. Knepley               }
3083*5f80ce2aSJacob Faibussowitsch               CHKERRQ(DMPlexRestoreClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
3084bd041c0cSMatthew G. Knepley             }
3085bd041c0cSMatthew G. Knepley           }
3086bd041c0cSMatthew G. Knepley         }
3087bd041c0cSMatthew G. Knepley       }
3088*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscSFDestroy(&coarseCellSF));
3089*5f80ce2aSJacob Faibussowitsch       CHKERRQ(VecDestroy(&pointVec));
3090*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexRestoreClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
3091bd041c0cSMatthew G. Knepley     }
3092bd041c0cSMatthew G. Knepley   }
3093*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscHSetIJDestroy(&ht));
3094*5f80ce2aSJacob Faibussowitsch   CHKERRQ(MatXAIJSetPreallocation(mass, 1, dnz, onz, NULL, NULL));
3095*5f80ce2aSJacob Faibussowitsch   CHKERRQ(MatSetOption(mass, MAT_NEW_NONZERO_ALLOCATION_ERR,PETSC_TRUE));
3096*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree2(dnz,onz));
3097bd041c0cSMatthew G. Knepley   for (field = 0; field < Nf; ++field) {
3098bd041c0cSMatthew G. Knepley     PetscObject       obj;
3099bd041c0cSMatthew G. Knepley     PetscClassId      id;
3100ef0bb6c7SMatthew G. Knepley     PetscTabulation T, Tfine;
3101bd041c0cSMatthew G. Knepley     PetscQuadrature   quad;
3102bd041c0cSMatthew G. Knepley     const PetscReal  *qpoints, *qweights;
3103bd041c0cSMatthew G. Knepley     PetscInt          Nq, Nc, i, d;
3104bd041c0cSMatthew G. Knepley 
3105*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, field, &obj));
3106*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
3107ef0bb6c7SMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
3108*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetQuadrature((PetscFE) obj, &quad));
3109*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetCellTabulation((PetscFE) obj, 1, &Tfine));
3110*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFECreateTabulation((PetscFE) obj, 1, 1, x, 0, &T));
3111ef0bb6c7SMatthew G. Knepley     } else {
3112*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetQuadrature((PetscFV) obj, &quad));
3113ef0bb6c7SMatthew G. Knepley     }
3114*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscQuadratureGetData(quad, NULL, &Nc, &Nq, &qpoints, &qweights));
3115bd041c0cSMatthew G. Knepley     /* For each fine grid cell */
3116bd041c0cSMatthew G. Knepley     for (cell = cStart; cell < cEnd; ++cell) {
3117bd041c0cSMatthew G. Knepley       Vec                pointVec;
3118bd041c0cSMatthew G. Knepley       PetscScalar       *pV;
3119bd041c0cSMatthew G. Knepley       PetscSF            coarseCellSF = NULL;
3120bd041c0cSMatthew G. Knepley       const PetscSFNode *coarseCells;
3121bd041c0cSMatthew G. Knepley       PetscInt           numCoarseCells, cpdim, q, c, j;
3122bd041c0cSMatthew G. Knepley       PetscInt          *findices,   *cindices;
3123bd041c0cSMatthew G. Knepley       PetscInt           numFIndices, numCIndices;
3124bd041c0cSMatthew G. Knepley 
3125*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
3126*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexComputeCellGeometryFEM(dmf, cell, NULL, v0, J, invJ, &detJ));
3127bd041c0cSMatthew G. Knepley       /* Get points from the quadrature */
3128*5f80ce2aSJacob Faibussowitsch       CHKERRQ(VecCreateSeq(PETSC_COMM_SELF, Nq*dim, &pointVec));
3129*5f80ce2aSJacob Faibussowitsch       CHKERRQ(VecSetBlockSize(pointVec, dim));
3130*5f80ce2aSJacob Faibussowitsch       CHKERRQ(VecGetArray(pointVec, &pV));
3131bd041c0cSMatthew G. Knepley       for (q = 0; q < Nq; ++q) {
3132c330f8ffSToby Isaac         const PetscReal xi0[3] = {-1., -1., -1.};
3133c330f8ffSToby Isaac 
3134bd041c0cSMatthew G. Knepley         /* Transform point to real space */
3135c330f8ffSToby Isaac         CoordinatesRefToReal(dim, dim, xi0, v0, J, &qpoints[q*dim], x);
3136bd041c0cSMatthew G. Knepley         for (d = 0; d < dim; ++d) pV[q*dim+d] = x[d];
3137bd041c0cSMatthew G. Knepley       }
3138*5f80ce2aSJacob Faibussowitsch       CHKERRQ(VecRestoreArray(pointVec, &pV));
3139bd041c0cSMatthew G. Knepley       /* Get set of coarse cells that overlap points (would like to group points by coarse cell) */
3140*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMLocatePoints(dmc, pointVec, DM_POINTLOCATION_NEAREST, &coarseCellSF));
3141bd041c0cSMatthew G. Knepley       /* Update matrix */
3142*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscSFGetGraph(coarseCellSF, NULL, &numCoarseCells, NULL, &coarseCells));
3143*5f80ce2aSJacob Faibussowitsch       PetscCheck(numCoarseCells == Nq,PETSC_COMM_SELF,PETSC_ERR_PLIB,"Not all closure points located");
3144*5f80ce2aSJacob Faibussowitsch       CHKERRQ(VecGetArray(pointVec, &pV));
3145bd041c0cSMatthew G. Knepley       for (ccell = 0; ccell < numCoarseCells; ++ccell) {
3146bd041c0cSMatthew G. Knepley         PetscReal pVReal[3];
3147c330f8ffSToby Isaac         const PetscReal xi0[3] = {-1., -1., -1.};
3148c330f8ffSToby Isaac 
3149*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexGetClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
3150bd041c0cSMatthew G. Knepley         /* Transform points from real space to coarse reference space */
3151*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexComputeCellGeometryFEM(dmc, coarseCells[ccell].index, NULL, v0c, Jc, invJc, &detJc));
3152bd041c0cSMatthew G. Knepley         for (d = 0; d < dim; ++d) pVReal[d] = PetscRealPart(pV[ccell*dim+d]);
3153c330f8ffSToby Isaac         CoordinatesRealToRef(dim, dim, xi0, v0c, invJc, pVReal, x);
3154bd041c0cSMatthew G. Knepley 
3155bd041c0cSMatthew G. Knepley         if (id == PETSCFE_CLASSID) {
3156bd041c0cSMatthew G. Knepley           PetscFE fe = (PetscFE) obj;
3157bd041c0cSMatthew G. Knepley 
3158bd041c0cSMatthew G. Knepley           /* Evaluate coarse basis on contained point */
3159*5f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEGetDimension(fe, &cpdim));
3160*5f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEComputeTabulation(fe, 1, x, 0, T));
3161bd041c0cSMatthew G. Knepley           /* Get elemMat entries by multiplying by weight */
3162bd041c0cSMatthew G. Knepley           for (i = 0; i < numFIndices; ++i) {
3163*5f80ce2aSJacob Faibussowitsch             CHKERRQ(PetscArrayzero(elemMat, cpdim));
3164bd041c0cSMatthew G. Knepley             for (j = 0; j < cpdim; ++j) {
3165ef0bb6c7SMatthew G. Knepley               for (c = 0; c < Nc; ++c) elemMat[j] += T->T[0][j*Nc + c]*Tfine->T[0][(ccell*numFIndices + i)*Nc + c]*qweights[ccell*Nc + c]*detJ;
3166bd041c0cSMatthew G. Knepley             }
3167bd041c0cSMatthew G. Knepley             /* Update interpolator */
3168*5f80ce2aSJacob Faibussowitsch             if (mesh->printFEM > 1) CHKERRQ(DMPrintCellMatrix(cell, name, 1, numCIndices, elemMat));
3169*5f80ce2aSJacob Faibussowitsch             PetscCheck(numCIndices == cpdim,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Number of element matrix columns %D != %D", numCIndices, cpdim);
3170*5f80ce2aSJacob Faibussowitsch             CHKERRQ(MatSetValues(mass, 1, &findices[i], numCIndices, cindices, elemMat, ADD_VALUES));
3171bd041c0cSMatthew G. Knepley           }
3172bd041c0cSMatthew G. Knepley         } else {
3173bd041c0cSMatthew G. Knepley           cpdim = 1;
3174bd041c0cSMatthew G. Knepley           for (i = 0; i < numFIndices; ++i) {
3175*5f80ce2aSJacob Faibussowitsch             CHKERRQ(PetscArrayzero(elemMat, cpdim));
3176bd041c0cSMatthew G. Knepley             for (j = 0; j < cpdim; ++j) {
3177bd041c0cSMatthew G. Knepley               for (c = 0; c < Nc; ++c) elemMat[j] += 1.0*1.0*qweights[ccell*Nc + c]*detJ;
3178bd041c0cSMatthew G. Knepley             }
3179bd041c0cSMatthew G. Knepley             /* Update interpolator */
3180*5f80ce2aSJacob Faibussowitsch             if (mesh->printFEM > 1) CHKERRQ(DMPrintCellMatrix(cell, name, 1, numCIndices, elemMat));
3181*5f80ce2aSJacob Faibussowitsch             CHKERRQ(PetscPrintf(PETSC_COMM_SELF, "Nq: %D %D Nf: %D %D Nc: %D %D\n", ccell, Nq, i, numFIndices, j, numCIndices));
3182*5f80ce2aSJacob Faibussowitsch             PetscCheck(numCIndices == cpdim,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Number of element matrix columns %D != %D", numCIndices, cpdim);
3183*5f80ce2aSJacob Faibussowitsch             CHKERRQ(MatSetValues(mass, 1, &findices[i], numCIndices, cindices, elemMat, ADD_VALUES));
3184bd041c0cSMatthew G. Knepley           }
3185bd041c0cSMatthew G. Knepley         }
3186*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexRestoreClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
3187bd041c0cSMatthew G. Knepley       }
3188*5f80ce2aSJacob Faibussowitsch       CHKERRQ(VecRestoreArray(pointVec, &pV));
3189*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscSFDestroy(&coarseCellSF));
3190*5f80ce2aSJacob Faibussowitsch       CHKERRQ(VecDestroy(&pointVec));
3191*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexRestoreClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
3192bd041c0cSMatthew G. Knepley     }
3193*5f80ce2aSJacob Faibussowitsch     if (id == PETSCFE_CLASSID) CHKERRQ(PetscTabulationDestroy(&T));
3194bd041c0cSMatthew G. Knepley   }
3195*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree3(v0,J,invJ));
3196*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree3(v0c,Jc,invJc));
3197*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree(elemMat));
3198*5f80ce2aSJacob Faibussowitsch   CHKERRQ(MatAssemblyBegin(mass, MAT_FINAL_ASSEMBLY));
3199*5f80ce2aSJacob Faibussowitsch   CHKERRQ(MatAssemblyEnd(mass, MAT_FINAL_ASSEMBLY));
3200bd041c0cSMatthew G. Knepley   PetscFunctionReturn(0);
3201bd041c0cSMatthew G. Knepley }
3202bd041c0cSMatthew G. Knepley 
3203bd041c0cSMatthew G. Knepley /*@
320446fa42a0SMatthew G. Knepley   DMPlexComputeInjectorFEM - Compute a mapping from coarse unknowns to fine unknowns
320546fa42a0SMatthew G. Knepley 
320646fa42a0SMatthew G. Knepley   Input Parameters:
320746fa42a0SMatthew G. Knepley + dmc  - The coarse mesh
320846fa42a0SMatthew G. Knepley - dmf  - The fine mesh
320946fa42a0SMatthew G. Knepley - user - The user context
321046fa42a0SMatthew G. Knepley 
321146fa42a0SMatthew G. Knepley   Output Parameter:
321246fa42a0SMatthew G. Knepley . sc   - The mapping
321346fa42a0SMatthew G. Knepley 
321446fa42a0SMatthew G. Knepley   Level: developer
321546fa42a0SMatthew G. Knepley 
321646fa42a0SMatthew G. Knepley .seealso: DMPlexComputeInterpolatorNested(), DMPlexComputeJacobianFEM()
321746fa42a0SMatthew G. Knepley @*/
32187c927364SMatthew G. Knepley PetscErrorCode DMPlexComputeInjectorFEM(DM dmc, DM dmf, VecScatter *sc, void *user)
32197c927364SMatthew G. Knepley {
3220e9d4ef1bSMatthew G. Knepley   PetscDS        prob;
32217c927364SMatthew G. Knepley   PetscFE       *feRef;
322297c42addSMatthew G. Knepley   PetscFV       *fvRef;
32237c927364SMatthew G. Knepley   Vec            fv, cv;
32247c927364SMatthew G. Knepley   IS             fis, cis;
32257c927364SMatthew G. Knepley   PetscSection   fsection, fglobalSection, csection, cglobalSection;
32267c927364SMatthew G. Knepley   PetscInt      *cmap, *cellCIndices, *cellFIndices, *cindices, *findices;
3227485ad865SMatthew G. Knepley   PetscInt       cTotDim, fTotDim = 0, Nf, f, field, cStart, cEnd, c, dim, d, startC, endC, offsetC, offsetF, m;
32286f3d3cbcSMatthew G. Knepley   PetscBool     *needAvg;
32297c927364SMatthew G. Knepley 
32307c927364SMatthew G. Knepley   PetscFunctionBegin;
3231*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventBegin(DMPLEX_InjectorFEM,dmc,dmf,0,0));
3232*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dmf, &dim));
3233*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dmf, &fsection));
3234*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetGlobalSection(dmf, &fglobalSection));
3235*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dmc, &csection));
3236*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetGlobalSection(dmc, &cglobalSection));
3237*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetNumFields(fsection, &Nf));
3238*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetSimplexOrBoxCells(dmc, 0, &cStart, &cEnd));
3239*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDS(dmc, &prob));
3240*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscCalloc3(Nf,&feRef,Nf,&fvRef,Nf,&needAvg));
32417c927364SMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
324297c42addSMatthew G. Knepley     PetscObject  obj;
324397c42addSMatthew G. Knepley     PetscClassId id;
3244aa7890ccSMatthew G. Knepley     PetscInt     fNb = 0, Nc = 0;
32457c927364SMatthew G. Knepley 
3246*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, f, &obj));
3247*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
324897c42addSMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
324997c42addSMatthew G. Knepley       PetscFE    fe = (PetscFE) obj;
32506f3d3cbcSMatthew G. Knepley       PetscSpace sp;
32519b2fc754SMatthew G. Knepley       PetscInt   maxDegree;
325297c42addSMatthew G. Knepley 
3253*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFERefine(fe, &feRef[f]));
3254*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetDimension(feRef[f], &fNb));
3255*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetNumComponents(fe, &Nc));
3256*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetBasisSpace(fe, &sp));
3257*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscSpaceGetDegree(sp, NULL, &maxDegree));
32589b2fc754SMatthew G. Knepley       if (!maxDegree) needAvg[f] = PETSC_TRUE;
325997c42addSMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
326097c42addSMatthew G. Knepley       PetscFV        fv = (PetscFV) obj;
326197c42addSMatthew G. Knepley       PetscDualSpace Q;
326297c42addSMatthew G. Knepley 
3263*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVRefine(fv, &fvRef[f]));
3264*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetDualSpace(fvRef[f], &Q));
3265*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDualSpaceGetDimension(Q, &fNb));
3266*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetNumComponents(fv, &Nc));
32676f3d3cbcSMatthew G. Knepley       needAvg[f] = PETSC_TRUE;
326897c42addSMatthew G. Knepley     }
3269d172c84bSMatthew G. Knepley     fTotDim += fNb;
32707c927364SMatthew G. Knepley   }
3271*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetTotalDimension(prob, &cTotDim));
3272*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc1(cTotDim,&cmap));
32737c927364SMatthew G. Knepley   for (field = 0, offsetC = 0, offsetF = 0; field < Nf; ++field) {
32747c927364SMatthew G. Knepley     PetscFE        feC;
327597c42addSMatthew G. Knepley     PetscFV        fvC;
32767c927364SMatthew G. Knepley     PetscDualSpace QF, QC;
3277d172c84bSMatthew G. Knepley     PetscInt       order = -1, NcF, NcC, fpdim, cpdim;
32787c927364SMatthew G. Knepley 
327997c42addSMatthew G. Knepley     if (feRef[field]) {
3280*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetDiscretization(prob, field, (PetscObject *) &feC));
3281*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetNumComponents(feC, &NcC));
3282*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetNumComponents(feRef[field], &NcF));
3283*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetDualSpace(feRef[field], &QF));
3284*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDualSpaceGetOrder(QF, &order));
3285*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDualSpaceGetDimension(QF, &fpdim));
3286*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetDualSpace(feC, &QC));
3287*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDualSpaceGetDimension(QC, &cpdim));
328897c42addSMatthew G. Knepley     } else {
3289*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetDiscretization(prob, field, (PetscObject *) &fvC));
3290*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetNumComponents(fvC, &NcC));
3291*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetNumComponents(fvRef[field], &NcF));
3292*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetDualSpace(fvRef[field], &QF));
3293*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDualSpaceGetDimension(QF, &fpdim));
3294*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetDualSpace(fvC, &QC));
3295*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDualSpaceGetDimension(QC, &cpdim));
329697c42addSMatthew G. Knepley     }
3297*5f80ce2aSJacob Faibussowitsch     PetscCheck(NcF == NcC,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of components in fine space field %D does not match coarse field %D", NcF, NcC);
32987c927364SMatthew G. Knepley     for (c = 0; c < cpdim; ++c) {
32997c927364SMatthew G. Knepley       PetscQuadrature  cfunc;
3300d172c84bSMatthew G. Knepley       const PetscReal *cqpoints, *cqweights;
3301d172c84bSMatthew G. Knepley       PetscInt         NqcC, NpC;
330297c42addSMatthew G. Knepley       PetscBool        found = PETSC_FALSE;
33037c927364SMatthew G. Knepley 
3304*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDualSpaceGetFunctional(QC, c, &cfunc));
3305*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscQuadratureGetData(cfunc, NULL, &NqcC, &NpC, &cqpoints, &cqweights));
3306*5f80ce2aSJacob Faibussowitsch       PetscCheck(NqcC == NcC,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of quadrature components %D must match number of field components %D", NqcC, NcC);
33072c71b3e2SJacob Faibussowitsch       PetscCheckFalse(NpC != 1 && feRef[field],PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Do not know how to do injection for moments");
33087c927364SMatthew G. Knepley       for (f = 0; f < fpdim; ++f) {
33097c927364SMatthew G. Knepley         PetscQuadrature  ffunc;
3310d172c84bSMatthew G. Knepley         const PetscReal *fqpoints, *fqweights;
33117c927364SMatthew G. Knepley         PetscReal        sum = 0.0;
3312d172c84bSMatthew G. Knepley         PetscInt         NqcF, NpF;
33137c927364SMatthew G. Knepley 
3314*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDualSpaceGetFunctional(QF, f, &ffunc));
3315*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscQuadratureGetData(ffunc, NULL, &NqcF, &NpF, &fqpoints, &fqweights));
3316*5f80ce2aSJacob Faibussowitsch         PetscCheck(NqcF == NcF,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of quadrature components %D must match number of field components %D", NqcF, NcF);
33177c927364SMatthew G. Knepley         if (NpC != NpF) continue;
33187c927364SMatthew G. Knepley         for (d = 0; d < dim; ++d) sum += PetscAbsReal(cqpoints[d] - fqpoints[d]);
33197c927364SMatthew G. Knepley         if (sum > 1.0e-9) continue;
3320d172c84bSMatthew G. Knepley         for (d = 0; d < NcC; ++d) sum += PetscAbsReal(cqweights[d]*fqweights[d]);
3321d172c84bSMatthew G. Knepley         if (sum < 1.0e-9) continue;
3322d172c84bSMatthew G. Knepley         cmap[offsetC+c] = offsetF+f;
332397c42addSMatthew G. Knepley         found = PETSC_TRUE;
33247c927364SMatthew G. Knepley         break;
33257c927364SMatthew G. Knepley       }
332697c42addSMatthew G. Knepley       if (!found) {
332797c42addSMatthew G. Knepley         /* TODO We really want the average here, but some asshole put VecScatter in the interface */
3328d172c84bSMatthew G. Knepley         if (fvRef[field] || (feRef[field] && order == 0)) {
3329d172c84bSMatthew G. Knepley           cmap[offsetC+c] = offsetF+0;
333097c42addSMatthew G. Knepley         } else SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Could not locate matching functional for injection");
333197c42addSMatthew G. Knepley       }
33327c927364SMatthew G. Knepley     }
3333d172c84bSMatthew G. Knepley     offsetC += cpdim;
3334d172c84bSMatthew G. Knepley     offsetF += fpdim;
33357c927364SMatthew G. Knepley   }
3336*5f80ce2aSJacob Faibussowitsch   for (f = 0; f < Nf; ++f) {CHKERRQ(PetscFEDestroy(&feRef[f]));CHKERRQ(PetscFVDestroy(&fvRef[f]));}
3337*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree3(feRef,fvRef,needAvg));
33387c927364SMatthew G. Knepley 
3339*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetGlobalVector(dmf, &fv));
3340*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetGlobalVector(dmc, &cv));
3341*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetOwnershipRange(cv, &startC, &endC));
3342*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetConstrainedStorageSize(cglobalSection, &m));
3343*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc2(cTotDim,&cellCIndices,fTotDim,&cellFIndices));
3344*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc1(m,&cindices));
3345*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc1(m,&findices));
33467c927364SMatthew G. Knepley   for (d = 0; d < m; ++d) cindices[d] = findices[d] = -1;
33477c927364SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
3348*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexMatGetClosureIndicesRefined(dmf, fsection, fglobalSection, dmc, csection, cglobalSection, c, cellCIndices, cellFIndices));
33497c927364SMatthew G. Knepley     for (d = 0; d < cTotDim; ++d) {
33500bd915a7SMatthew G. Knepley       if ((cellCIndices[d] < startC) || (cellCIndices[d] >= endC)) continue;
33512c71b3e2SJacob Faibussowitsch       PetscCheckFalse((findices[cellCIndices[d]-startC] >= 0) && (findices[cellCIndices[d]-startC] != cellFIndices[cmap[d]]),PETSC_COMM_SELF, PETSC_ERR_PLIB, "Coarse dof %D maps to both %D and %D", cindices[cellCIndices[d]-startC], findices[cellCIndices[d]-startC], cellFIndices[cmap[d]]);
33527c927364SMatthew G. Knepley       cindices[cellCIndices[d]-startC] = cellCIndices[d];
33537c927364SMatthew G. Knepley       findices[cellCIndices[d]-startC] = cellFIndices[cmap[d]];
33547c927364SMatthew G. Knepley     }
33557c927364SMatthew G. Knepley   }
3356*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree(cmap));
3357*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree2(cellCIndices,cellFIndices));
33587c927364SMatthew G. Knepley 
3359*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISCreateGeneral(PETSC_COMM_SELF, m, cindices, PETSC_OWN_POINTER, &cis));
3360*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISCreateGeneral(PETSC_COMM_SELF, m, findices, PETSC_OWN_POINTER, &fis));
3361*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecScatterCreate(cv, cis, fv, fis, sc));
3362*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISDestroy(&cis));
3363*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISDestroy(&fis));
3364*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreGlobalVector(dmf, &fv));
3365*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreGlobalVector(dmc, &cv));
3366*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventEnd(DMPLEX_InjectorFEM,dmc,dmf,0,0));
3367cb1e1211SMatthew G Knepley   PetscFunctionReturn(0);
3368cb1e1211SMatthew G Knepley }
3369a1cf66bbSMatthew G. Knepley 
33702f856554SMatthew G. Knepley /*@C
33712f856554SMatthew G. Knepley   DMPlexGetCellFields - Retrieve the field values values for a chunk of cells
33722f856554SMatthew G. Knepley 
33732f856554SMatthew G. Knepley   Input Parameters:
33742f856554SMatthew G. Knepley + dm     - The DM
33752f856554SMatthew G. Knepley . cellIS - The cells to include
33762f856554SMatthew G. Knepley . locX   - A local vector with the solution fields
33772f856554SMatthew G. Knepley . locX_t - A local vector with solution field time derivatives, or NULL
33782f856554SMatthew G. Knepley - locA   - A local vector with auxiliary fields, or NULL
33792f856554SMatthew G. Knepley 
33802f856554SMatthew G. Knepley   Output Parameters:
33812f856554SMatthew G. Knepley + u   - The field coefficients
33822f856554SMatthew G. Knepley . u_t - The fields derivative coefficients
33832f856554SMatthew G. Knepley - a   - The auxiliary field coefficients
33842f856554SMatthew G. Knepley 
33852f856554SMatthew G. Knepley   Level: developer
33862f856554SMatthew G. Knepley 
33872f856554SMatthew G. Knepley .seealso: DMPlexGetFaceFields()
33882f856554SMatthew G. Knepley @*/
33892f856554SMatthew G. Knepley PetscErrorCode DMPlexGetCellFields(DM dm, IS cellIS, Vec locX, Vec locX_t, Vec locA, PetscScalar **u, PetscScalar **u_t, PetscScalar **a)
33902f856554SMatthew G. Knepley {
33912f856554SMatthew G. Knepley   DM              plex, plexA = NULL;
3392a6e0b375SMatthew G. Knepley   DMEnclosureType encAux;
33932f856554SMatthew G. Knepley   PetscSection    section, sectionAux;
33942f856554SMatthew G. Knepley   PetscDS         prob;
33952f856554SMatthew G. Knepley   const PetscInt *cells;
33962f856554SMatthew G. Knepley   PetscInt        cStart, cEnd, numCells, totDim, totDimAux, c;
33972f856554SMatthew G. Knepley 
33982f856554SMatthew G. Knepley   PetscFunctionBegin;
33992f856554SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
3400064a246eSJacob Faibussowitsch   PetscValidHeaderSpecific(locX, VEC_CLASSID, 3);
3401064a246eSJacob Faibussowitsch   if (locX_t) {PetscValidHeaderSpecific(locX_t, VEC_CLASSID, 4);}
3402064a246eSJacob Faibussowitsch   if (locA)   {PetscValidHeaderSpecific(locA, VEC_CLASSID, 5);}
3403064a246eSJacob Faibussowitsch   PetscValidPointer(u, 6);
3404064a246eSJacob Faibussowitsch   PetscValidPointer(u_t, 7);
3405064a246eSJacob Faibussowitsch   PetscValidPointer(a, 8);
3406*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexConvertPlex(dm, &plex, PETSC_FALSE));
3407*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
3408*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &section));
3409*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCellDS(dm, cells ? cells[cStart] : cStart, &prob));
3410*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetTotalDimension(prob, &totDim));
34112f856554SMatthew G. Knepley   if (locA) {
34122f856554SMatthew G. Knepley     DM      dmAux;
34132f856554SMatthew G. Knepley     PetscDS probAux;
34142f856554SMatthew G. Knepley 
3415*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetDM(locA, &dmAux));
3416*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetEnclosureRelation(dmAux, dm, &encAux));
3417*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexConvertPlex(dmAux, &plexA, PETSC_FALSE));
3418*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetLocalSection(dmAux, &sectionAux));
3419*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetDS(dmAux, &probAux));
3420*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetTotalDimension(probAux, &totDimAux));
34212f856554SMatthew G. Knepley   }
34222f856554SMatthew G. Knepley   numCells = cEnd - cStart;
3423*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetWorkArray(dm, numCells*totDim, MPIU_SCALAR, u));
3424*5f80ce2aSJacob Faibussowitsch   if (locX_t) CHKERRQ(DMGetWorkArray(dm, numCells*totDim, MPIU_SCALAR, u_t)); else {*u_t = NULL;}
3425*5f80ce2aSJacob Faibussowitsch   if (locA)   CHKERRQ(DMGetWorkArray(dm, numCells*totDimAux, MPIU_SCALAR, a)); else {*a = NULL;}
34262f856554SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
34272f856554SMatthew G. Knepley     const PetscInt cell = cells ? cells[c] : c;
34282f856554SMatthew G. Knepley     const PetscInt cind = c - cStart;
34292f856554SMatthew G. Knepley     PetscScalar   *x = NULL, *x_t = NULL, *ul = *u, *ul_t = *u_t, *al = *a;
34302f856554SMatthew G. Knepley     PetscInt       i;
34312f856554SMatthew G. Knepley 
3432*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecGetClosure(plex, section, locX, cell, NULL, &x));
34332f856554SMatthew G. Knepley     for (i = 0; i < totDim; ++i) ul[cind*totDim+i] = x[i];
3434*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecRestoreClosure(plex, section, locX, cell, NULL, &x));
34352f856554SMatthew G. Knepley     if (locX_t) {
3436*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecGetClosure(plex, section, locX_t, cell, NULL, &x_t));
34372f856554SMatthew G. Knepley       for (i = 0; i < totDim; ++i) ul_t[cind*totDim+i] = x_t[i];
3438*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecRestoreClosure(plex, section, locX_t, cell, NULL, &x_t));
34392f856554SMatthew G. Knepley     }
34402f856554SMatthew G. Knepley     if (locA) {
34412f856554SMatthew G. Knepley       PetscInt subcell;
3442*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMGetEnclosurePoint(plexA, dm, encAux, cell, &subcell));
3443*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecGetClosure(plexA, sectionAux, locA, subcell, NULL, &x));
34442f856554SMatthew G. Knepley       for (i = 0; i < totDimAux; ++i) al[cind*totDimAux+i] = x[i];
3445*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecRestoreClosure(plexA, sectionAux, locA, subcell, NULL, &x));
34462f856554SMatthew G. Knepley     }
34472f856554SMatthew G. Knepley   }
3448*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMDestroy(&plex));
3449*5f80ce2aSJacob Faibussowitsch   if (locA) CHKERRQ(DMDestroy(&plexA));
3450*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
34512f856554SMatthew G. Knepley   PetscFunctionReturn(0);
34522f856554SMatthew G. Knepley }
34532f856554SMatthew G. Knepley 
34542f856554SMatthew G. Knepley /*@C
34552f856554SMatthew G. Knepley   DMPlexRestoreCellFields - Restore the field values values for a chunk of cells
34562f856554SMatthew G. Knepley 
34572f856554SMatthew G. Knepley   Input Parameters:
34582f856554SMatthew G. Knepley + dm     - The DM
34592f856554SMatthew G. Knepley . cellIS - The cells to include
34602f856554SMatthew G. Knepley . locX   - A local vector with the solution fields
34612f856554SMatthew G. Knepley . locX_t - A local vector with solution field time derivatives, or NULL
34622f856554SMatthew G. Knepley - locA   - A local vector with auxiliary fields, or NULL
34632f856554SMatthew G. Knepley 
34642f856554SMatthew G. Knepley   Output Parameters:
34652f856554SMatthew G. Knepley + u   - The field coefficients
34662f856554SMatthew G. Knepley . u_t - The fields derivative coefficients
34672f856554SMatthew G. Knepley - a   - The auxiliary field coefficients
34682f856554SMatthew G. Knepley 
34692f856554SMatthew G. Knepley   Level: developer
34702f856554SMatthew G. Knepley 
34712f856554SMatthew G. Knepley .seealso: DMPlexGetFaceFields()
34722f856554SMatthew G. Knepley @*/
34732f856554SMatthew G. Knepley PetscErrorCode DMPlexRestoreCellFields(DM dm, IS cellIS, Vec locX, Vec locX_t, Vec locA, PetscScalar **u, PetscScalar **u_t, PetscScalar **a)
34742f856554SMatthew G. Knepley {
34752f856554SMatthew G. Knepley   PetscFunctionBegin;
3476*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreWorkArray(dm, 0, MPIU_SCALAR, u));
3477*5f80ce2aSJacob Faibussowitsch   if (locX_t) CHKERRQ(DMRestoreWorkArray(dm, 0, MPIU_SCALAR, u_t));
3478*5f80ce2aSJacob Faibussowitsch   if (locA)   CHKERRQ(DMRestoreWorkArray(dm, 0, MPIU_SCALAR, a));
34792f856554SMatthew G. Knepley   PetscFunctionReturn(0);
34802f856554SMatthew G. Knepley }
34812f856554SMatthew G. Knepley 
3482faff4f7fSMatthew G. Knepley /*
3483faff4f7fSMatthew G. Knepley   Get the auxiliary field vectors for the negative side (s = 0) and positive side (s = 1) of the interfaace
3484faff4f7fSMatthew G. Knepley */
3485148442b3SMatthew G. Knepley static PetscErrorCode DMPlexGetHybridAuxFields(DM dm, DM dmAux[], PetscDS dsAux[], IS cellIS, Vec locA[], PetscScalar *a[])
34866528b96dSMatthew G. Knepley {
348704c51a94SMatthew G. Knepley   DM              plexA[2];
3488148442b3SMatthew G. Knepley   DMEnclosureType encAux[2];
348904c51a94SMatthew G. Knepley   PetscSection    sectionAux[2];
34906528b96dSMatthew G. Knepley   const PetscInt *cells;
3491148442b3SMatthew G. Knepley   PetscInt        cStart, cEnd, numCells, c, s, totDimAux[2];
34926528b96dSMatthew G. Knepley 
34936528b96dSMatthew G. Knepley   PetscFunctionBegin;
3494148442b3SMatthew G. Knepley   PetscValidPointer(locA, 5);
349504c51a94SMatthew G. Knepley   if (!locA[0] || !locA[1]) PetscFunctionReturn(0);
3496148442b3SMatthew G. Knepley   PetscValidPointer(dmAux, 2);
3497148442b3SMatthew G. Knepley   PetscValidPointer(dsAux, 3);
3498148442b3SMatthew G. Knepley   PetscValidPointer(a, 6);
3499*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
35006528b96dSMatthew G. Knepley   numCells = cEnd - cStart;
3501148442b3SMatthew G. Knepley   for (s = 0; s < 2; ++s) {
3502148442b3SMatthew G. Knepley     PetscValidHeaderSpecific(dmAux[s], DM_CLASSID, 2);
3503148442b3SMatthew G. Knepley     PetscValidHeaderSpecific(dsAux[s], PETSCDS_CLASSID, 3);
3504148442b3SMatthew G. Knepley     PetscValidHeaderSpecific(locA[s], VEC_CLASSID, 5);
3505*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexConvertPlex(dmAux[s], &plexA[s], PETSC_FALSE));
3506*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetEnclosureRelation(dmAux[s], dm, &encAux[s]));
3507*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetLocalSection(dmAux[s], &sectionAux[s]));
3508*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetTotalDimension(dsAux[s], &totDimAux[s]));
3509*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetWorkArray(dmAux[s], numCells*totDimAux[s], MPIU_SCALAR, &a[s]));
351004c51a94SMatthew G. Knepley   }
3511148442b3SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
35126528b96dSMatthew G. Knepley     const PetscInt  cell = cells ? cells[c] : c;
35136528b96dSMatthew G. Knepley     const PetscInt  cind = c - cStart;
35146528b96dSMatthew G. Knepley     const PetscInt *cone, *ornt;
35156528b96dSMatthew G. Knepley 
3516*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexGetCone(dm, cell, &cone));
3517*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexGetConeOrientation(dm, cell, &ornt));
35182c71b3e2SJacob Faibussowitsch     PetscCheckFalse(ornt[0],PETSC_COMM_SELF, PETSC_ERR_SUP, "Face %D in hybrid cell %D has orientation %D != 0", cone[0], cell, ornt[0]);
3519148442b3SMatthew G. Knepley     for (s = 0; s < 2; ++s) {
35205fedec97SMatthew G. Knepley       const PetscInt *support;
3521148442b3SMatthew G. Knepley       PetscScalar    *x = NULL, *al = a[s];
3522148442b3SMatthew G. Knepley       const PetscInt  tdA = totDimAux[s];
35235fedec97SMatthew G. Knepley       PetscInt        ssize, scell;
3524148442b3SMatthew G. Knepley       PetscInt        subface, Na, i;
35256528b96dSMatthew G. Knepley 
3526*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetSupport(dm, cone[s], &support));
3527*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetSupportSize(dm, cone[s], &ssize));
35282c71b3e2SJacob Faibussowitsch       PetscCheckFalse(ssize != 2,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Face %D from cell %D has support size %D != 2", cone[s], cell, ssize);
35295fedec97SMatthew G. Knepley       if      (support[0] == cell) scell = support[1];
35305fedec97SMatthew G. Knepley       else if (support[1] == cell) scell = support[0];
353198921bdaSJacob Faibussowitsch       else SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Face %D does not have cell %D in its support", cone[s], cell);
35325fedec97SMatthew G. Knepley 
3533*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMGetEnclosurePoint(plexA[s], dm, encAux[s], scell, &subface));
3534*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecGetClosure(plexA[s], sectionAux[s], locA[s], subface, &Na, &x));
35356528b96dSMatthew G. Knepley       for (i = 0; i < Na; ++i) al[cind*tdA+i] = x[i];
3536*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecRestoreClosure(plexA[s], sectionAux[s], locA[s], subface, &Na, &x));
35376528b96dSMatthew G. Knepley     }
35386528b96dSMatthew G. Knepley   }
3539*5f80ce2aSJacob Faibussowitsch   for (s = 0; s < 2; ++s) CHKERRQ(DMDestroy(&plexA[s]));
3540*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
35416528b96dSMatthew G. Knepley   PetscFunctionReturn(0);
35426528b96dSMatthew G. Knepley }
35436528b96dSMatthew G. Knepley 
354404c51a94SMatthew G. Knepley static PetscErrorCode DMPlexRestoreHybridAuxFields(DM dmAux[], PetscDS dsAux[], IS cellIS, Vec locA[], PetscScalar *a[])
35456528b96dSMatthew G. Knepley {
35466528b96dSMatthew G. Knepley   PetscFunctionBegin;
354704c51a94SMatthew G. Knepley   if (!locA[0] || !locA[1]) PetscFunctionReturn(0);
3548*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreWorkArray(dmAux[0], 0, MPIU_SCALAR, &a[0]));
3549*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreWorkArray(dmAux[1], 0, MPIU_SCALAR, &a[1]));
35506528b96dSMatthew G. Knepley   PetscFunctionReturn(0);
35516528b96dSMatthew G. Knepley }
35526528b96dSMatthew G. Knepley 
35532f856554SMatthew G. Knepley /*@C
35542f856554SMatthew G. Knepley   DMPlexGetFaceFields - Retrieve the field values values for a chunk of faces
35552f856554SMatthew G. Knepley 
35562f856554SMatthew G. Knepley   Input Parameters:
35572f856554SMatthew G. Knepley + dm     - The DM
35582f856554SMatthew G. Knepley . fStart - The first face to include
35592f856554SMatthew G. Knepley . fEnd   - The first face to exclude
35602f856554SMatthew G. Knepley . locX   - A local vector with the solution fields
35612f856554SMatthew G. Knepley . locX_t - A local vector with solution field time derivatives, or NULL
35622f856554SMatthew G. Knepley . faceGeometry - A local vector with face geometry
35632f856554SMatthew G. Knepley . cellGeometry - A local vector with cell geometry
35642f856554SMatthew G. Knepley - locaGrad - A local vector with field gradients, or NULL
35652f856554SMatthew G. Knepley 
35662f856554SMatthew G. Knepley   Output Parameters:
35672f856554SMatthew G. Knepley + Nface - The number of faces with field values
35682f856554SMatthew G. Knepley . uL - The field values at the left side of the face
35692f856554SMatthew G. Knepley - uR - The field values at the right side of the face
35702f856554SMatthew G. Knepley 
35712f856554SMatthew G. Knepley   Level: developer
35722f856554SMatthew G. Knepley 
35732f856554SMatthew G. Knepley .seealso: DMPlexGetCellFields()
35742f856554SMatthew G. Knepley @*/
35752f856554SMatthew G. Knepley PetscErrorCode DMPlexGetFaceFields(DM dm, PetscInt fStart, PetscInt fEnd, Vec locX, Vec locX_t, Vec faceGeometry, Vec cellGeometry, Vec locGrad, PetscInt *Nface, PetscScalar **uL, PetscScalar **uR)
35762f856554SMatthew G. Knepley {
35772f856554SMatthew G. Knepley   DM                 dmFace, dmCell, dmGrad = NULL;
35782f856554SMatthew G. Knepley   PetscSection       section;
35792f856554SMatthew G. Knepley   PetscDS            prob;
35802f856554SMatthew G. Knepley   DMLabel            ghostLabel;
35812f856554SMatthew G. Knepley   const PetscScalar *facegeom, *cellgeom, *x, *lgrad;
35822f856554SMatthew G. Knepley   PetscBool         *isFE;
35832f856554SMatthew G. Knepley   PetscInt           dim, Nf, f, Nc, numFaces = fEnd - fStart, iface, face;
35842f856554SMatthew G. Knepley 
35852f856554SMatthew G. Knepley   PetscFunctionBegin;
35862f856554SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
35872f856554SMatthew G. Knepley   PetscValidHeaderSpecific(locX, VEC_CLASSID, 4);
35882f856554SMatthew G. Knepley   if (locX_t) {PetscValidHeaderSpecific(locX_t, VEC_CLASSID, 5);}
35892f856554SMatthew G. Knepley   PetscValidHeaderSpecific(faceGeometry, VEC_CLASSID, 6);
35902f856554SMatthew G. Knepley   PetscValidHeaderSpecific(cellGeometry, VEC_CLASSID, 7);
35912f856554SMatthew G. Knepley   if (locGrad) {PetscValidHeaderSpecific(locGrad, VEC_CLASSID, 8);}
3592064a246eSJacob Faibussowitsch   PetscValidPointer(uL, 10);
3593064a246eSJacob Faibussowitsch   PetscValidPointer(uR, 11);
3594*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dm, &dim));
3595*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDS(dm, &prob));
3596*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &section));
3597*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetNumFields(prob, &Nf));
3598*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetTotalComponents(prob, &Nc));
3599*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc1(Nf, &isFE));
36002f856554SMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
36012f856554SMatthew G. Knepley     PetscObject  obj;
36022f856554SMatthew G. Knepley     PetscClassId id;
36032f856554SMatthew G. Knepley 
3604*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, f, &obj));
3605*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
36062f856554SMatthew G. Knepley     if (id == PETSCFE_CLASSID)      {isFE[f] = PETSC_TRUE;}
36072f856554SMatthew G. Knepley     else if (id == PETSCFV_CLASSID) {isFE[f] = PETSC_FALSE;}
36082f856554SMatthew G. Knepley     else                            {isFE[f] = PETSC_FALSE;}
36092f856554SMatthew G. Knepley   }
3610*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLabel(dm, "ghost", &ghostLabel));
3611*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetArrayRead(locX, &x));
3612*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetDM(faceGeometry, &dmFace));
3613*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetArrayRead(faceGeometry, &facegeom));
3614*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetDM(cellGeometry, &dmCell));
3615*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetArrayRead(cellGeometry, &cellgeom));
36162f856554SMatthew G. Knepley   if (locGrad) {
3617*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetDM(locGrad, &dmGrad));
3618*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetArrayRead(locGrad, &lgrad));
36192f856554SMatthew G. Knepley   }
3620*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetWorkArray(dm, numFaces*Nc, MPIU_SCALAR, uL));
3621*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetWorkArray(dm, numFaces*Nc, MPIU_SCALAR, uR));
36222f856554SMatthew G. Knepley   /* Right now just eat the extra work for FE (could make a cell loop) */
36232f856554SMatthew G. Knepley   for (face = fStart, iface = 0; face < fEnd; ++face) {
36242f856554SMatthew G. Knepley     const PetscInt        *cells;
36252f856554SMatthew G. Knepley     PetscFVFaceGeom       *fg;
36262f856554SMatthew G. Knepley     PetscFVCellGeom       *cgL, *cgR;
36272f856554SMatthew G. Knepley     PetscScalar           *xL, *xR, *gL, *gR;
36282f856554SMatthew G. Knepley     PetscScalar           *uLl = *uL, *uRl = *uR;
36292f856554SMatthew G. Knepley     PetscInt               ghost, nsupp, nchild;
36302f856554SMatthew G. Knepley 
3631*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMLabelGetValue(ghostLabel, face, &ghost));
3632*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexGetSupportSize(dm, face, &nsupp));
3633*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexGetTreeChildren(dm, face, &nchild, NULL));
36342f856554SMatthew G. Knepley     if (ghost >= 0 || nsupp > 2 || nchild > 0) continue;
3635*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexPointLocalRead(dmFace, face, facegeom, &fg));
3636*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexGetSupport(dm, face, &cells));
3637*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexPointLocalRead(dmCell, cells[0], cellgeom, &cgL));
3638*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexPointLocalRead(dmCell, cells[1], cellgeom, &cgR));
36392f856554SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
36402f856554SMatthew G. Knepley       PetscInt off;
36412f856554SMatthew G. Knepley 
3642*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetComponentOffset(prob, f, &off));
36432f856554SMatthew G. Knepley       if (isFE[f]) {
36442f856554SMatthew G. Knepley         const PetscInt *cone;
36452f856554SMatthew G. Knepley         PetscInt        comp, coneSizeL, coneSizeR, faceLocL, faceLocR, ldof, rdof, d;
36462f856554SMatthew G. Knepley 
36472f856554SMatthew G. Knepley         xL = xR = NULL;
3648*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscSectionGetFieldComponents(section, f, &comp));
3649*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecGetClosure(dm, section, locX, cells[0], &ldof, (PetscScalar **) &xL));
3650*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecGetClosure(dm, section, locX, cells[1], &rdof, (PetscScalar **) &xR));
3651*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexGetCone(dm, cells[0], &cone));
3652*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexGetConeSize(dm, cells[0], &coneSizeL));
36532f856554SMatthew G. Knepley         for (faceLocL = 0; faceLocL < coneSizeL; ++faceLocL) if (cone[faceLocL] == face) break;
3654*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexGetCone(dm, cells[1], &cone));
3655*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexGetConeSize(dm, cells[1], &coneSizeR));
36562f856554SMatthew G. Knepley         for (faceLocR = 0; faceLocR < coneSizeR; ++faceLocR) if (cone[faceLocR] == face) break;
36572c71b3e2SJacob Faibussowitsch         PetscCheckFalse(faceLocL == coneSizeL && faceLocR == coneSizeR,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Could not find face %D in cone of cell %D or cell %D", face, cells[0], cells[1]);
36582f856554SMatthew G. Knepley         /* Check that FEM field has values in the right cell (sometimes its an FV ghost cell) */
36592f856554SMatthew G. Knepley         /* TODO: this is a hack that might not be right for nonconforming */
36602f856554SMatthew G. Knepley         if (faceLocL < coneSizeL) {
3661*5f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEEvaluateFaceFields_Internal(prob, f, faceLocL, xL, &uLl[iface*Nc+off]));
3662*5f80ce2aSJacob Faibussowitsch           if (rdof == ldof && faceLocR < coneSizeR) CHKERRQ(PetscFEEvaluateFaceFields_Internal(prob, f, faceLocR, xR, &uRl[iface*Nc+off]));
36632f856554SMatthew G. Knepley           else              {for (d = 0; d < comp; ++d) uRl[iface*Nc+off+d] = uLl[iface*Nc+off+d];}
36642f856554SMatthew G. Knepley         }
36652f856554SMatthew G. Knepley         else {
3666*5f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEEvaluateFaceFields_Internal(prob, f, faceLocR, xR, &uRl[iface*Nc+off]));
3667*5f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscSectionGetFieldComponents(section, f, &comp));
36682f856554SMatthew G. Knepley           for (d = 0; d < comp; ++d) uLl[iface*Nc+off+d] = uRl[iface*Nc+off+d];
36692f856554SMatthew G. Knepley         }
3670*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecRestoreClosure(dm, section, locX, cells[0], &ldof, (PetscScalar **) &xL));
3671*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecRestoreClosure(dm, section, locX, cells[1], &rdof, (PetscScalar **) &xR));
36722f856554SMatthew G. Knepley       } else {
36732f856554SMatthew G. Knepley         PetscFV  fv;
36742f856554SMatthew G. Knepley         PetscInt numComp, c;
36752f856554SMatthew G. Knepley 
3676*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDSGetDiscretization(prob, f, (PetscObject *) &fv));
3677*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFVGetNumComponents(fv, &numComp));
3678*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexPointLocalFieldRead(dm, cells[0], f, x, &xL));
3679*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexPointLocalFieldRead(dm, cells[1], f, x, &xR));
36802f856554SMatthew G. Knepley         if (dmGrad) {
36812f856554SMatthew G. Knepley           PetscReal dxL[3], dxR[3];
36822f856554SMatthew G. Knepley 
3683*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexPointLocalRead(dmGrad, cells[0], lgrad, &gL));
3684*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexPointLocalRead(dmGrad, cells[1], lgrad, &gR));
36852f856554SMatthew G. Knepley           DMPlex_WaxpyD_Internal(dim, -1, cgL->centroid, fg->centroid, dxL);
36862f856554SMatthew G. Knepley           DMPlex_WaxpyD_Internal(dim, -1, cgR->centroid, fg->centroid, dxR);
36872f856554SMatthew G. Knepley           for (c = 0; c < numComp; ++c) {
36882f856554SMatthew G. Knepley             uLl[iface*Nc+off+c] = xL[c] + DMPlex_DotD_Internal(dim, &gL[c*dim], dxL);
36892f856554SMatthew G. Knepley             uRl[iface*Nc+off+c] = xR[c] + DMPlex_DotD_Internal(dim, &gR[c*dim], dxR);
36902f856554SMatthew G. Knepley           }
36912f856554SMatthew G. Knepley         } else {
36922f856554SMatthew G. Knepley           for (c = 0; c < numComp; ++c) {
36932f856554SMatthew G. Knepley             uLl[iface*Nc+off+c] = xL[c];
36942f856554SMatthew G. Knepley             uRl[iface*Nc+off+c] = xR[c];
36952f856554SMatthew G. Knepley           }
36962f856554SMatthew G. Knepley         }
36972f856554SMatthew G. Knepley       }
36982f856554SMatthew G. Knepley     }
36992f856554SMatthew G. Knepley     ++iface;
37002f856554SMatthew G. Knepley   }
37012f856554SMatthew G. Knepley   *Nface = iface;
3702*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecRestoreArrayRead(locX, &x));
3703*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecRestoreArrayRead(faceGeometry, &facegeom));
3704*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecRestoreArrayRead(cellGeometry, &cellgeom));
37052f856554SMatthew G. Knepley   if (locGrad) {
3706*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecRestoreArrayRead(locGrad, &lgrad));
37072f856554SMatthew G. Knepley   }
3708*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree(isFE));
37092f856554SMatthew G. Knepley   PetscFunctionReturn(0);
37102f856554SMatthew G. Knepley }
37112f856554SMatthew G. Knepley 
37122f856554SMatthew G. Knepley /*@C
37132f856554SMatthew G. Knepley   DMPlexRestoreFaceFields - Restore the field values values for a chunk of faces
37142f856554SMatthew G. Knepley 
37152f856554SMatthew G. Knepley   Input Parameters:
37162f856554SMatthew G. Knepley + dm     - The DM
37172f856554SMatthew G. Knepley . fStart - The first face to include
37182f856554SMatthew G. Knepley . fEnd   - The first face to exclude
37192f856554SMatthew G. Knepley . locX   - A local vector with the solution fields
37202f856554SMatthew G. Knepley . locX_t - A local vector with solution field time derivatives, or NULL
37212f856554SMatthew G. Knepley . faceGeometry - A local vector with face geometry
37222f856554SMatthew G. Knepley . cellGeometry - A local vector with cell geometry
37232f856554SMatthew G. Knepley - locaGrad - A local vector with field gradients, or NULL
37242f856554SMatthew G. Knepley 
37252f856554SMatthew G. Knepley   Output Parameters:
37262f856554SMatthew G. Knepley + Nface - The number of faces with field values
37272f856554SMatthew G. Knepley . uL - The field values at the left side of the face
37282f856554SMatthew G. Knepley - uR - The field values at the right side of the face
37292f856554SMatthew G. Knepley 
37302f856554SMatthew G. Knepley   Level: developer
37312f856554SMatthew G. Knepley 
37322f856554SMatthew G. Knepley .seealso: DMPlexGetFaceFields()
37332f856554SMatthew G. Knepley @*/
37342f856554SMatthew G. Knepley PetscErrorCode DMPlexRestoreFaceFields(DM dm, PetscInt fStart, PetscInt fEnd, Vec locX, Vec locX_t, Vec faceGeometry, Vec cellGeometry, Vec locGrad, PetscInt *Nface, PetscScalar **uL, PetscScalar **uR)
37352f856554SMatthew G. Knepley {
37362f856554SMatthew G. Knepley   PetscFunctionBegin;
3737*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreWorkArray(dm, 0, MPIU_SCALAR, uL));
3738*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreWorkArray(dm, 0, MPIU_SCALAR, uR));
37392f856554SMatthew G. Knepley   PetscFunctionReturn(0);
37402f856554SMatthew G. Knepley }
37412f856554SMatthew G. Knepley 
37422f856554SMatthew G. Knepley /*@C
37432f856554SMatthew G. Knepley   DMPlexGetFaceGeometry - Retrieve the geometric values for a chunk of faces
37442f856554SMatthew G. Knepley 
37452f856554SMatthew G. Knepley   Input Parameters:
37462f856554SMatthew G. Knepley + dm     - The DM
37472f856554SMatthew G. Knepley . fStart - The first face to include
37482f856554SMatthew G. Knepley . fEnd   - The first face to exclude
37492f856554SMatthew G. Knepley . faceGeometry - A local vector with face geometry
37502f856554SMatthew G. Knepley - cellGeometry - A local vector with cell geometry
37512f856554SMatthew G. Knepley 
37522f856554SMatthew G. Knepley   Output Parameters:
37532f856554SMatthew G. Knepley + Nface - The number of faces with field values
37542f856554SMatthew G. Knepley . fgeom - The extract the face centroid and normal
37552f856554SMatthew G. Knepley - vol   - The cell volume
37562f856554SMatthew G. Knepley 
37572f856554SMatthew G. Knepley   Level: developer
37582f856554SMatthew G. Knepley 
37592f856554SMatthew G. Knepley .seealso: DMPlexGetCellFields()
37602f856554SMatthew G. Knepley @*/
37612f856554SMatthew G. Knepley PetscErrorCode DMPlexGetFaceGeometry(DM dm, PetscInt fStart, PetscInt fEnd, Vec faceGeometry, Vec cellGeometry, PetscInt *Nface, PetscFVFaceGeom **fgeom, PetscReal **vol)
37622f856554SMatthew G. Knepley {
37632f856554SMatthew G. Knepley   DM                 dmFace, dmCell;
37642f856554SMatthew G. Knepley   DMLabel            ghostLabel;
37652f856554SMatthew G. Knepley   const PetscScalar *facegeom, *cellgeom;
37662f856554SMatthew G. Knepley   PetscInt           dim, numFaces = fEnd - fStart, iface, face;
37672f856554SMatthew G. Knepley 
37682f856554SMatthew G. Knepley   PetscFunctionBegin;
37692f856554SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
37702f856554SMatthew G. Knepley   PetscValidHeaderSpecific(faceGeometry, VEC_CLASSID, 4);
37712f856554SMatthew G. Knepley   PetscValidHeaderSpecific(cellGeometry, VEC_CLASSID, 5);
3772064a246eSJacob Faibussowitsch   PetscValidPointer(fgeom, 7);
3773064a246eSJacob Faibussowitsch   PetscValidPointer(vol, 8);
3774*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dm, &dim));
3775*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLabel(dm, "ghost", &ghostLabel));
3776*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetDM(faceGeometry, &dmFace));
3777*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetArrayRead(faceGeometry, &facegeom));
3778*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetDM(cellGeometry, &dmCell));
3779*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetArrayRead(cellGeometry, &cellgeom));
3780*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc1(numFaces, fgeom));
3781*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetWorkArray(dm, numFaces*2, MPIU_SCALAR, vol));
37822f856554SMatthew G. Knepley   for (face = fStart, iface = 0; face < fEnd; ++face) {
37832f856554SMatthew G. Knepley     const PetscInt        *cells;
37842f856554SMatthew G. Knepley     PetscFVFaceGeom       *fg;
37852f856554SMatthew G. Knepley     PetscFVCellGeom       *cgL, *cgR;
37862f856554SMatthew G. Knepley     PetscFVFaceGeom       *fgeoml = *fgeom;
37872f856554SMatthew G. Knepley     PetscReal             *voll   = *vol;
37882f856554SMatthew G. Knepley     PetscInt               ghost, d, nchild, nsupp;
37892f856554SMatthew G. Knepley 
3790*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMLabelGetValue(ghostLabel, face, &ghost));
3791*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexGetSupportSize(dm, face, &nsupp));
3792*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexGetTreeChildren(dm, face, &nchild, NULL));
37932f856554SMatthew G. Knepley     if (ghost >= 0 || nsupp > 2 || nchild > 0) continue;
3794*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexPointLocalRead(dmFace, face, facegeom, &fg));
3795*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexGetSupport(dm, face, &cells));
3796*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexPointLocalRead(dmCell, cells[0], cellgeom, &cgL));
3797*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexPointLocalRead(dmCell, cells[1], cellgeom, &cgR));
37982f856554SMatthew G. Knepley     for (d = 0; d < dim; ++d) {
37992f856554SMatthew G. Knepley       fgeoml[iface].centroid[d] = fg->centroid[d];
38002f856554SMatthew G. Knepley       fgeoml[iface].normal[d]   = fg->normal[d];
38012f856554SMatthew G. Knepley     }
38022f856554SMatthew G. Knepley     voll[iface*2+0] = cgL->volume;
38032f856554SMatthew G. Knepley     voll[iface*2+1] = cgR->volume;
38042f856554SMatthew G. Knepley     ++iface;
38052f856554SMatthew G. Knepley   }
38062f856554SMatthew G. Knepley   *Nface = iface;
3807*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecRestoreArrayRead(faceGeometry, &facegeom));
3808*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecRestoreArrayRead(cellGeometry, &cellgeom));
38092f856554SMatthew G. Knepley   PetscFunctionReturn(0);
38102f856554SMatthew G. Knepley }
38112f856554SMatthew G. Knepley 
38122f856554SMatthew G. Knepley /*@C
38132f856554SMatthew G. Knepley   DMPlexRestoreFaceGeometry - Restore the field values values for a chunk of faces
38142f856554SMatthew G. Knepley 
38152f856554SMatthew G. Knepley   Input Parameters:
38162f856554SMatthew G. Knepley + dm     - The DM
38172f856554SMatthew G. Knepley . fStart - The first face to include
38182f856554SMatthew G. Knepley . fEnd   - The first face to exclude
38192f856554SMatthew G. Knepley . faceGeometry - A local vector with face geometry
38202f856554SMatthew G. Knepley - cellGeometry - A local vector with cell geometry
38212f856554SMatthew G. Knepley 
38222f856554SMatthew G. Knepley   Output Parameters:
38232f856554SMatthew G. Knepley + Nface - The number of faces with field values
38242f856554SMatthew G. Knepley . fgeom - The extract the face centroid and normal
38252f856554SMatthew G. Knepley - vol   - The cell volume
38262f856554SMatthew G. Knepley 
38272f856554SMatthew G. Knepley   Level: developer
38282f856554SMatthew G. Knepley 
38292f856554SMatthew G. Knepley .seealso: DMPlexGetFaceFields()
38302f856554SMatthew G. Knepley @*/
38312f856554SMatthew G. Knepley PetscErrorCode DMPlexRestoreFaceGeometry(DM dm, PetscInt fStart, PetscInt fEnd, Vec faceGeometry, Vec cellGeometry, PetscInt *Nface, PetscFVFaceGeom **fgeom, PetscReal **vol)
38322f856554SMatthew G. Knepley {
38332f856554SMatthew G. Knepley   PetscFunctionBegin;
3834*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree(*fgeom));
3835*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreWorkArray(dm, 0, MPIU_REAL, vol));
38362f856554SMatthew G. Knepley   PetscFunctionReturn(0);
38372f856554SMatthew G. Knepley }
38382f856554SMatthew G. Knepley 
3839a1cf66bbSMatthew G. Knepley PetscErrorCode DMSNESGetFEGeom(DMField coordField, IS pointIS, PetscQuadrature quad, PetscBool faceData, PetscFEGeom **geom)
3840a1cf66bbSMatthew G. Knepley {
3841a1cf66bbSMatthew G. Knepley   char            composeStr[33] = {0};
3842a1cf66bbSMatthew G. Knepley   PetscObjectId   id;
3843a1cf66bbSMatthew G. Knepley   PetscContainer  container;
3844a1cf66bbSMatthew G. Knepley 
3845a1cf66bbSMatthew G. Knepley   PetscFunctionBegin;
3846*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscObjectGetId((PetscObject)quad,&id));
3847*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSNPrintf(composeStr, 32, "DMSNESGetFEGeom_%x\n", id));
3848*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscObjectQuery((PetscObject) pointIS, composeStr, (PetscObject *) &container));
3849a1cf66bbSMatthew G. Knepley   if (container) {
3850*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscContainerGetPointer(container, (void **) geom));
3851a1cf66bbSMatthew G. Knepley   } else {
3852*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMFieldCreateFEGeom(coordField, pointIS, quad, faceData, geom));
3853*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscContainerCreate(PETSC_COMM_SELF,&container));
3854*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscContainerSetPointer(container, (void *) *geom));
3855*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscContainerSetUserDestroy(container, PetscContainerUserDestroy_PetscFEGeom));
3856*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectCompose((PetscObject) pointIS, composeStr, (PetscObject) container));
3857*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscContainerDestroy(&container));
3858a1cf66bbSMatthew G. Knepley   }
3859a1cf66bbSMatthew G. Knepley   PetscFunctionReturn(0);
3860a1cf66bbSMatthew G. Knepley }
3861a1cf66bbSMatthew G. Knepley 
3862a1cf66bbSMatthew G. Knepley PetscErrorCode DMSNESRestoreFEGeom(DMField coordField, IS pointIS, PetscQuadrature quad, PetscBool faceData, PetscFEGeom **geom)
3863a1cf66bbSMatthew G. Knepley {
3864a1cf66bbSMatthew G. Knepley   PetscFunctionBegin;
3865a1cf66bbSMatthew G. Knepley   *geom = NULL;
3866a1cf66bbSMatthew G. Knepley   PetscFunctionReturn(0);
3867a1cf66bbSMatthew G. Knepley }
3868a1cf66bbSMatthew G. Knepley 
386992d50984SMatthew G. Knepley PetscErrorCode DMPlexComputeResidual_Patch_Internal(DM dm, PetscSection section, IS cellIS, PetscReal t, Vec locX, Vec locX_t, Vec locF, void *user)
387092d50984SMatthew G. Knepley {
387192d50984SMatthew G. Knepley   DM_Plex         *mesh       = (DM_Plex *) dm->data;
387292d50984SMatthew G. Knepley   const char      *name       = "Residual";
387392d50984SMatthew G. Knepley   DM               dmAux      = NULL;
387492d50984SMatthew G. Knepley   DMLabel          ghostLabel = NULL;
387592d50984SMatthew G. Knepley   PetscDS          prob       = NULL;
387692d50984SMatthew G. Knepley   PetscDS          probAux    = NULL;
387792d50984SMatthew G. Knepley   PetscBool        useFEM     = PETSC_FALSE;
387892d50984SMatthew G. Knepley   PetscBool        isImplicit = (locX_t || t == PETSC_MIN_REAL) ? PETSC_TRUE : PETSC_FALSE;
387992d50984SMatthew G. Knepley   DMField          coordField = NULL;
3880c0006e53SPatrick Farrell   Vec              locA;
3881c0006e53SPatrick Farrell   PetscScalar     *u = NULL, *u_t, *a, *uL = NULL, *uR = NULL;
388292d50984SMatthew G. Knepley   IS               chunkIS;
388392d50984SMatthew G. Knepley   const PetscInt  *cells;
388492d50984SMatthew G. Knepley   PetscInt         cStart, cEnd, numCells;
3885364207b6SKarl Rupp   PetscInt         Nf, f, totDim, totDimAux, numChunks, cellChunkSize, chunk, fStart, fEnd;
388692d50984SMatthew G. Knepley   PetscInt         maxDegree = PETSC_MAX_INT;
388706ad1575SMatthew G. Knepley   PetscFormKey key;
388892d50984SMatthew G. Knepley   PetscQuadrature  affineQuad = NULL, *quads = NULL;
388992d50984SMatthew G. Knepley   PetscFEGeom     *affineGeom = NULL, **geoms = NULL;
389092d50984SMatthew G. Knepley 
389192d50984SMatthew G. Knepley   PetscFunctionBegin;
3892*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventBegin(DMPLEX_ResidualFEM,dm,0,0,0));
389392d50984SMatthew G. Knepley   /* FEM+FVM */
389492d50984SMatthew G. Knepley   /* 1: Get sizes from dm and dmAux */
3895*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLabel(dm, "ghost", &ghostLabel));
3896*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDS(dm, &prob));
3897*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetNumFields(prob, &Nf));
3898*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetTotalDimension(prob, &totDim));
3899*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetAuxiliaryVec(dm, NULL, 0, 0, &locA));
390092d50984SMatthew G. Knepley   if (locA) {
3901*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetDM(locA, &dmAux));
3902*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetDS(dmAux, &probAux));
3903*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetTotalDimension(probAux, &totDimAux));
390492d50984SMatthew G. Knepley   }
390592d50984SMatthew G. Knepley   /* 2: Get geometric data */
390692d50984SMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
390792d50984SMatthew G. Knepley     PetscObject  obj;
390892d50984SMatthew G. Knepley     PetscClassId id;
390992d50984SMatthew G. Knepley     PetscBool    fimp;
391092d50984SMatthew G. Knepley 
3911*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetImplicit(prob, f, &fimp));
391292d50984SMatthew G. Knepley     if (isImplicit != fimp) continue;
3913*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, f, &obj));
3914*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
391592d50984SMatthew G. Knepley     if (id == PETSCFE_CLASSID) {useFEM = PETSC_TRUE;}
3916*5f80ce2aSJacob Faibussowitsch     PetscCheck(id != PETSCFV_CLASSID,PETSC_COMM_SELF,PETSC_ERR_ARG_WRONG,"Use of FVM with PCPATCH not yet implemented");
391792d50984SMatthew G. Knepley   }
391892d50984SMatthew G. Knepley   if (useFEM) {
3919*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetCoordinateField(dm, &coordField));
3920*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMFieldGetDegree(coordField,cellIS,NULL,&maxDegree));
392192d50984SMatthew G. Knepley     if (maxDegree <= 1) {
3922*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMFieldCreateDefaultQuadrature(coordField,cellIS,&affineQuad));
392392d50984SMatthew G. Knepley       if (affineQuad) {
3924*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMSNESGetFEGeom(coordField,cellIS,affineQuad,PETSC_FALSE,&affineGeom));
392592d50984SMatthew G. Knepley       }
392692d50984SMatthew G. Knepley     } else {
3927*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscCalloc2(Nf,&quads,Nf,&geoms));
392892d50984SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
392992d50984SMatthew G. Knepley         PetscObject  obj;
393092d50984SMatthew G. Knepley         PetscClassId id;
393192d50984SMatthew G. Knepley         PetscBool    fimp;
393292d50984SMatthew G. Knepley 
3933*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDSGetImplicit(prob, f, &fimp));
393492d50984SMatthew G. Knepley         if (isImplicit != fimp) continue;
3935*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDSGetDiscretization(prob, f, &obj));
3936*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscObjectGetClassId(obj, &id));
393792d50984SMatthew G. Knepley         if (id == PETSCFE_CLASSID) {
393892d50984SMatthew G. Knepley           PetscFE fe = (PetscFE) obj;
393992d50984SMatthew G. Knepley 
3940*5f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEGetQuadrature(fe, &quads[f]));
3941*5f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscObjectReference((PetscObject)quads[f]));
3942*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMSNESGetFEGeom(coordField,cellIS,quads[f],PETSC_FALSE,&geoms[f]));
394392d50984SMatthew G. Knepley         }
394492d50984SMatthew G. Knepley       }
394592d50984SMatthew G. Knepley     }
394692d50984SMatthew G. Knepley   }
394792d50984SMatthew G. Knepley   /* Loop over chunks */
3948*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
3949*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetHeightStratum(dm, 1, &fStart, &fEnd));
3950*5f80ce2aSJacob Faibussowitsch   if (useFEM) CHKERRQ(ISCreate(PETSC_COMM_SELF, &chunkIS));
395192d50984SMatthew G. Knepley   numCells      = cEnd - cStart;
395292d50984SMatthew G. Knepley   numChunks     = 1;
395392d50984SMatthew G. Knepley   cellChunkSize = numCells/numChunks;
395492d50984SMatthew G. Knepley   numChunks     = PetscMin(1,numCells);
39556528b96dSMatthew G. Knepley   key.label     = NULL;
39566528b96dSMatthew G. Knepley   key.value     = 0;
395706ad1575SMatthew G. Knepley   key.part      = 0;
395892d50984SMatthew G. Knepley   for (chunk = 0; chunk < numChunks; ++chunk) {
3959c0006e53SPatrick Farrell     PetscScalar     *elemVec, *fluxL = NULL, *fluxR = NULL;
3960c0006e53SPatrick Farrell     PetscReal       *vol = NULL;
3961c0006e53SPatrick Farrell     PetscFVFaceGeom *fgeom = NULL;
396292d50984SMatthew G. Knepley     PetscInt         cS = cStart+chunk*cellChunkSize, cE = PetscMin(cS+cellChunkSize, cEnd), numCells = cE - cS, c;
3963c0006e53SPatrick Farrell     PetscInt         numFaces = 0;
396492d50984SMatthew G. Knepley 
396592d50984SMatthew G. Knepley     /* Extract field coefficients */
396692d50984SMatthew G. Knepley     if (useFEM) {
3967*5f80ce2aSJacob Faibussowitsch       CHKERRQ(ISGetPointSubrange(chunkIS, cS, cE, cells));
3968*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetCellFields(dm, chunkIS, locX, locX_t, locA, &u, &u_t, &a));
3969*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMGetWorkArray(dm, numCells*totDim, MPIU_SCALAR, &elemVec));
3970*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscArrayzero(elemVec, numCells*totDim));
397192d50984SMatthew G. Knepley     }
397292d50984SMatthew G. Knepley     /* TODO We will interlace both our field coefficients (u, u_t, uL, uR, etc.) and our output (elemVec, fL, fR). I think this works */
397392d50984SMatthew G. Knepley     /* Loop over fields */
397492d50984SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
397592d50984SMatthew G. Knepley       PetscObject  obj;
397692d50984SMatthew G. Knepley       PetscClassId id;
397792d50984SMatthew G. Knepley       PetscBool    fimp;
397892d50984SMatthew G. Knepley       PetscInt     numChunks, numBatches, batchSize, numBlocks, blockSize, Ne, Nr, offset;
397992d50984SMatthew G. Knepley 
39806528b96dSMatthew G. Knepley       key.field = f;
3981*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetImplicit(prob, f, &fimp));
398292d50984SMatthew G. Knepley       if (isImplicit != fimp) continue;
3983*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetDiscretization(prob, f, &obj));
3984*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscObjectGetClassId(obj, &id));
398592d50984SMatthew G. Knepley       if (id == PETSCFE_CLASSID) {
398692d50984SMatthew G. Knepley         PetscFE         fe = (PetscFE) obj;
398792d50984SMatthew G. Knepley         PetscFEGeom    *geom = affineGeom ? affineGeom : geoms[f];
398892d50984SMatthew G. Knepley         PetscFEGeom    *chunkGeom = NULL;
398992d50984SMatthew G. Knepley         PetscQuadrature quad = affineQuad ? affineQuad : quads[f];
399092d50984SMatthew G. Knepley         PetscInt        Nq, Nb;
399192d50984SMatthew G. Knepley 
3992*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
3993*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscQuadratureGetData(quad, NULL, NULL, &Nq, NULL, NULL));
3994*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGetDimension(fe, &Nb));
399592d50984SMatthew G. Knepley         blockSize = Nb;
399692d50984SMatthew G. Knepley         batchSize = numBlocks * blockSize;
3997*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
399892d50984SMatthew G. Knepley         numChunks = numCells / (numBatches*batchSize);
399992d50984SMatthew G. Knepley         Ne        = numChunks*numBatches*batchSize;
400092d50984SMatthew G. Knepley         Nr        = numCells % (numBatches*batchSize);
400192d50984SMatthew G. Knepley         offset    = numCells - Nr;
400292d50984SMatthew G. Knepley         /* Integrate FE residual to get elemVec (need fields at quadrature points) */
400392d50984SMatthew G. Knepley         /*   For FV, I think we use a P0 basis and the cell coefficients (for subdivided cells, we can tweak the basis tabulation to be the indicator function) */
4004*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGeomGetChunk(geom,0,offset,&chunkGeom));
4005*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEIntegrateResidual(prob, key, Ne, chunkGeom, u, u_t, probAux, a, t, elemVec));
4006*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGeomGetChunk(geom,offset,numCells,&chunkGeom));
4007*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEIntegrateResidual(prob, key, Nr, chunkGeom, &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, probAux, &a[offset*totDimAux], t, &elemVec[offset*totDim]));
4008*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGeomRestoreChunk(geom,offset,numCells,&chunkGeom));
400992d50984SMatthew G. Knepley       } else if (id == PETSCFV_CLASSID) {
401092d50984SMatthew G. Knepley         PetscFV fv = (PetscFV) obj;
401192d50984SMatthew G. Knepley 
401292d50984SMatthew G. Knepley         Ne = numFaces;
401392d50984SMatthew G. Knepley         /* Riemann solve over faces (need fields at face centroids) */
401492d50984SMatthew G. Knepley         /*   We need to evaluate FE fields at those coordinates */
4015*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFVIntegrateRHSFunction(fv, prob, f, Ne, fgeom, vol, uL, uR, fluxL, fluxR));
401698921bdaSJacob Faibussowitsch       } else SETERRQ(PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", f);
401792d50984SMatthew G. Knepley     }
401892d50984SMatthew G. Knepley     /* Loop over domain */
401992d50984SMatthew G. Knepley     if (useFEM) {
402092d50984SMatthew G. Knepley       /* Add elemVec to locX */
402192d50984SMatthew G. Knepley       for (c = cS; c < cE; ++c) {
402292d50984SMatthew G. Knepley         const PetscInt cell = cells ? cells[c] : c;
402392d50984SMatthew G. Knepley         const PetscInt cind = c - cStart;
402492d50984SMatthew G. Knepley 
4025*5f80ce2aSJacob Faibussowitsch         if (mesh->printFEM > 1) CHKERRQ(DMPrintCellVector(cell, name, totDim, &elemVec[cind*totDim]));
402692d50984SMatthew G. Knepley         if (ghostLabel) {
402792d50984SMatthew G. Knepley           PetscInt ghostVal;
402892d50984SMatthew G. Knepley 
4029*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMLabelGetValue(ghostLabel,cell,&ghostVal));
403092d50984SMatthew G. Knepley           if (ghostVal > 0) continue;
403192d50984SMatthew G. Knepley         }
4032*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecSetClosure(dm, section, locF, cell, &elemVec[cind*totDim], ADD_ALL_VALUES));
403392d50984SMatthew G. Knepley       }
403492d50984SMatthew G. Knepley     }
403592d50984SMatthew G. Knepley     /* Handle time derivative */
403692d50984SMatthew G. Knepley     if (locX_t) {
403792d50984SMatthew G. Knepley       PetscScalar *x_t, *fa;
403892d50984SMatthew G. Knepley 
4039*5f80ce2aSJacob Faibussowitsch       CHKERRQ(VecGetArray(locF, &fa));
4040*5f80ce2aSJacob Faibussowitsch       CHKERRQ(VecGetArray(locX_t, &x_t));
404192d50984SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
404292d50984SMatthew G. Knepley         PetscFV      fv;
404392d50984SMatthew G. Knepley         PetscObject  obj;
404492d50984SMatthew G. Knepley         PetscClassId id;
404592d50984SMatthew G. Knepley         PetscInt     pdim, d;
404692d50984SMatthew G. Knepley 
4047*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDSGetDiscretization(prob, f, &obj));
4048*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscObjectGetClassId(obj, &id));
404992d50984SMatthew G. Knepley         if (id != PETSCFV_CLASSID) continue;
405092d50984SMatthew G. Knepley         fv   = (PetscFV) obj;
4051*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFVGetNumComponents(fv, &pdim));
405292d50984SMatthew G. Knepley         for (c = cS; c < cE; ++c) {
405392d50984SMatthew G. Knepley           const PetscInt cell = cells ? cells[c] : c;
405492d50984SMatthew G. Knepley           PetscScalar   *u_t, *r;
405592d50984SMatthew G. Knepley 
405692d50984SMatthew G. Knepley           if (ghostLabel) {
405792d50984SMatthew G. Knepley             PetscInt ghostVal;
405892d50984SMatthew G. Knepley 
4059*5f80ce2aSJacob Faibussowitsch             CHKERRQ(DMLabelGetValue(ghostLabel, cell, &ghostVal));
406092d50984SMatthew G. Knepley             if (ghostVal > 0) continue;
406192d50984SMatthew G. Knepley           }
4062*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexPointLocalFieldRead(dm, cell, f, x_t, &u_t));
4063*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexPointLocalFieldRef(dm, cell, f, fa, &r));
406492d50984SMatthew G. Knepley           for (d = 0; d < pdim; ++d) r[d] += u_t[d];
406592d50984SMatthew G. Knepley         }
406692d50984SMatthew G. Knepley       }
4067*5f80ce2aSJacob Faibussowitsch       CHKERRQ(VecRestoreArray(locX_t, &x_t));
4068*5f80ce2aSJacob Faibussowitsch       CHKERRQ(VecRestoreArray(locF, &fa));
406992d50984SMatthew G. Knepley     }
407092d50984SMatthew G. Knepley     if (useFEM) {
4071*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexRestoreCellFields(dm, chunkIS, locX, locX_t, locA, &u, &u_t, &a));
4072*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMRestoreWorkArray(dm, numCells*totDim, MPIU_SCALAR, &elemVec));
407392d50984SMatthew G. Knepley     }
407492d50984SMatthew G. Knepley   }
4075*5f80ce2aSJacob Faibussowitsch   if (useFEM) CHKERRQ(ISDestroy(&chunkIS));
4076*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
407792d50984SMatthew G. Knepley   /* TODO Could include boundary residual here (see DMPlexComputeResidual_Internal) */
407892d50984SMatthew G. Knepley   if (useFEM) {
407992d50984SMatthew G. Knepley     if (maxDegree <= 1) {
4080*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMSNESRestoreFEGeom(coordField,cellIS,affineQuad,PETSC_FALSE,&affineGeom));
4081*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscQuadratureDestroy(&affineQuad));
408292d50984SMatthew G. Knepley     } else {
408392d50984SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
4084*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMSNESRestoreFEGeom(coordField,cellIS,quads[f],PETSC_FALSE,&geoms[f]));
4085*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscQuadratureDestroy(&quads[f]));
408692d50984SMatthew G. Knepley       }
4087*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFree2(quads,geoms));
408892d50984SMatthew G. Knepley     }
408992d50984SMatthew G. Knepley   }
4090*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventEnd(DMPLEX_ResidualFEM,dm,0,0,0));
409192d50984SMatthew G. Knepley   PetscFunctionReturn(0);
409292d50984SMatthew G. Knepley }
409392d50984SMatthew G. Knepley 
4094a1cf66bbSMatthew G. Knepley /*
4095a1cf66bbSMatthew G. Knepley   We always assemble JacP, and if the matrix is different from Jac and two different sets of point functions are provided, we also assemble Jac
4096a1cf66bbSMatthew G. Knepley 
4097a1cf66bbSMatthew G. Knepley   X   - The local solution vector
4098a5b23f4aSJose E. Roman   X_t - The local solution time derivative vector, or NULL
4099a1cf66bbSMatthew G. Knepley */
4100a1cf66bbSMatthew G. Knepley PetscErrorCode DMPlexComputeJacobian_Patch_Internal(DM dm, PetscSection section, PetscSection globalSection, IS cellIS,
4101a1cf66bbSMatthew G. Knepley                                                     PetscReal t, PetscReal X_tShift, Vec X, Vec X_t, Mat Jac, Mat JacP, void *ctx)
4102a1cf66bbSMatthew G. Knepley {
4103a1cf66bbSMatthew G. Knepley   DM_Plex         *mesh  = (DM_Plex *) dm->data;
4104a1cf66bbSMatthew G. Knepley   const char      *name = "Jacobian", *nameP = "JacobianPre";
4105a1cf66bbSMatthew G. Knepley   DM               dmAux = NULL;
4106a1cf66bbSMatthew G. Knepley   PetscDS          prob,   probAux = NULL;
4107a1cf66bbSMatthew G. Knepley   PetscSection     sectionAux = NULL;
4108a1cf66bbSMatthew G. Knepley   Vec              A;
4109a1cf66bbSMatthew G. Knepley   DMField          coordField;
4110a1cf66bbSMatthew G. Knepley   PetscFEGeom     *cgeomFEM;
4111a1cf66bbSMatthew G. Knepley   PetscQuadrature  qGeom = NULL;
4112a1cf66bbSMatthew G. Knepley   Mat              J = Jac, JP = JacP;
4113a1cf66bbSMatthew G. Knepley   PetscScalar     *work, *u = NULL, *u_t = NULL, *a = NULL, *elemMat = NULL, *elemMatP = NULL, *elemMatD = NULL;
4114e432b41dSStefano Zampini   PetscBool        hasJac, hasPrec, hasDyn, assembleJac, *isFE, hasFV = PETSC_FALSE;
4115a1cf66bbSMatthew G. Knepley   const PetscInt  *cells;
411606ad1575SMatthew G. Knepley   PetscFormKey key;
41179b2fc754SMatthew G. Knepley   PetscInt         Nf, fieldI, fieldJ, maxDegree, numCells, cStart, cEnd, numChunks, chunkSize, chunk, totDim, totDimAux = 0, sz, wsz, off = 0, offCell = 0;
4118a1cf66bbSMatthew G. Knepley 
4119a1cf66bbSMatthew G. Knepley   PetscFunctionBegin;
4120*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISGetLocalSize(cellIS, &numCells));
4121*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
4122*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventBegin(DMPLEX_JacobianFEM,dm,0,0,0));
4123*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDS(dm, &prob));
4124*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetAuxiliaryVec(dm, NULL, 0, 0, &A));
41259a2a23afSMatthew G. Knepley   if (A) {
4126*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetDM(A, &dmAux));
4127*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetLocalSection(dmAux, &sectionAux));
4128*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetDS(dmAux, &probAux));
4129a1cf66bbSMatthew G. Knepley   }
4130a1cf66bbSMatthew G. Knepley   /* Get flags */
4131*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetNumFields(prob, &Nf));
4132*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetWorkArray(dm, Nf, MPIU_BOOL, &isFE));
4133a1cf66bbSMatthew G. Knepley   for (fieldI = 0; fieldI < Nf; ++fieldI) {
4134a1cf66bbSMatthew G. Knepley     PetscObject  disc;
4135a1cf66bbSMatthew G. Knepley     PetscClassId id;
4136*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, fieldI, &disc));
4137*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(disc, &id));
4138a1cf66bbSMatthew G. Knepley     if (id == PETSCFE_CLASSID)      {isFE[fieldI] = PETSC_TRUE;}
4139a1cf66bbSMatthew G. Knepley     else if (id == PETSCFV_CLASSID) {hasFV = PETSC_TRUE; isFE[fieldI] = PETSC_FALSE;}
4140a1cf66bbSMatthew G. Knepley   }
4141*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSHasJacobian(prob, &hasJac));
4142*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSHasJacobianPreconditioner(prob, &hasPrec));
4143*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSHasDynamicJacobian(prob, &hasDyn));
4144a1cf66bbSMatthew G. Knepley   assembleJac = hasJac && hasPrec && (Jac != JacP) ? PETSC_TRUE : PETSC_FALSE;
4145a1cf66bbSMatthew G. Knepley   hasDyn      = hasDyn && (X_tShift != 0.0) ? PETSC_TRUE : PETSC_FALSE;
4146*5f80ce2aSJacob Faibussowitsch   if (hasFV) CHKERRQ(MatSetOption(JP, MAT_IGNORE_ZERO_ENTRIES, PETSC_TRUE)); /* No allocated space for FV stuff, so ignore the zero entries */
4147*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetTotalDimension(prob, &totDim));
4148*5f80ce2aSJacob Faibussowitsch   if (probAux) CHKERRQ(PetscDSGetTotalDimension(probAux, &totDimAux));
4149a1cf66bbSMatthew G. Knepley   /* Compute batch sizes */
4150a1cf66bbSMatthew G. Knepley   if (isFE[0]) {
4151a1cf66bbSMatthew G. Knepley     PetscFE         fe;
4152a1cf66bbSMatthew G. Knepley     PetscQuadrature q;
4153a1cf66bbSMatthew G. Knepley     PetscInt        numQuadPoints, numBatches, batchSize, numBlocks, blockSize, Nb;
4154a1cf66bbSMatthew G. Knepley 
4155*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, 0, (PetscObject *) &fe));
4156*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGetQuadrature(fe, &q));
4157*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscQuadratureGetData(q, NULL, NULL, &numQuadPoints, NULL, NULL));
4158*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGetDimension(fe, &Nb));
4159*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
4160a1cf66bbSMatthew G. Knepley     blockSize = Nb*numQuadPoints;
4161a1cf66bbSMatthew G. Knepley     batchSize = numBlocks  * blockSize;
4162a1cf66bbSMatthew G. Knepley     chunkSize = numBatches * batchSize;
4163a1cf66bbSMatthew G. Knepley     numChunks = numCells / chunkSize + numCells % chunkSize;
4164*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
4165a1cf66bbSMatthew G. Knepley   } else {
4166a1cf66bbSMatthew G. Knepley     chunkSize = numCells;
4167a1cf66bbSMatthew G. Knepley     numChunks = 1;
4168a1cf66bbSMatthew G. Knepley   }
4169a1cf66bbSMatthew G. Knepley   /* Get work space */
4170a1cf66bbSMatthew G. Knepley   wsz  = (((X?1:0) + (X_t?1:0) + (dmAux?1:0))*totDim + ((hasJac?1:0) + (hasPrec?1:0) + (hasDyn?1:0))*totDim*totDim)*chunkSize;
4171*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetWorkArray(dm, wsz, MPIU_SCALAR, &work));
4172*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscArrayzero(work, wsz));
4173a1cf66bbSMatthew G. Knepley   off      = 0;
4174a1cf66bbSMatthew G. Knepley   u        = X       ? (sz = chunkSize*totDim,        off += sz, work+off-sz) : NULL;
4175a1cf66bbSMatthew G. Knepley   u_t      = X_t     ? (sz = chunkSize*totDim,        off += sz, work+off-sz) : NULL;
4176a1cf66bbSMatthew G. Knepley   a        = dmAux   ? (sz = chunkSize*totDimAux,     off += sz, work+off-sz) : NULL;
4177a1cf66bbSMatthew G. Knepley   elemMat  = hasJac  ? (sz = chunkSize*totDim*totDim, off += sz, work+off-sz) : NULL;
4178a1cf66bbSMatthew G. Knepley   elemMatP = hasPrec ? (sz = chunkSize*totDim*totDim, off += sz, work+off-sz) : NULL;
4179a1cf66bbSMatthew G. Knepley   elemMatD = hasDyn  ? (sz = chunkSize*totDim*totDim, off += sz, work+off-sz) : NULL;
4180*5f80ce2aSJacob Faibussowitsch   PetscCheck(off == wsz,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Error is workspace size %D should be %D", off, wsz);
4181a1cf66bbSMatthew G. Knepley   /* Setup geometry */
4182*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateField(dm, &coordField));
4183*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMFieldGetDegree(coordField, cellIS, NULL, &maxDegree));
4184*5f80ce2aSJacob Faibussowitsch   if (maxDegree <= 1) CHKERRQ(DMFieldCreateDefaultQuadrature(coordField, cellIS, &qGeom));
4185a1cf66bbSMatthew G. Knepley   if (!qGeom) {
4186a1cf66bbSMatthew G. Knepley     PetscFE fe;
4187a1cf66bbSMatthew G. Knepley 
4188*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, 0, (PetscObject *) &fe));
4189*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGetQuadrature(fe, &qGeom));
4190*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectReference((PetscObject) qGeom));
4191a1cf66bbSMatthew G. Knepley   }
4192*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMSNESGetFEGeom(coordField, cellIS, qGeom, PETSC_FALSE, &cgeomFEM));
4193a1cf66bbSMatthew G. Knepley   /* Compute volume integrals */
4194*5f80ce2aSJacob Faibussowitsch   if (assembleJac) CHKERRQ(MatZeroEntries(J));
4195*5f80ce2aSJacob Faibussowitsch   CHKERRQ(MatZeroEntries(JP));
41966528b96dSMatthew G. Knepley   key.label = NULL;
41976528b96dSMatthew G. Knepley   key.value = 0;
419806ad1575SMatthew G. Knepley   key.part  = 0;
4199a1cf66bbSMatthew G. Knepley   for (chunk = 0; chunk < numChunks; ++chunk, offCell += chunkSize) {
4200a1cf66bbSMatthew G. Knepley     const PetscInt   Ncell = PetscMin(chunkSize, numCells - offCell);
4201a1cf66bbSMatthew G. Knepley     PetscInt         c;
4202a1cf66bbSMatthew G. Knepley 
4203a1cf66bbSMatthew G. Knepley     /* Extract values */
4204a1cf66bbSMatthew G. Knepley     for (c = 0; c < Ncell; ++c) {
4205a1cf66bbSMatthew G. Knepley       const PetscInt cell = cells ? cells[c+offCell] : c+offCell;
4206a1cf66bbSMatthew G. Knepley       PetscScalar   *x = NULL,  *x_t = NULL;
4207a1cf66bbSMatthew G. Knepley       PetscInt       i;
4208a1cf66bbSMatthew G. Knepley 
4209a1cf66bbSMatthew G. Knepley       if (X) {
4210*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecGetClosure(dm, section, X, cell, NULL, &x));
4211a1cf66bbSMatthew G. Knepley         for (i = 0; i < totDim; ++i) u[c*totDim+i] = x[i];
4212*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecRestoreClosure(dm, section, X, cell, NULL, &x));
4213a1cf66bbSMatthew G. Knepley       }
4214a1cf66bbSMatthew G. Knepley       if (X_t) {
4215*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecGetClosure(dm, section, X_t, cell, NULL, &x_t));
4216a1cf66bbSMatthew G. Knepley         for (i = 0; i < totDim; ++i) u_t[c*totDim+i] = x_t[i];
4217*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecRestoreClosure(dm, section, X_t, cell, NULL, &x_t));
4218a1cf66bbSMatthew G. Knepley       }
4219a1cf66bbSMatthew G. Knepley       if (dmAux) {
4220*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecGetClosure(dmAux, sectionAux, A, cell, NULL, &x));
4221a1cf66bbSMatthew G. Knepley         for (i = 0; i < totDimAux; ++i) a[c*totDimAux+i] = x[i];
4222*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecRestoreClosure(dmAux, sectionAux, A, cell, NULL, &x));
4223a1cf66bbSMatthew G. Knepley       }
4224a1cf66bbSMatthew G. Knepley     }
4225a1cf66bbSMatthew G. Knepley     for (fieldI = 0; fieldI < Nf; ++fieldI) {
4226a1cf66bbSMatthew G. Knepley       PetscFE fe;
4227*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetDiscretization(prob, fieldI, (PetscObject *) &fe));
4228a1cf66bbSMatthew G. Knepley       for (fieldJ = 0; fieldJ < Nf; ++fieldJ) {
42296528b96dSMatthew G. Knepley         key.field = fieldI*Nf + fieldJ;
4230*5f80ce2aSJacob Faibussowitsch         if (hasJac)  CHKERRQ(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN,     key, Ncell, cgeomFEM, u, u_t, probAux, a, t, X_tShift, elemMat));
4231*5f80ce2aSJacob Faibussowitsch         if (hasPrec) CHKERRQ(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN_PRE, key, Ncell, cgeomFEM, u, u_t, probAux, a, t, X_tShift, elemMatP));
4232*5f80ce2aSJacob Faibussowitsch         if (hasDyn)  CHKERRQ(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN_DYN, key, Ncell, cgeomFEM, u, u_t, probAux, a, t, X_tShift, elemMatD));
4233a1cf66bbSMatthew G. Knepley       }
4234a1cf66bbSMatthew G. Knepley       /* For finite volume, add the identity */
4235a1cf66bbSMatthew G. Knepley       if (!isFE[fieldI]) {
4236a1cf66bbSMatthew G. Knepley         PetscFV  fv;
4237a1cf66bbSMatthew G. Knepley         PetscInt eOffset = 0, Nc, fc, foff;
4238a1cf66bbSMatthew G. Knepley 
4239*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDSGetFieldOffset(prob, fieldI, &foff));
4240*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDSGetDiscretization(prob, fieldI, (PetscObject *) &fv));
4241*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFVGetNumComponents(fv, &Nc));
4242a1cf66bbSMatthew G. Knepley         for (c = 0; c < chunkSize; ++c, eOffset += totDim*totDim) {
4243a1cf66bbSMatthew G. Knepley           for (fc = 0; fc < Nc; ++fc) {
4244a1cf66bbSMatthew G. Knepley             const PetscInt i = foff + fc;
4245a1cf66bbSMatthew G. Knepley             if (hasJac)  {elemMat [eOffset+i*totDim+i] = 1.0;}
4246a1cf66bbSMatthew G. Knepley             if (hasPrec) {elemMatP[eOffset+i*totDim+i] = 1.0;}
4247a1cf66bbSMatthew G. Knepley           }
4248a1cf66bbSMatthew G. Knepley         }
4249a1cf66bbSMatthew G. Knepley       }
4250a1cf66bbSMatthew G. Knepley     }
4251a1cf66bbSMatthew G. Knepley     /*   Add contribution from X_t */
4252a1cf66bbSMatthew G. Knepley     if (hasDyn) {for (c = 0; c < chunkSize*totDim*totDim; ++c) elemMat[c] += X_tShift*elemMatD[c];}
4253a1cf66bbSMatthew G. Knepley     /* Insert values into matrix */
4254a1cf66bbSMatthew G. Knepley     for (c = 0; c < Ncell; ++c) {
4255a1cf66bbSMatthew G. Knepley       const PetscInt cell = cells ? cells[c+offCell] : c+offCell;
4256a1cf66bbSMatthew G. Knepley       if (mesh->printFEM > 1) {
4257*5f80ce2aSJacob Faibussowitsch         if (hasJac)  CHKERRQ(DMPrintCellMatrix(cell, name,  totDim, totDim, &elemMat[(c-cStart)*totDim*totDim]));
4258*5f80ce2aSJacob Faibussowitsch         if (hasPrec) CHKERRQ(DMPrintCellMatrix(cell, nameP, totDim, totDim, &elemMatP[(c-cStart)*totDim*totDim]));
4259a1cf66bbSMatthew G. Knepley       }
4260*5f80ce2aSJacob Faibussowitsch       if (assembleJac) CHKERRQ(DMPlexMatSetClosure(dm, section, globalSection, Jac, cell, &elemMat[(c-cStart)*totDim*totDim], ADD_VALUES));
4261*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexMatSetClosure(dm, section, globalSection, JP, cell, &elemMat[(c-cStart)*totDim*totDim], ADD_VALUES));
4262a1cf66bbSMatthew G. Knepley     }
4263a1cf66bbSMatthew G. Knepley   }
4264a1cf66bbSMatthew G. Knepley   /* Cleanup */
4265*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMSNESRestoreFEGeom(coordField, cellIS, qGeom, PETSC_FALSE, &cgeomFEM));
4266*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscQuadratureDestroy(&qGeom));
4267*5f80ce2aSJacob Faibussowitsch   if (hasFV) CHKERRQ(MatSetOption(JacP, MAT_IGNORE_ZERO_ENTRIES, PETSC_FALSE));
4268*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreWorkArray(dm, Nf, MPIU_BOOL, &isFE));
4269*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreWorkArray(dm, ((1 + (X_t?1:0) + (dmAux?1:0))*totDim + ((hasJac?1:0) + (hasPrec?1:0) + (hasDyn?1:0))*totDim*totDim)*chunkSize, MPIU_SCALAR, &work));
4270a1cf66bbSMatthew G. Knepley   /* Compute boundary integrals */
4271*5f80ce2aSJacob Faibussowitsch   /* CHKERRQ(DMPlexComputeBdJacobian_Internal(dm, X, X_t, t, X_tShift, Jac, JacP, ctx)); */
4272a1cf66bbSMatthew G. Knepley   /* Assemble matrix */
4273*5f80ce2aSJacob Faibussowitsch   if (assembleJac) {CHKERRQ(MatAssemblyBegin(Jac, MAT_FINAL_ASSEMBLY));CHKERRQ(MatAssemblyEnd(Jac, MAT_FINAL_ASSEMBLY));}
4274*5f80ce2aSJacob Faibussowitsch   CHKERRQ(MatAssemblyBegin(JacP, MAT_FINAL_ASSEMBLY));CHKERRQ(MatAssemblyEnd(JacP, MAT_FINAL_ASSEMBLY));
4275*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventEnd(DMPLEX_JacobianFEM,dm,0,0,0));
4276a1cf66bbSMatthew G. Knepley   PetscFunctionReturn(0);
4277a1cf66bbSMatthew G. Knepley }
42783e9753d6SMatthew G. Knepley 
42793e9753d6SMatthew G. Knepley /******** FEM Assembly Function ********/
42803e9753d6SMatthew G. Knepley 
42813e9753d6SMatthew G. Knepley static PetscErrorCode DMConvertPlex_Internal(DM dm, DM *plex, PetscBool copy)
42823e9753d6SMatthew G. Knepley {
42833e9753d6SMatthew G. Knepley   PetscBool      isPlex;
42843e9753d6SMatthew G. Knepley 
42853e9753d6SMatthew G. Knepley   PetscFunctionBegin;
4286*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscObjectTypeCompare((PetscObject) dm, DMPLEX, &isPlex));
42873e9753d6SMatthew G. Knepley   if (isPlex) {
42883e9753d6SMatthew G. Knepley     *plex = dm;
4289*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectReference((PetscObject) dm));
42903e9753d6SMatthew G. Knepley   } else {
4291*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectQuery((PetscObject) dm, "dm_plex", (PetscObject *) plex));
42923e9753d6SMatthew G. Knepley     if (!*plex) {
4293*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMConvert(dm,DMPLEX,plex));
4294*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscObjectCompose((PetscObject) dm, "dm_plex", (PetscObject) *plex));
42953e9753d6SMatthew G. Knepley       if (copy) {
4296*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMCopyAuxiliaryVec(dm, *plex));
42973e9753d6SMatthew G. Knepley       }
42983e9753d6SMatthew G. Knepley     } else {
4299*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscObjectReference((PetscObject) *plex));
43003e9753d6SMatthew G. Knepley     }
43013e9753d6SMatthew G. Knepley   }
43023e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
43033e9753d6SMatthew G. Knepley }
43043e9753d6SMatthew G. Knepley 
43053e9753d6SMatthew G. Knepley /*@
43063e9753d6SMatthew G. Knepley   DMPlexGetGeometryFVM - Return precomputed geometric data
43073e9753d6SMatthew G. Knepley 
43083e9753d6SMatthew G. Knepley   Collective on DM
43093e9753d6SMatthew G. Knepley 
43103e9753d6SMatthew G. Knepley   Input Parameter:
43113e9753d6SMatthew G. Knepley . dm - The DM
43123e9753d6SMatthew G. Knepley 
43133e9753d6SMatthew G. Knepley   Output Parameters:
43143e9753d6SMatthew G. Knepley + facegeom - The values precomputed from face geometry
43153e9753d6SMatthew G. Knepley . cellgeom - The values precomputed from cell geometry
43163e9753d6SMatthew G. Knepley - minRadius - The minimum radius over the mesh of an inscribed sphere in a cell
43173e9753d6SMatthew G. Knepley 
43183e9753d6SMatthew G. Knepley   Level: developer
43193e9753d6SMatthew G. Knepley 
4320446c23c1SPierre Jolivet .seealso: DMTSSetRHSFunctionLocal()
43213e9753d6SMatthew G. Knepley @*/
43223e9753d6SMatthew G. Knepley PetscErrorCode DMPlexGetGeometryFVM(DM dm, Vec *facegeom, Vec *cellgeom, PetscReal *minRadius)
43233e9753d6SMatthew G. Knepley {
43243e9753d6SMatthew G. Knepley   DM             plex;
43253e9753d6SMatthew G. Knepley 
43263e9753d6SMatthew G. Knepley   PetscFunctionBegin;
43273e9753d6SMatthew G. Knepley   PetscValidHeaderSpecific(dm,DM_CLASSID,1);
4328*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMConvertPlex_Internal(dm,&plex,PETSC_TRUE));
4329*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetDataFVM(plex, NULL, cellgeom, facegeom, NULL));
4330*5f80ce2aSJacob Faibussowitsch   if (minRadius) CHKERRQ(DMPlexGetMinRadius(plex, minRadius));
4331*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMDestroy(&plex));
43323e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
43333e9753d6SMatthew G. Knepley }
43343e9753d6SMatthew G. Knepley 
43353e9753d6SMatthew G. Knepley /*@
43363e9753d6SMatthew G. Knepley   DMPlexGetGradientDM - Return gradient data layout
43373e9753d6SMatthew G. Knepley 
43383e9753d6SMatthew G. Knepley   Collective on DM
43393e9753d6SMatthew G. Knepley 
43403e9753d6SMatthew G. Knepley   Input Parameters:
43413e9753d6SMatthew G. Knepley + dm - The DM
43423e9753d6SMatthew G. Knepley - fv - The PetscFV
43433e9753d6SMatthew G. Knepley 
43443e9753d6SMatthew G. Knepley   Output Parameter:
43453e9753d6SMatthew G. Knepley . dmGrad - The layout for gradient values
43463e9753d6SMatthew G. Knepley 
43473e9753d6SMatthew G. Knepley   Level: developer
43483e9753d6SMatthew G. Knepley 
4349446c23c1SPierre Jolivet .seealso: DMPlexGetGeometryFVM()
43503e9753d6SMatthew G. Knepley @*/
43513e9753d6SMatthew G. Knepley PetscErrorCode DMPlexGetGradientDM(DM dm, PetscFV fv, DM *dmGrad)
43523e9753d6SMatthew G. Knepley {
43533e9753d6SMatthew G. Knepley   DM             plex;
43543e9753d6SMatthew G. Knepley   PetscBool      computeGradients;
43553e9753d6SMatthew G. Knepley 
43563e9753d6SMatthew G. Knepley   PetscFunctionBegin;
43573e9753d6SMatthew G. Knepley   PetscValidHeaderSpecific(dm,DM_CLASSID,1);
43583e9753d6SMatthew G. Knepley   PetscValidHeaderSpecific(fv,PETSCFV_CLASSID,2);
43593e9753d6SMatthew G. Knepley   PetscValidPointer(dmGrad,3);
4360*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFVGetComputeGradients(fv, &computeGradients));
43613e9753d6SMatthew G. Knepley   if (!computeGradients) {*dmGrad = NULL; PetscFunctionReturn(0);}
4362*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMConvertPlex_Internal(dm,&plex,PETSC_TRUE));
4363*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetDataFVM(plex, fv, NULL, NULL, dmGrad));
4364*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMDestroy(&plex));
43653e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
43663e9753d6SMatthew G. Knepley }
43673e9753d6SMatthew G. Knepley 
43680c290148SMatthew G. Knepley static PetscErrorCode DMPlexComputeBdResidual_Single_Internal(DM dm, PetscReal t, PetscWeakForm wf, PetscFormKey key, Vec locX, Vec locX_t, Vec locF, DMField coordField, IS facetIS)
43693e9753d6SMatthew G. Knepley {
43703e9753d6SMatthew G. Knepley   DM_Plex         *mesh = (DM_Plex *) dm->data;
43713e9753d6SMatthew G. Knepley   DM               plex = NULL, plexA = NULL;
43723e9753d6SMatthew G. Knepley   DMEnclosureType  encAux;
43733e9753d6SMatthew G. Knepley   PetscDS          prob, probAux = NULL;
43743e9753d6SMatthew G. Knepley   PetscSection     section, sectionAux = NULL;
43753e9753d6SMatthew G. Knepley   Vec              locA = NULL;
43763e9753d6SMatthew G. Knepley   PetscScalar     *u = NULL, *u_t = NULL, *a = NULL, *elemVec = NULL;
43773e9753d6SMatthew G. Knepley   PetscInt         totDim, totDimAux = 0;
43783e9753d6SMatthew G. Knepley 
43793e9753d6SMatthew G. Knepley   PetscFunctionBegin;
4380*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMConvert(dm, DMPLEX, &plex));
4381*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &section));
4382*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDS(dm, &prob));
4383*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetTotalDimension(prob, &totDim));
4384*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetAuxiliaryVec(dm, key.label, key.value, key.part, &locA));
43853e9753d6SMatthew G. Knepley   if (locA) {
43863e9753d6SMatthew G. Knepley     DM dmAux;
43873e9753d6SMatthew G. Knepley 
4388*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetDM(locA, &dmAux));
4389*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetEnclosureRelation(dmAux, dm, &encAux));
4390*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMConvert(dmAux, DMPLEX, &plexA));
4391*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetDS(plexA, &probAux));
4392*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetTotalDimension(probAux, &totDimAux));
4393*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetLocalSection(plexA, &sectionAux));
43943e9753d6SMatthew G. Knepley   }
43950c290148SMatthew G. Knepley   {
43963e9753d6SMatthew G. Knepley     PetscFEGeom     *fgeom;
43973e9753d6SMatthew G. Knepley     PetscInt         maxDegree;
43983e9753d6SMatthew G. Knepley     PetscQuadrature  qGeom = NULL;
43993e9753d6SMatthew G. Knepley     IS               pointIS;
44003e9753d6SMatthew G. Knepley     const PetscInt  *points;
44013e9753d6SMatthew G. Knepley     PetscInt         numFaces, face, Nq;
44023e9753d6SMatthew G. Knepley 
4403*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMLabelGetStratumIS(key.label, key.value, &pointIS));
44040c290148SMatthew G. Knepley     if (!pointIS) goto end; /* No points with that id on this process */
44053e9753d6SMatthew G. Knepley     {
44063e9753d6SMatthew G. Knepley       IS isectIS;
44073e9753d6SMatthew G. Knepley 
44083e9753d6SMatthew G. Knepley       /* TODO: Special cases of ISIntersect where it is quick to check a priori if one is a superset of the other */
4409*5f80ce2aSJacob Faibussowitsch       CHKERRQ(ISIntersect_Caching_Internal(facetIS,pointIS,&isectIS));
4410*5f80ce2aSJacob Faibussowitsch       CHKERRQ(ISDestroy(&pointIS));
44113e9753d6SMatthew G. Knepley       pointIS = isectIS;
44123e9753d6SMatthew G. Knepley     }
4413*5f80ce2aSJacob Faibussowitsch     CHKERRQ(ISGetLocalSize(pointIS,&numFaces));
4414*5f80ce2aSJacob Faibussowitsch     CHKERRQ(ISGetIndices(pointIS,&points));
4415*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscMalloc4(numFaces*totDim, &u, locX_t ? numFaces*totDim : 0, &u_t, numFaces*totDim, &elemVec, locA ? numFaces*totDimAux : 0, &a));
4416*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMFieldGetDegree(coordField,pointIS,NULL,&maxDegree));
44173e9753d6SMatthew G. Knepley     if (maxDegree <= 1) {
4418*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMFieldCreateDefaultQuadrature(coordField,pointIS,&qGeom));
44193e9753d6SMatthew G. Knepley     }
44203e9753d6SMatthew G. Knepley     if (!qGeom) {
44213e9753d6SMatthew G. Knepley       PetscFE fe;
44223e9753d6SMatthew G. Knepley 
4423*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetDiscretization(prob, key.field, (PetscObject *) &fe));
4424*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetFaceQuadrature(fe, &qGeom));
4425*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscObjectReference((PetscObject)qGeom));
44263e9753d6SMatthew G. Knepley     }
4427*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscQuadratureGetData(qGeom, NULL, NULL, &Nq, NULL, NULL));
4428*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMSNESGetFEGeom(coordField,pointIS,qGeom,PETSC_TRUE,&fgeom));
44293e9753d6SMatthew G. Knepley     for (face = 0; face < numFaces; ++face) {
4430f15274beSMatthew Knepley       const PetscInt point = points[face], *support;
44313e9753d6SMatthew G. Knepley       PetscScalar   *x     = NULL;
4432f15274beSMatthew Knepley       PetscInt       i;
44333e9753d6SMatthew G. Knepley 
4434*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetSupport(dm, point, &support));
4435*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecGetClosure(plex, section, locX, support[0], NULL, &x));
44363e9753d6SMatthew G. Knepley       for (i = 0; i < totDim; ++i) u[face*totDim+i] = x[i];
4437*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecRestoreClosure(plex, section, locX, support[0], NULL, &x));
44383e9753d6SMatthew G. Knepley       if (locX_t) {
4439*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecGetClosure(plex, section, locX_t, support[0], NULL, &x));
44403e9753d6SMatthew G. Knepley         for (i = 0; i < totDim; ++i) u_t[face*totDim+i] = x[i];
4441*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecRestoreClosure(plex, section, locX_t, support[0], NULL, &x));
44423e9753d6SMatthew G. Knepley       }
44433e9753d6SMatthew G. Knepley       if (locA) {
44443e9753d6SMatthew G. Knepley         PetscInt subp;
44453e9753d6SMatthew G. Knepley 
4446*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMGetEnclosurePoint(plexA, dm, encAux, support[0], &subp));
4447*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecGetClosure(plexA, sectionAux, locA, subp, NULL, &x));
44483e9753d6SMatthew G. Knepley         for (i = 0; i < totDimAux; ++i) a[face*totDimAux+i] = x[i];
4449*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecRestoreClosure(plexA, sectionAux, locA, subp, NULL, &x));
44503e9753d6SMatthew G. Knepley       }
44513e9753d6SMatthew G. Knepley     }
4452*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscArrayzero(elemVec, numFaces*totDim));
44533e9753d6SMatthew G. Knepley     {
44543e9753d6SMatthew G. Knepley       PetscFE         fe;
44553e9753d6SMatthew G. Knepley       PetscInt        Nb;
44563e9753d6SMatthew G. Knepley       PetscFEGeom     *chunkGeom = NULL;
44573e9753d6SMatthew G. Knepley       /* Conforming batches */
44583e9753d6SMatthew G. Knepley       PetscInt        numChunks, numBatches, numBlocks, Ne, blockSize, batchSize;
44593e9753d6SMatthew G. Knepley       /* Remainder */
44603e9753d6SMatthew G. Knepley       PetscInt        Nr, offset;
44613e9753d6SMatthew G. Knepley 
4462*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetDiscretization(prob, key.field, (PetscObject *) &fe));
4463*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetDimension(fe, &Nb));
4464*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
44653e9753d6SMatthew G. Knepley       /* TODO: documentation is unclear about what is going on with these numbers: how should Nb / Nq factor in ? */
44663e9753d6SMatthew G. Knepley       blockSize = Nb;
44673e9753d6SMatthew G. Knepley       batchSize = numBlocks * blockSize;
4468*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
44693e9753d6SMatthew G. Knepley       numChunks = numFaces / (numBatches*batchSize);
44703e9753d6SMatthew G. Knepley       Ne        = numChunks*numBatches*batchSize;
44713e9753d6SMatthew G. Knepley       Nr        = numFaces % (numBatches*batchSize);
44723e9753d6SMatthew G. Knepley       offset    = numFaces - Nr;
4473*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomGetChunk(fgeom,0,offset,&chunkGeom));
4474*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEIntegrateBdResidual(prob, wf, key, Ne, chunkGeom, u, u_t, probAux, a, t, elemVec));
4475*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomRestoreChunk(fgeom, 0, offset, &chunkGeom));
4476*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomGetChunk(fgeom,offset,numFaces,&chunkGeom));
4477*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEIntegrateBdResidual(prob, wf, key, Nr, chunkGeom, &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, probAux, a ? &a[offset*totDimAux] : NULL, t, &elemVec[offset*totDim]));
4478*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomRestoreChunk(fgeom,offset,numFaces,&chunkGeom));
44793e9753d6SMatthew G. Knepley     }
44803e9753d6SMatthew G. Knepley     for (face = 0; face < numFaces; ++face) {
44813e9753d6SMatthew G. Knepley       const PetscInt point = points[face], *support;
44823e9753d6SMatthew G. Knepley 
4483*5f80ce2aSJacob Faibussowitsch       if (mesh->printFEM > 1) CHKERRQ(DMPrintCellVector(point, "BdResidual", totDim, &elemVec[face*totDim]));
4484*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetSupport(plex, point, &support));
4485*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecSetClosure(plex, NULL, locF, support[0], &elemVec[face*totDim], ADD_ALL_VALUES));
44863e9753d6SMatthew G. Knepley     }
4487*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMSNESRestoreFEGeom(coordField,pointIS,qGeom,PETSC_TRUE,&fgeom));
4488*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscQuadratureDestroy(&qGeom));
4489*5f80ce2aSJacob Faibussowitsch     CHKERRQ(ISRestoreIndices(pointIS, &points));
4490*5f80ce2aSJacob Faibussowitsch     CHKERRQ(ISDestroy(&pointIS));
4491*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFree4(u, u_t, elemVec, a));
44923e9753d6SMatthew G. Knepley   }
44930c290148SMatthew G. Knepley   end:
4494*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMDestroy(&plex));
4495*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMDestroy(&plexA));
44963e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
44973e9753d6SMatthew G. Knepley }
44983e9753d6SMatthew G. Knepley 
44990c290148SMatthew G. Knepley PetscErrorCode DMPlexComputeBdResidualSingle(DM dm, PetscReal t, PetscWeakForm wf, PetscFormKey key, Vec locX, Vec locX_t, Vec locF)
45003e9753d6SMatthew G. Knepley {
45013e9753d6SMatthew G. Knepley   DMField        coordField;
45023e9753d6SMatthew G. Knepley   DMLabel        depthLabel;
45033e9753d6SMatthew G. Knepley   IS             facetIS;
45043e9753d6SMatthew G. Knepley   PetscInt       dim;
45053e9753d6SMatthew G. Knepley 
45063e9753d6SMatthew G. Knepley   PetscFunctionBegin;
4507*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dm, &dim));
4508*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetDepthLabel(dm, &depthLabel));
4509*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMLabelGetStratumIS(depthLabel, dim-1, &facetIS));
4510*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateField(dm, &coordField));
4511*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexComputeBdResidual_Single_Internal(dm, t, wf, key, locX, locX_t, locF, coordField, facetIS));
4512*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISDestroy(&facetIS));
45133e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
45143e9753d6SMatthew G. Knepley }
45153e9753d6SMatthew G. Knepley 
45163e9753d6SMatthew G. Knepley PetscErrorCode DMPlexComputeBdResidual_Internal(DM dm, Vec locX, Vec locX_t, PetscReal t, Vec locF, void *user)
45173e9753d6SMatthew G. Knepley {
45183e9753d6SMatthew G. Knepley   PetscDS        prob;
45193e9753d6SMatthew G. Knepley   PetscInt       numBd, bd;
45203e9753d6SMatthew G. Knepley   DMField        coordField = NULL;
45213e9753d6SMatthew G. Knepley   IS             facetIS    = NULL;
45223e9753d6SMatthew G. Knepley   DMLabel        depthLabel;
45233e9753d6SMatthew G. Knepley   PetscInt       dim;
45243e9753d6SMatthew G. Knepley 
45253e9753d6SMatthew G. Knepley   PetscFunctionBegin;
4526*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDS(dm, &prob));
4527*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetDepthLabel(dm, &depthLabel));
4528*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dm, &dim));
4529*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMLabelGetStratumIS(depthLabel,dim - 1,&facetIS));
4530*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetNumBoundary(prob, &numBd));
45313e9753d6SMatthew G. Knepley   for (bd = 0; bd < numBd; ++bd) {
453245480ffeSMatthew G. Knepley     PetscWeakForm           wf;
45333e9753d6SMatthew G. Knepley     DMBoundaryConditionType type;
45343e9753d6SMatthew G. Knepley     DMLabel                 label;
45353e9753d6SMatthew G. Knepley     const PetscInt         *values;
45360c290148SMatthew G. Knepley     PetscInt                field, numValues, v;
45373e9753d6SMatthew G. Knepley     PetscObject             obj;
45383e9753d6SMatthew G. Knepley     PetscClassId            id;
45390c290148SMatthew G. Knepley     PetscFormKey            key;
45403e9753d6SMatthew G. Knepley 
4541*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetBoundary(prob, bd, &wf, &type, NULL, &label, &numValues, &values, &field, NULL, NULL, NULL, NULL, NULL));
4542*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, field, &obj));
4543*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
45443e9753d6SMatthew G. Knepley     if ((id != PETSCFE_CLASSID) || (type & DM_BC_ESSENTIAL)) continue;
45453e9753d6SMatthew G. Knepley     if (!facetIS) {
45463e9753d6SMatthew G. Knepley       DMLabel  depthLabel;
45473e9753d6SMatthew G. Knepley       PetscInt dim;
45483e9753d6SMatthew G. Knepley 
4549*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetDepthLabel(dm, &depthLabel));
4550*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMGetDimension(dm, &dim));
4551*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMLabelGetStratumIS(depthLabel, dim - 1, &facetIS));
45523e9753d6SMatthew G. Knepley     }
4553*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetCoordinateField(dm, &coordField));
45540c290148SMatthew G. Knepley     for (v = 0; v < numValues; ++v) {
45550c290148SMatthew G. Knepley       key.label = label;
45560c290148SMatthew G. Knepley       key.value = values[v];
45570c290148SMatthew G. Knepley       key.field = field;
45580c290148SMatthew G. Knepley       key.part  = 0;
4559*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexComputeBdResidual_Single_Internal(dm, t, wf, key, locX, locX_t, locF, coordField, facetIS));
45600c290148SMatthew G. Knepley     }
45613e9753d6SMatthew G. Knepley   }
4562*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISDestroy(&facetIS));
45633e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
45643e9753d6SMatthew G. Knepley }
45653e9753d6SMatthew G. Knepley 
456606ad1575SMatthew G. Knepley PetscErrorCode DMPlexComputeResidual_Internal(DM dm, PetscFormKey key, IS cellIS, PetscReal time, Vec locX, Vec locX_t, PetscReal t, Vec locF, void *user)
45673e9753d6SMatthew G. Knepley {
45683e9753d6SMatthew G. Knepley   DM_Plex         *mesh       = (DM_Plex *) dm->data;
45693e9753d6SMatthew G. Knepley   const char      *name       = "Residual";
45703e9753d6SMatthew G. Knepley   DM               dmAux      = NULL;
45713e9753d6SMatthew G. Knepley   DM               dmGrad     = NULL;
45723e9753d6SMatthew G. Knepley   DMLabel          ghostLabel = NULL;
45736528b96dSMatthew G. Knepley   PetscDS          ds         = NULL;
45746528b96dSMatthew G. Knepley   PetscDS          dsAux      = NULL;
45753e9753d6SMatthew G. Knepley   PetscSection     section    = NULL;
45763e9753d6SMatthew G. Knepley   PetscBool        useFEM     = PETSC_FALSE;
45773e9753d6SMatthew G. Knepley   PetscBool        useFVM     = PETSC_FALSE;
45783e9753d6SMatthew G. Knepley   PetscBool        isImplicit = (locX_t || time == PETSC_MIN_REAL) ? PETSC_TRUE : PETSC_FALSE;
45793e9753d6SMatthew G. Knepley   PetscFV          fvm        = NULL;
45803e9753d6SMatthew G. Knepley   PetscFVCellGeom *cgeomFVM   = NULL;
45813e9753d6SMatthew G. Knepley   PetscFVFaceGeom *fgeomFVM   = NULL;
45823e9753d6SMatthew G. Knepley   DMField          coordField = NULL;
45833e9753d6SMatthew G. Knepley   Vec              locA, cellGeometryFVM = NULL, faceGeometryFVM = NULL, grad, locGrad = NULL;
45843e9753d6SMatthew G. Knepley   PetscScalar     *u = NULL, *u_t, *a, *uL, *uR;
45853e9753d6SMatthew G. Knepley   IS               chunkIS;
45863e9753d6SMatthew G. Knepley   const PetscInt  *cells;
45873e9753d6SMatthew G. Knepley   PetscInt         cStart, cEnd, numCells;
45883e9753d6SMatthew G. Knepley   PetscInt         Nf, f, totDim, totDimAux, numChunks, cellChunkSize, faceChunkSize, chunk, fStart, fEnd;
45893e9753d6SMatthew G. Knepley   PetscInt         maxDegree = PETSC_MAX_INT;
45903e9753d6SMatthew G. Knepley   PetscQuadrature  affineQuad = NULL, *quads = NULL;
45913e9753d6SMatthew G. Knepley   PetscFEGeom     *affineGeom = NULL, **geoms = NULL;
45923e9753d6SMatthew G. Knepley 
45933e9753d6SMatthew G. Knepley   PetscFunctionBegin;
4594*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventBegin(DMPLEX_ResidualFEM,dm,0,0,0));
45953e9753d6SMatthew G. Knepley   /* TODO The places where we have to use isFE are probably the member functions for the PetscDisc class */
45963e9753d6SMatthew G. Knepley   /* TODO The FVM geometry is over-manipulated. Make the precalc functions return exactly what we need */
45973e9753d6SMatthew G. Knepley   /* FEM+FVM */
4598*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
4599*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetHeightStratum(dm, 1, &fStart, &fEnd));
46003e9753d6SMatthew G. Knepley   /* 1: Get sizes from dm and dmAux */
4601*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &section));
4602*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLabel(dm, "ghost", &ghostLabel));
4603*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCellDS(dm, cells ? cells[cStart] : cStart, &ds));
4604*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetNumFields(ds, &Nf));
4605*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetTotalDimension(ds, &totDim));
4606*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetAuxiliaryVec(dm, key.label, key.value, key.part, &locA));
46073e9753d6SMatthew G. Knepley   if (locA) {
46083e9753d6SMatthew G. Knepley     PetscInt subcell;
4609*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetDM(locA, &dmAux));
4610*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetEnclosurePoint(dmAux, dm, DM_ENC_UNKNOWN, cStart, &subcell));
4611*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetCellDS(dmAux, subcell, &dsAux));
4612*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetTotalDimension(dsAux, &totDimAux));
46133e9753d6SMatthew G. Knepley   }
46143e9753d6SMatthew G. Knepley   /* 2: Get geometric data */
46153e9753d6SMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
46163e9753d6SMatthew G. Knepley     PetscObject  obj;
46173e9753d6SMatthew G. Knepley     PetscClassId id;
46183e9753d6SMatthew G. Knepley     PetscBool    fimp;
46193e9753d6SMatthew G. Knepley 
4620*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetImplicit(ds, f, &fimp));
46213e9753d6SMatthew G. Knepley     if (isImplicit != fimp) continue;
4622*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(ds, f, &obj));
4623*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
46243e9753d6SMatthew G. Knepley     if (id == PETSCFE_CLASSID) {useFEM = PETSC_TRUE;}
46253e9753d6SMatthew G. Knepley     if (id == PETSCFV_CLASSID) {useFVM = PETSC_TRUE; fvm = (PetscFV) obj;}
46263e9753d6SMatthew G. Knepley   }
46273e9753d6SMatthew G. Knepley   if (useFEM) {
4628*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetCoordinateField(dm, &coordField));
4629*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMFieldGetDegree(coordField,cellIS,NULL,&maxDegree));
46303e9753d6SMatthew G. Knepley     if (maxDegree <= 1) {
4631*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMFieldCreateDefaultQuadrature(coordField,cellIS,&affineQuad));
46323e9753d6SMatthew G. Knepley       if (affineQuad) {
4633*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMSNESGetFEGeom(coordField,cellIS,affineQuad,PETSC_FALSE,&affineGeom));
46343e9753d6SMatthew G. Knepley       }
46353e9753d6SMatthew G. Knepley     } else {
4636*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscCalloc2(Nf,&quads,Nf,&geoms));
46373e9753d6SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
46383e9753d6SMatthew G. Knepley         PetscObject  obj;
46393e9753d6SMatthew G. Knepley         PetscClassId id;
46403e9753d6SMatthew G. Knepley         PetscBool    fimp;
46413e9753d6SMatthew G. Knepley 
4642*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDSGetImplicit(ds, f, &fimp));
46433e9753d6SMatthew G. Knepley         if (isImplicit != fimp) continue;
4644*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDSGetDiscretization(ds, f, &obj));
4645*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscObjectGetClassId(obj, &id));
46463e9753d6SMatthew G. Knepley         if (id == PETSCFE_CLASSID) {
46473e9753d6SMatthew G. Knepley           PetscFE fe = (PetscFE) obj;
46483e9753d6SMatthew G. Knepley 
4649*5f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEGetQuadrature(fe, &quads[f]));
4650*5f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscObjectReference((PetscObject)quads[f]));
4651*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMSNESGetFEGeom(coordField,cellIS,quads[f],PETSC_FALSE,&geoms[f]));
46523e9753d6SMatthew G. Knepley         }
46533e9753d6SMatthew G. Knepley       }
46543e9753d6SMatthew G. Knepley     }
46553e9753d6SMatthew G. Knepley   }
46563e9753d6SMatthew G. Knepley   if (useFVM) {
4657*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexGetGeometryFVM(dm, &faceGeometryFVM, &cellGeometryFVM, NULL));
4658*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetArrayRead(faceGeometryFVM, (const PetscScalar **) &fgeomFVM));
4659*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetArrayRead(cellGeometryFVM, (const PetscScalar **) &cgeomFVM));
46603e9753d6SMatthew G. Knepley     /* Reconstruct and limit cell gradients */
4661*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexGetGradientDM(dm, fvm, &dmGrad));
46623e9753d6SMatthew G. Knepley     if (dmGrad) {
4663*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetHeightStratum(dm, 1, &fStart, &fEnd));
4664*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMGetGlobalVector(dmGrad, &grad));
4665*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexReconstructGradients_Internal(dm, fvm, fStart, fEnd, faceGeometryFVM, cellGeometryFVM, locX, grad));
46663e9753d6SMatthew G. Knepley       /* Communicate gradient values */
4667*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMGetLocalVector(dmGrad, &locGrad));
4668*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMGlobalToLocalBegin(dmGrad, grad, INSERT_VALUES, locGrad));
4669*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMGlobalToLocalEnd(dmGrad, grad, INSERT_VALUES, locGrad));
4670*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMRestoreGlobalVector(dmGrad, &grad));
46713e9753d6SMatthew G. Knepley     }
46723e9753d6SMatthew G. Knepley     /* Handle non-essential (e.g. outflow) boundary values */
4673*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexInsertBoundaryValues(dm, PETSC_FALSE, locX, time, faceGeometryFVM, cellGeometryFVM, locGrad));
46743e9753d6SMatthew G. Knepley   }
46753e9753d6SMatthew G. Knepley   /* Loop over chunks */
4676*5f80ce2aSJacob Faibussowitsch   if (useFEM) CHKERRQ(ISCreate(PETSC_COMM_SELF, &chunkIS));
46773e9753d6SMatthew G. Knepley   numCells      = cEnd - cStart;
46783e9753d6SMatthew G. Knepley   numChunks     = 1;
46793e9753d6SMatthew G. Knepley   cellChunkSize = numCells/numChunks;
46803e9753d6SMatthew G. Knepley   faceChunkSize = (fEnd - fStart)/numChunks;
46813e9753d6SMatthew G. Knepley   numChunks     = PetscMin(1,numCells);
46823e9753d6SMatthew G. Knepley   for (chunk = 0; chunk < numChunks; ++chunk) {
46833e9753d6SMatthew G. Knepley     PetscScalar     *elemVec, *fluxL, *fluxR;
46843e9753d6SMatthew G. Knepley     PetscReal       *vol;
46853e9753d6SMatthew G. Knepley     PetscFVFaceGeom *fgeom;
46863e9753d6SMatthew G. Knepley     PetscInt         cS = cStart+chunk*cellChunkSize, cE = PetscMin(cS+cellChunkSize, cEnd), numCells = cE - cS, c;
46873e9753d6SMatthew G. Knepley     PetscInt         fS = fStart+chunk*faceChunkSize, fE = PetscMin(fS+faceChunkSize, fEnd), numFaces = 0, face;
46883e9753d6SMatthew G. Knepley 
46893e9753d6SMatthew G. Knepley     /* Extract field coefficients */
46903e9753d6SMatthew G. Knepley     if (useFEM) {
4691*5f80ce2aSJacob Faibussowitsch       CHKERRQ(ISGetPointSubrange(chunkIS, cS, cE, cells));
4692*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetCellFields(dm, chunkIS, locX, locX_t, locA, &u, &u_t, &a));
4693*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMGetWorkArray(dm, numCells*totDim, MPIU_SCALAR, &elemVec));
4694*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscArrayzero(elemVec, numCells*totDim));
46953e9753d6SMatthew G. Knepley     }
46963e9753d6SMatthew G. Knepley     if (useFVM) {
4697*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetFaceFields(dm, fS, fE, locX, locX_t, faceGeometryFVM, cellGeometryFVM, locGrad, &numFaces, &uL, &uR));
4698*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetFaceGeometry(dm, fS, fE, faceGeometryFVM, cellGeometryFVM, &numFaces, &fgeom, &vol));
4699*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMGetWorkArray(dm, numFaces*totDim, MPIU_SCALAR, &fluxL));
4700*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMGetWorkArray(dm, numFaces*totDim, MPIU_SCALAR, &fluxR));
4701*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscArrayzero(fluxL, numFaces*totDim));
4702*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscArrayzero(fluxR, numFaces*totDim));
47033e9753d6SMatthew G. Knepley     }
47043e9753d6SMatthew G. Knepley     /* TODO We will interlace both our field coefficients (u, u_t, uL, uR, etc.) and our output (elemVec, fL, fR). I think this works */
47053e9753d6SMatthew G. Knepley     /* Loop over fields */
47063e9753d6SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
47073e9753d6SMatthew G. Knepley       PetscObject  obj;
47083e9753d6SMatthew G. Knepley       PetscClassId id;
47093e9753d6SMatthew G. Knepley       PetscBool    fimp;
47103e9753d6SMatthew G. Knepley       PetscInt     numChunks, numBatches, batchSize, numBlocks, blockSize, Ne, Nr, offset;
47113e9753d6SMatthew G. Knepley 
47126528b96dSMatthew G. Knepley       key.field = f;
4713*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetImplicit(ds, f, &fimp));
47143e9753d6SMatthew G. Knepley       if (isImplicit != fimp) continue;
4715*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetDiscretization(ds, f, &obj));
4716*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscObjectGetClassId(obj, &id));
47173e9753d6SMatthew G. Knepley       if (id == PETSCFE_CLASSID) {
47183e9753d6SMatthew G. Knepley         PetscFE         fe = (PetscFE) obj;
47193e9753d6SMatthew G. Knepley         PetscFEGeom    *geom = affineGeom ? affineGeom : geoms[f];
47203e9753d6SMatthew G. Knepley         PetscFEGeom    *chunkGeom = NULL;
47213e9753d6SMatthew G. Knepley         PetscQuadrature quad = affineQuad ? affineQuad : quads[f];
47223e9753d6SMatthew G. Knepley         PetscInt        Nq, Nb;
47233e9753d6SMatthew G. Knepley 
4724*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
4725*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscQuadratureGetData(quad, NULL, NULL, &Nq, NULL, NULL));
4726*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGetDimension(fe, &Nb));
47273e9753d6SMatthew G. Knepley         blockSize = Nb;
47283e9753d6SMatthew G. Knepley         batchSize = numBlocks * blockSize;
4729*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
47303e9753d6SMatthew G. Knepley         numChunks = numCells / (numBatches*batchSize);
47313e9753d6SMatthew G. Knepley         Ne        = numChunks*numBatches*batchSize;
47323e9753d6SMatthew G. Knepley         Nr        = numCells % (numBatches*batchSize);
47333e9753d6SMatthew G. Knepley         offset    = numCells - Nr;
47343e9753d6SMatthew G. Knepley         /* Integrate FE residual to get elemVec (need fields at quadrature points) */
47353e9753d6SMatthew G. Knepley         /*   For FV, I think we use a P0 basis and the cell coefficients (for subdivided cells, we can tweak the basis tabulation to be the indicator function) */
4736*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGeomGetChunk(geom,0,offset,&chunkGeom));
4737*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEIntegrateResidual(ds, key, Ne, chunkGeom, u, u_t, dsAux, a, t, elemVec));
4738*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGeomGetChunk(geom,offset,numCells,&chunkGeom));
4739*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEIntegrateResidual(ds, key, Nr, chunkGeom, &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, dsAux, &a[offset*totDimAux], t, &elemVec[offset*totDim]));
4740*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGeomRestoreChunk(geom,offset,numCells,&chunkGeom));
47413e9753d6SMatthew G. Knepley       } else if (id == PETSCFV_CLASSID) {
47423e9753d6SMatthew G. Knepley         PetscFV fv = (PetscFV) obj;
47433e9753d6SMatthew G. Knepley 
47443e9753d6SMatthew G. Knepley         Ne = numFaces;
47453e9753d6SMatthew G. Knepley         /* Riemann solve over faces (need fields at face centroids) */
47463e9753d6SMatthew G. Knepley         /*   We need to evaluate FE fields at those coordinates */
4747*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFVIntegrateRHSFunction(fv, ds, f, Ne, fgeom, vol, uL, uR, fluxL, fluxR));
474898921bdaSJacob Faibussowitsch       } else SETERRQ(PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", f);
47493e9753d6SMatthew G. Knepley     }
47503e9753d6SMatthew G. Knepley     /* Loop over domain */
47513e9753d6SMatthew G. Knepley     if (useFEM) {
47523e9753d6SMatthew G. Knepley       /* Add elemVec to locX */
47533e9753d6SMatthew G. Knepley       for (c = cS; c < cE; ++c) {
47543e9753d6SMatthew G. Knepley         const PetscInt cell = cells ? cells[c] : c;
47553e9753d6SMatthew G. Knepley         const PetscInt cind = c - cStart;
47563e9753d6SMatthew G. Knepley 
4757*5f80ce2aSJacob Faibussowitsch         if (mesh->printFEM > 1) CHKERRQ(DMPrintCellVector(cell, name, totDim, &elemVec[cind*totDim]));
47583e9753d6SMatthew G. Knepley         if (ghostLabel) {
47593e9753d6SMatthew G. Knepley           PetscInt ghostVal;
47603e9753d6SMatthew G. Knepley 
4761*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMLabelGetValue(ghostLabel,cell,&ghostVal));
47623e9753d6SMatthew G. Knepley           if (ghostVal > 0) continue;
47633e9753d6SMatthew G. Knepley         }
4764*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecSetClosure(dm, section, locF, cell, &elemVec[cind*totDim], ADD_ALL_VALUES));
47653e9753d6SMatthew G. Knepley       }
47663e9753d6SMatthew G. Knepley     }
47673e9753d6SMatthew G. Knepley     if (useFVM) {
47683e9753d6SMatthew G. Knepley       PetscScalar *fa;
47693e9753d6SMatthew G. Knepley       PetscInt     iface;
47703e9753d6SMatthew G. Knepley 
4771*5f80ce2aSJacob Faibussowitsch       CHKERRQ(VecGetArray(locF, &fa));
47723e9753d6SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
47733e9753d6SMatthew G. Knepley         PetscFV      fv;
47743e9753d6SMatthew G. Knepley         PetscObject  obj;
47753e9753d6SMatthew G. Knepley         PetscClassId id;
47763e9753d6SMatthew G. Knepley         PetscInt     foff, pdim;
47773e9753d6SMatthew G. Knepley 
4778*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDSGetDiscretization(ds, f, &obj));
4779*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDSGetFieldOffset(ds, f, &foff));
4780*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscObjectGetClassId(obj, &id));
47813e9753d6SMatthew G. Knepley         if (id != PETSCFV_CLASSID) continue;
47823e9753d6SMatthew G. Knepley         fv   = (PetscFV) obj;
4783*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFVGetNumComponents(fv, &pdim));
47843e9753d6SMatthew G. Knepley         /* Accumulate fluxes to cells */
47853e9753d6SMatthew G. Knepley         for (face = fS, iface = 0; face < fE; ++face) {
47863e9753d6SMatthew G. Knepley           const PetscInt *scells;
47873e9753d6SMatthew G. Knepley           PetscScalar    *fL = NULL, *fR = NULL;
47883e9753d6SMatthew G. Knepley           PetscInt        ghost, d, nsupp, nchild;
47893e9753d6SMatthew G. Knepley 
4790*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMLabelGetValue(ghostLabel, face, &ghost));
4791*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexGetSupportSize(dm, face, &nsupp));
4792*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexGetTreeChildren(dm, face, &nchild, NULL));
47933e9753d6SMatthew G. Knepley           if (ghost >= 0 || nsupp > 2 || nchild > 0) continue;
4794*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexGetSupport(dm, face, &scells));
4795*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMLabelGetValue(ghostLabel,scells[0],&ghost));
4796*5f80ce2aSJacob Faibussowitsch           if (ghost <= 0) CHKERRQ(DMPlexPointLocalFieldRef(dm, scells[0], f, fa, &fL));
4797*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMLabelGetValue(ghostLabel,scells[1],&ghost));
4798*5f80ce2aSJacob Faibussowitsch           if (ghost <= 0) CHKERRQ(DMPlexPointLocalFieldRef(dm, scells[1], f, fa, &fR));
47993e9753d6SMatthew G. Knepley           for (d = 0; d < pdim; ++d) {
48003e9753d6SMatthew G. Knepley             if (fL) fL[d] -= fluxL[iface*totDim+foff+d];
48013e9753d6SMatthew G. Knepley             if (fR) fR[d] += fluxR[iface*totDim+foff+d];
48023e9753d6SMatthew G. Knepley           }
48033e9753d6SMatthew G. Knepley           ++iface;
48043e9753d6SMatthew G. Knepley         }
48053e9753d6SMatthew G. Knepley       }
4806*5f80ce2aSJacob Faibussowitsch       CHKERRQ(VecRestoreArray(locF, &fa));
48073e9753d6SMatthew G. Knepley     }
48083e9753d6SMatthew G. Knepley     /* Handle time derivative */
48093e9753d6SMatthew G. Knepley     if (locX_t) {
48103e9753d6SMatthew G. Knepley       PetscScalar *x_t, *fa;
48113e9753d6SMatthew G. Knepley 
4812*5f80ce2aSJacob Faibussowitsch       CHKERRQ(VecGetArray(locF, &fa));
4813*5f80ce2aSJacob Faibussowitsch       CHKERRQ(VecGetArray(locX_t, &x_t));
48143e9753d6SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
48153e9753d6SMatthew G. Knepley         PetscFV      fv;
48163e9753d6SMatthew G. Knepley         PetscObject  obj;
48173e9753d6SMatthew G. Knepley         PetscClassId id;
48183e9753d6SMatthew G. Knepley         PetscInt     pdim, d;
48193e9753d6SMatthew G. Knepley 
4820*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDSGetDiscretization(ds, f, &obj));
4821*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscObjectGetClassId(obj, &id));
48223e9753d6SMatthew G. Knepley         if (id != PETSCFV_CLASSID) continue;
48233e9753d6SMatthew G. Knepley         fv   = (PetscFV) obj;
4824*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFVGetNumComponents(fv, &pdim));
48253e9753d6SMatthew G. Knepley         for (c = cS; c < cE; ++c) {
48263e9753d6SMatthew G. Knepley           const PetscInt cell = cells ? cells[c] : c;
48273e9753d6SMatthew G. Knepley           PetscScalar   *u_t, *r;
48283e9753d6SMatthew G. Knepley 
48293e9753d6SMatthew G. Knepley           if (ghostLabel) {
48303e9753d6SMatthew G. Knepley             PetscInt ghostVal;
48313e9753d6SMatthew G. Knepley 
4832*5f80ce2aSJacob Faibussowitsch             CHKERRQ(DMLabelGetValue(ghostLabel, cell, &ghostVal));
48333e9753d6SMatthew G. Knepley             if (ghostVal > 0) continue;
48343e9753d6SMatthew G. Knepley           }
4835*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexPointLocalFieldRead(dm, cell, f, x_t, &u_t));
4836*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexPointLocalFieldRef(dm, cell, f, fa, &r));
48373e9753d6SMatthew G. Knepley           for (d = 0; d < pdim; ++d) r[d] += u_t[d];
48383e9753d6SMatthew G. Knepley         }
48393e9753d6SMatthew G. Knepley       }
4840*5f80ce2aSJacob Faibussowitsch       CHKERRQ(VecRestoreArray(locX_t, &x_t));
4841*5f80ce2aSJacob Faibussowitsch       CHKERRQ(VecRestoreArray(locF, &fa));
48423e9753d6SMatthew G. Knepley     }
48433e9753d6SMatthew G. Knepley     if (useFEM) {
4844*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexRestoreCellFields(dm, chunkIS, locX, locX_t, locA, &u, &u_t, &a));
4845*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMRestoreWorkArray(dm, numCells*totDim, MPIU_SCALAR, &elemVec));
48463e9753d6SMatthew G. Knepley     }
48473e9753d6SMatthew G. Knepley     if (useFVM) {
4848*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexRestoreFaceFields(dm, fS, fE, locX, locX_t, faceGeometryFVM, cellGeometryFVM, locGrad, &numFaces, &uL, &uR));
4849*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexRestoreFaceGeometry(dm, fS, fE, faceGeometryFVM, cellGeometryFVM, &numFaces, &fgeom, &vol));
4850*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMRestoreWorkArray(dm, numFaces*totDim, MPIU_SCALAR, &fluxL));
4851*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMRestoreWorkArray(dm, numFaces*totDim, MPIU_SCALAR, &fluxR));
4852*5f80ce2aSJacob Faibussowitsch       if (dmGrad) CHKERRQ(DMRestoreLocalVector(dmGrad, &locGrad));
48533e9753d6SMatthew G. Knepley     }
48543e9753d6SMatthew G. Knepley   }
4855*5f80ce2aSJacob Faibussowitsch   if (useFEM) CHKERRQ(ISDestroy(&chunkIS));
4856*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
48573e9753d6SMatthew G. Knepley 
48583e9753d6SMatthew G. Knepley   if (useFEM) {
4859*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexComputeBdResidual_Internal(dm, locX, locX_t, t, locF, user));
48603e9753d6SMatthew G. Knepley 
48613e9753d6SMatthew G. Knepley     if (maxDegree <= 1) {
4862*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMSNESRestoreFEGeom(coordField,cellIS,affineQuad,PETSC_FALSE,&affineGeom));
4863*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscQuadratureDestroy(&affineQuad));
48643e9753d6SMatthew G. Knepley     } else {
48653e9753d6SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
4866*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMSNESRestoreFEGeom(coordField,cellIS,quads[f],PETSC_FALSE,&geoms[f]));
4867*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscQuadratureDestroy(&quads[f]));
48683e9753d6SMatthew G. Knepley       }
4869*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFree2(quads,geoms));
48703e9753d6SMatthew G. Knepley     }
48713e9753d6SMatthew G. Knepley   }
48723e9753d6SMatthew G. Knepley 
48733e9753d6SMatthew G. Knepley   /* FEM */
48743e9753d6SMatthew G. Knepley   /* 1: Get sizes from dm and dmAux */
48753e9753d6SMatthew G. Knepley   /* 2: Get geometric data */
48763e9753d6SMatthew G. Knepley   /* 3: Handle boundary values */
48773e9753d6SMatthew G. Knepley   /* 4: Loop over domain */
48783e9753d6SMatthew G. Knepley   /*   Extract coefficients */
48793e9753d6SMatthew G. Knepley   /* Loop over fields */
48803e9753d6SMatthew G. Knepley   /*   Set tiling for FE*/
48813e9753d6SMatthew G. Knepley   /*   Integrate FE residual to get elemVec */
48823e9753d6SMatthew G. Knepley   /*     Loop over subdomain */
48833e9753d6SMatthew G. Knepley   /*       Loop over quad points */
48843e9753d6SMatthew G. Knepley   /*         Transform coords to real space */
48853e9753d6SMatthew G. Knepley   /*         Evaluate field and aux fields at point */
48863e9753d6SMatthew G. Knepley   /*         Evaluate residual at point */
48873e9753d6SMatthew G. Knepley   /*         Transform residual to real space */
48883e9753d6SMatthew G. Knepley   /*       Add residual to elemVec */
48893e9753d6SMatthew G. Knepley   /* Loop over domain */
48903e9753d6SMatthew G. Knepley   /*   Add elemVec to locX */
48913e9753d6SMatthew G. Knepley 
48923e9753d6SMatthew G. Knepley   /* FVM */
48933e9753d6SMatthew G. Knepley   /* Get geometric data */
48943e9753d6SMatthew G. Knepley   /* If using gradients */
48953e9753d6SMatthew G. Knepley   /*   Compute gradient data */
48963e9753d6SMatthew G. Knepley   /*   Loop over domain faces */
48973e9753d6SMatthew G. Knepley   /*     Count computational faces */
48983e9753d6SMatthew G. Knepley   /*     Reconstruct cell gradient */
48993e9753d6SMatthew G. Knepley   /*   Loop over domain cells */
49003e9753d6SMatthew G. Knepley   /*     Limit cell gradients */
49013e9753d6SMatthew G. Knepley   /* Handle boundary values */
49023e9753d6SMatthew G. Knepley   /* Loop over domain faces */
49033e9753d6SMatthew G. Knepley   /*   Read out field, centroid, normal, volume for each side of face */
49043e9753d6SMatthew G. Knepley   /* Riemann solve over faces */
49053e9753d6SMatthew G. Knepley   /* Loop over domain faces */
49063e9753d6SMatthew G. Knepley   /*   Accumulate fluxes to cells */
49073e9753d6SMatthew G. Knepley   /* TODO Change printFEM to printDisc here */
49083e9753d6SMatthew G. Knepley   if (mesh->printFEM) {
49093e9753d6SMatthew G. Knepley     Vec         locFbc;
49103e9753d6SMatthew G. Knepley     PetscInt    pStart, pEnd, p, maxDof;
49113e9753d6SMatthew G. Knepley     PetscScalar *zeroes;
49123e9753d6SMatthew G. Knepley 
4913*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecDuplicate(locF,&locFbc));
4914*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecCopy(locF,locFbc));
4915*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscSectionGetChart(section,&pStart,&pEnd));
4916*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscSectionGetMaxDof(section,&maxDof));
4917*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscCalloc1(maxDof,&zeroes));
49183e9753d6SMatthew G. Knepley     for (p = pStart; p < pEnd; p++) {
4919*5f80ce2aSJacob Faibussowitsch       CHKERRQ(VecSetValuesSection(locFbc,section,p,zeroes,INSERT_BC_VALUES));
49203e9753d6SMatthew G. Knepley     }
4921*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFree(zeroes));
4922*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPrintLocalVec(dm, name, mesh->printTol, locFbc));
4923*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecDestroy(&locFbc));
49243e9753d6SMatthew G. Knepley   }
4925*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventEnd(DMPLEX_ResidualFEM,dm,0,0,0));
49263e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
49273e9753d6SMatthew G. Knepley }
49283e9753d6SMatthew G. Knepley 
49296528b96dSMatthew G. Knepley /*
49306528b96dSMatthew G. Knepley   1) Allow multiple kernels for BdResidual for hybrid DS
49316528b96dSMatthew G. Knepley 
49326528b96dSMatthew G. Knepley   DONE 2) Get out dsAux for either side at the same time as cohesive cell dsAux
49336528b96dSMatthew G. Knepley 
49346528b96dSMatthew G. Knepley   DONE 3) Change DMGetCellFields() to get different aux data a[] for each side
49356528b96dSMatthew G. Knepley      - I think I just need to replace a[] with the closure from each face
49366528b96dSMatthew G. Knepley 
49376528b96dSMatthew G. Knepley   4) Run both kernels for each non-hybrid field with correct dsAux, and then hybrid field as before
49386528b96dSMatthew G. Knepley */
493906ad1575SMatthew G. Knepley PetscErrorCode DMPlexComputeResidual_Hybrid_Internal(DM dm, PetscFormKey key[], IS cellIS, PetscReal time, Vec locX, Vec locX_t, PetscReal t, Vec locF, void *user)
49403e9753d6SMatthew G. Knepley {
49413e9753d6SMatthew G. Knepley   DM_Plex         *mesh       = (DM_Plex *) dm->data;
49423e9753d6SMatthew G. Knepley   const char      *name       = "Hybrid Residual";
494304c51a94SMatthew G. Knepley   DM               dmAux[3]   = {NULL, NULL, NULL};
49443e9753d6SMatthew G. Knepley   DMLabel          ghostLabel = NULL;
49456528b96dSMatthew G. Knepley   PetscDS          ds         = NULL;
49466528b96dSMatthew G. Knepley   PetscDS          dsAux[3]   = {NULL, NULL, NULL};
494704c51a94SMatthew G. Knepley   Vec              locA[3]    = {NULL, NULL, NULL};
49483e9753d6SMatthew G. Knepley   PetscSection     section    = NULL;
49493e9753d6SMatthew G. Knepley   DMField          coordField = NULL;
49506528b96dSMatthew G. Knepley   PetscScalar     *u = NULL, *u_t, *a[3];
49513e9753d6SMatthew G. Knepley   PetscScalar     *elemVec;
49523e9753d6SMatthew G. Knepley   IS               chunkIS;
49533e9753d6SMatthew G. Knepley   const PetscInt  *cells;
49543e9753d6SMatthew G. Knepley   PetscInt        *faces;
49553e9753d6SMatthew G. Knepley   PetscInt         cStart, cEnd, numCells;
49566528b96dSMatthew G. Knepley   PetscInt         Nf, f, totDim, totDimAux[3], numChunks, cellChunkSize, chunk;
49573e9753d6SMatthew G. Knepley   PetscInt         maxDegree = PETSC_MAX_INT;
49583e9753d6SMatthew G. Knepley   PetscQuadrature  affineQuad = NULL, *quads = NULL;
49593e9753d6SMatthew G. Knepley   PetscFEGeom     *affineGeom = NULL, **geoms = NULL;
49603e9753d6SMatthew G. Knepley 
49613e9753d6SMatthew G. Knepley   PetscFunctionBegin;
49625fedec97SMatthew G. Knepley   if ((key[0].label == key[1].label) && (key[0].value == key[1].value) && (key[0].part == key[1].part)) {
49635fedec97SMatthew G. Knepley     const char *name;
4964*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetName((PetscObject) key[0].label, &name));
496598921bdaSJacob Faibussowitsch     SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Form keys for each side of a cohesive surface must be different (%s, %D, %D)", name, key[0].value, key[0].part);
49665fedec97SMatthew G. Knepley   }
4967*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventBegin(DMPLEX_ResidualFEM,dm,0,0,0));
49683e9753d6SMatthew G. Knepley   /* TODO The places where we have to use isFE are probably the member functions for the PetscDisc class */
49693e9753d6SMatthew G. Knepley   /* FEM */
4970*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISGetLocalSize(cellIS, &numCells));
4971*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
49723e9753d6SMatthew G. Knepley   /* 1: Get sizes from dm and dmAux */
4973*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetSection(dm, &section));
4974*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLabel(dm, "ghost", &ghostLabel));
4975*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCellDS(dm, cStart, &ds));
4976*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetNumFields(ds, &Nf));
4977*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetTotalDimension(ds, &totDim));
4978*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetAuxiliaryVec(dm, key[2].label, key[2].value, key[2].part, &locA[2]));
497904c51a94SMatthew G. Knepley   if (locA[2]) {
4980*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetDM(locA[2], &dmAux[2]));
4981*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetCellDS(dmAux[2], cStart, &dsAux[2]));
4982*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetTotalDimension(dsAux[2], &totDimAux[2]));
49836528b96dSMatthew G. Knepley     {
49846528b96dSMatthew G. Knepley       const PetscInt *cone;
49856528b96dSMatthew G. Knepley       PetscInt        c;
49866528b96dSMatthew G. Knepley 
4987*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetCone(dm, cStart, &cone));
49886528b96dSMatthew G. Knepley       for (c = 0; c < 2; ++c) {
49896528b96dSMatthew G. Knepley         const PetscInt *support;
49906528b96dSMatthew G. Knepley         PetscInt ssize, s;
49916528b96dSMatthew G. Knepley 
4992*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexGetSupport(dm, cone[c], &support));
4993*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexGetSupportSize(dm, cone[c], &ssize));
4994*5f80ce2aSJacob Faibussowitsch         PetscCheck(ssize == 2,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Face %D from cell %D has support size %D != 2", cone[c], cStart, ssize);
49956528b96dSMatthew G. Knepley         if      (support[0] == cStart) s = 1;
49966528b96dSMatthew G. Knepley         else if (support[1] == cStart) s = 0;
499798921bdaSJacob Faibussowitsch         else SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Face %D does not have cell %D in its support", cone[c], cStart);
4998*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMGetAuxiliaryVec(dm, key[c].label, key[c].value, key[c].part, &locA[c]));
4999*5f80ce2aSJacob Faibussowitsch         if (locA[c]) CHKERRQ(VecGetDM(locA[c], &dmAux[c]));
500004c51a94SMatthew G. Knepley         else         {dmAux[c] = dmAux[2];}
5001*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMGetCellDS(dmAux[c], support[s], &dsAux[c]));
5002*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDSGetTotalDimension(dsAux[c], &totDimAux[c]));
50036528b96dSMatthew G. Knepley       }
50046528b96dSMatthew G. Knepley     }
50053e9753d6SMatthew G. Knepley   }
50063e9753d6SMatthew G. Knepley   /* 2: Setup geometric data */
5007*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateField(dm, &coordField));
5008*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMFieldGetDegree(coordField, cellIS, NULL, &maxDegree));
50093e9753d6SMatthew G. Knepley   if (maxDegree > 1) {
5010*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscCalloc2(Nf, &quads, Nf, &geoms));
50113e9753d6SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
50123e9753d6SMatthew G. Knepley       PetscFE fe;
50133e9753d6SMatthew G. Knepley 
5014*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetDiscretization(ds, f, (PetscObject *) &fe));
50153e9753d6SMatthew G. Knepley       if (fe) {
5016*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGetQuadrature(fe, &quads[f]));
5017*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscObjectReference((PetscObject) quads[f]));
50183e9753d6SMatthew G. Knepley       }
50193e9753d6SMatthew G. Knepley     }
50203e9753d6SMatthew G. Knepley   }
50213e9753d6SMatthew G. Knepley   /* Loop over chunks */
50223e9753d6SMatthew G. Knepley   cellChunkSize = numCells;
50233e9753d6SMatthew G. Knepley   numChunks     = !numCells ? 0 : PetscCeilReal(((PetscReal) numCells)/cellChunkSize);
5024*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscCalloc1(2*cellChunkSize, &faces));
5025*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISCreateGeneral(PETSC_COMM_SELF, cellChunkSize, faces, PETSC_USE_POINTER, &chunkIS));
50263e9753d6SMatthew G. Knepley   /* Extract field coefficients */
50273e9753d6SMatthew G. Knepley   /* NOTE This needs the end cap faces to have identical orientations */
5028*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetCellFields(dm, cellIS, locX, locX_t, locA[2], &u, &u_t, &a[2]));
5029*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetHybridAuxFields(dm, dmAux, dsAux, cellIS, locA, a));
5030*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetWorkArray(dm, cellChunkSize*totDim, MPIU_SCALAR, &elemVec));
50313e9753d6SMatthew G. Knepley   for (chunk = 0; chunk < numChunks; ++chunk) {
50323e9753d6SMatthew G. Knepley     PetscInt cS = cStart+chunk*cellChunkSize, cE = PetscMin(cS+cellChunkSize, cEnd), numCells = cE - cS, c;
50333e9753d6SMatthew G. Knepley 
5034*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscMemzero(elemVec, cellChunkSize*totDim * sizeof(PetscScalar)));
50353e9753d6SMatthew G. Knepley     /* Get faces */
50363e9753d6SMatthew G. Knepley     for (c = cS; c < cE; ++c) {
50373e9753d6SMatthew G. Knepley       const PetscInt  cell = cells ? cells[c] : c;
50383e9753d6SMatthew G. Knepley       const PetscInt *cone;
5039*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetCone(dm, cell, &cone));
50403e9753d6SMatthew G. Knepley       faces[(c-cS)*2+0] = cone[0];
50413e9753d6SMatthew G. Knepley       faces[(c-cS)*2+1] = cone[1];
50423e9753d6SMatthew G. Knepley     }
5043*5f80ce2aSJacob Faibussowitsch     CHKERRQ(ISGeneralSetIndices(chunkIS, cellChunkSize, faces, PETSC_USE_POINTER));
50443e9753d6SMatthew G. Knepley     /* Get geometric data */
50453e9753d6SMatthew G. Knepley     if (maxDegree <= 1) {
5046*5f80ce2aSJacob Faibussowitsch       if (!affineQuad) CHKERRQ(DMFieldCreateDefaultQuadrature(coordField, chunkIS, &affineQuad));
5047*5f80ce2aSJacob Faibussowitsch       if (affineQuad)  CHKERRQ(DMSNESGetFEGeom(coordField, chunkIS, affineQuad, PETSC_TRUE, &affineGeom));
50483e9753d6SMatthew G. Knepley     } else {
50493e9753d6SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
5050*5f80ce2aSJacob Faibussowitsch         if (quads[f]) CHKERRQ(DMSNESGetFEGeom(coordField, chunkIS, quads[f], PETSC_TRUE, &geoms[f]));
50513e9753d6SMatthew G. Knepley       }
50523e9753d6SMatthew G. Knepley     }
50533e9753d6SMatthew G. Knepley     /* Loop over fields */
50543e9753d6SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
50553e9753d6SMatthew G. Knepley       PetscFE         fe;
50563e9753d6SMatthew G. Knepley       PetscFEGeom    *geom = affineGeom ? affineGeom : geoms[f];
5057148442b3SMatthew G. Knepley       PetscFEGeom    *chunkGeom = NULL, *remGeom = NULL;
50583e9753d6SMatthew G. Knepley       PetscQuadrature quad = affineQuad ? affineQuad : quads[f];
50593e9753d6SMatthew G. Knepley       PetscInt        numChunks, numBatches, batchSize, numBlocks, blockSize, Ne, Nr, offset, Nq, Nb;
50605fedec97SMatthew G. Knepley       PetscBool       isCohesiveField;
50613e9753d6SMatthew G. Knepley 
5062*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetDiscretization(ds, f, (PetscObject *) &fe));
50633e9753d6SMatthew G. Knepley       if (!fe) continue;
5064*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
5065*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscQuadratureGetData(quad, NULL, NULL, &Nq, NULL, NULL));
5066*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetDimension(fe, &Nb));
50673e9753d6SMatthew G. Knepley       blockSize = Nb;
50683e9753d6SMatthew G. Knepley       batchSize = numBlocks * blockSize;
5069*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
50703e9753d6SMatthew G. Knepley       numChunks = numCells / (numBatches*batchSize);
50713e9753d6SMatthew G. Knepley       Ne        = numChunks*numBatches*batchSize;
50723e9753d6SMatthew G. Knepley       Nr        = numCells % (numBatches*batchSize);
50733e9753d6SMatthew G. Knepley       offset    = numCells - Nr;
5074*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomGetChunk(geom,0,offset,&chunkGeom));
5075*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomGetChunk(geom,offset,numCells,&remGeom));
5076*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetCohesive(ds, f, &isCohesiveField));
50775fedec97SMatthew G. Knepley       chunkGeom->isCohesive = remGeom->isCohesive = PETSC_TRUE;
50786528b96dSMatthew G. Knepley       key[0].field = f;
50796528b96dSMatthew G. Knepley       key[1].field = f;
50805fedec97SMatthew G. Knepley       key[2].field = f;
5081*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEIntegrateHybridResidual(ds, key[0], 0, Ne, chunkGeom, u, u_t, dsAux[0], a[0], t, elemVec));
5082*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEIntegrateHybridResidual(ds, key[0], 0, Nr, remGeom,  &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, dsAux[0], &a[0][offset*totDimAux[0]], t, &elemVec[offset*totDim]));
5083*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEIntegrateHybridResidual(ds, key[1], 1, Ne, chunkGeom, u, u_t, dsAux[1], a[1], t, elemVec));
5084*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEIntegrateHybridResidual(ds, key[1], 1, Nr, remGeom,  &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, dsAux[1], &a[1][offset*totDimAux[1]], t, &elemVec[offset*totDim]));
5085*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEIntegrateHybridResidual(ds, key[2], 2, Ne, chunkGeom, u, u_t, dsAux[2], a[2], t, elemVec));
5086*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEIntegrateHybridResidual(ds, key[2], 2, Nr, remGeom,  &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, dsAux[2], &a[2][offset*totDimAux[2]], t, &elemVec[offset*totDim]));
5087*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomRestoreChunk(geom,offset,numCells,&remGeom));
5088*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomRestoreChunk(geom,0,offset,&chunkGeom));
50893e9753d6SMatthew G. Knepley     }
50903e9753d6SMatthew G. Knepley     /* Add elemVec to locX */
50913e9753d6SMatthew G. Knepley     for (c = cS; c < cE; ++c) {
50923e9753d6SMatthew G. Knepley       const PetscInt cell = cells ? cells[c] : c;
50933e9753d6SMatthew G. Knepley       const PetscInt cind = c - cStart;
50943e9753d6SMatthew G. Knepley 
5095*5f80ce2aSJacob Faibussowitsch       if (mesh->printFEM > 1) CHKERRQ(DMPrintCellVector(cell, name, totDim, &elemVec[cind*totDim]));
50963e9753d6SMatthew G. Knepley       if (ghostLabel) {
50973e9753d6SMatthew G. Knepley         PetscInt ghostVal;
50983e9753d6SMatthew G. Knepley 
5099*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMLabelGetValue(ghostLabel,cell,&ghostVal));
51003e9753d6SMatthew G. Knepley         if (ghostVal > 0) continue;
51013e9753d6SMatthew G. Knepley       }
5102*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecSetClosure(dm, section, locF, cell, &elemVec[cind*totDim], ADD_ALL_VALUES));
51033e9753d6SMatthew G. Knepley     }
51043e9753d6SMatthew G. Knepley   }
5105*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexRestoreCellFields(dm, cellIS, locX, locX_t, locA[2], &u, &u_t, &a[2]));
5106*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexRestoreHybridAuxFields(dmAux, dsAux, cellIS, locA, a));
5107*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreWorkArray(dm, numCells*totDim, MPIU_SCALAR, &elemVec));
5108*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree(faces));
5109*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISDestroy(&chunkIS));
5110*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
51113e9753d6SMatthew G. Knepley   if (maxDegree <= 1) {
5112*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMSNESRestoreFEGeom(coordField,cellIS,affineQuad,PETSC_FALSE,&affineGeom));
5113*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscQuadratureDestroy(&affineQuad));
51143e9753d6SMatthew G. Knepley   } else {
51153e9753d6SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
5116*5f80ce2aSJacob Faibussowitsch       if (geoms) CHKERRQ(DMSNESRestoreFEGeom(coordField,cellIS,quads[f],PETSC_FALSE,&geoms[f]));
5117*5f80ce2aSJacob Faibussowitsch       if (quads) CHKERRQ(PetscQuadratureDestroy(&quads[f]));
51183e9753d6SMatthew G. Knepley     }
5119*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFree2(quads,geoms));
51203e9753d6SMatthew G. Knepley   }
5121*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventEnd(DMPLEX_ResidualFEM,dm,0,0,0));
51223e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
51233e9753d6SMatthew G. Knepley }
51243e9753d6SMatthew G. Knepley 
512545480ffeSMatthew G. Knepley PetscErrorCode DMPlexComputeBdJacobian_Single_Internal(DM dm, PetscReal t, PetscWeakForm wf, DMLabel label, PetscInt numValues, const PetscInt values[], PetscInt fieldI, Vec locX, Vec locX_t, PetscReal X_tShift, Mat Jac, Mat JacP, DMField coordField, IS facetIS)
51263e9753d6SMatthew G. Knepley {
51273e9753d6SMatthew G. Knepley   DM_Plex        *mesh = (DM_Plex *) dm->data;
51283e9753d6SMatthew G. Knepley   DM              plex = NULL, plexA = NULL, tdm;
51293e9753d6SMatthew G. Knepley   DMEnclosureType encAux;
51303e9753d6SMatthew G. Knepley   PetscDS         prob, probAux = NULL;
51313e9753d6SMatthew G. Knepley   PetscSection    section, sectionAux = NULL;
5132e432b41dSStefano Zampini   PetscSection    globalSection;
51333e9753d6SMatthew G. Knepley   Vec             locA = NULL, tv;
51343e9753d6SMatthew G. Knepley   PetscScalar    *u = NULL, *u_t = NULL, *a = NULL, *elemMat = NULL;
51353e9753d6SMatthew G. Knepley   PetscInt        v;
51363e9753d6SMatthew G. Knepley   PetscInt        Nf, totDim, totDimAux = 0;
5137e432b41dSStefano Zampini   PetscBool       transform;
51383e9753d6SMatthew G. Knepley 
51393e9753d6SMatthew G. Knepley   PetscFunctionBegin;
5140*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMConvert(dm, DMPLEX, &plex));
5141*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMHasBasisTransform(dm, &transform));
5142*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetBasisTransformDM_Internal(dm, &tdm));
5143*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetBasisTransformVec_Internal(dm, &tv));
5144*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &section));
5145*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDS(dm, &prob));
5146*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetNumFields(prob, &Nf));
5147*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetTotalDimension(prob, &totDim));
5148*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetAuxiliaryVec(dm, label, values[0], 0, &locA));
51493e9753d6SMatthew G. Knepley   if (locA) {
51503e9753d6SMatthew G. Knepley     DM dmAux;
51513e9753d6SMatthew G. Knepley 
5152*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetDM(locA, &dmAux));
5153*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetEnclosureRelation(dmAux, dm, &encAux));
5154*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMConvert(dmAux, DMPLEX, &plexA));
5155*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetDS(plexA, &probAux));
5156*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetTotalDimension(probAux, &totDimAux));
5157*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetLocalSection(plexA, &sectionAux));
51583e9753d6SMatthew G. Knepley   }
51593e9753d6SMatthew G. Knepley 
5160*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetGlobalSection(dm, &globalSection));
51613e9753d6SMatthew G. Knepley   for (v = 0; v < numValues; ++v) {
51623e9753d6SMatthew G. Knepley     PetscFEGeom     *fgeom;
51633e9753d6SMatthew G. Knepley     PetscInt         maxDegree;
51643e9753d6SMatthew G. Knepley     PetscQuadrature  qGeom = NULL;
51653e9753d6SMatthew G. Knepley     IS               pointIS;
51663e9753d6SMatthew G. Knepley     const PetscInt  *points;
516706ad1575SMatthew G. Knepley     PetscFormKey key;
51683e9753d6SMatthew G. Knepley     PetscInt         numFaces, face, Nq;
51693e9753d6SMatthew G. Knepley 
517045480ffeSMatthew G. Knepley     key.label = label;
517145480ffeSMatthew G. Knepley     key.value = values[v];
517206ad1575SMatthew G. Knepley     key.part  = 0;
5173*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMLabelGetStratumIS(label, values[v], &pointIS));
51743e9753d6SMatthew G. Knepley     if (!pointIS) continue; /* No points with that id on this process */
51753e9753d6SMatthew G. Knepley     {
51763e9753d6SMatthew G. Knepley       IS isectIS;
51773e9753d6SMatthew G. Knepley 
51783e9753d6SMatthew G. Knepley       /* TODO: Special cases of ISIntersect where it is quick to check a prior if one is a superset of the other */
5179*5f80ce2aSJacob Faibussowitsch       CHKERRQ(ISIntersect_Caching_Internal(facetIS,pointIS,&isectIS));
5180*5f80ce2aSJacob Faibussowitsch       CHKERRQ(ISDestroy(&pointIS));
51813e9753d6SMatthew G. Knepley       pointIS = isectIS;
51823e9753d6SMatthew G. Knepley     }
5183*5f80ce2aSJacob Faibussowitsch     CHKERRQ(ISGetLocalSize(pointIS, &numFaces));
5184*5f80ce2aSJacob Faibussowitsch     CHKERRQ(ISGetIndices(pointIS, &points));
5185*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscMalloc4(numFaces*totDim, &u, locX_t ? numFaces*totDim : 0, &u_t, numFaces*totDim*totDim, &elemMat, locA ? numFaces*totDimAux : 0, &a));
5186*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMFieldGetDegree(coordField,pointIS,NULL,&maxDegree));
51873e9753d6SMatthew G. Knepley     if (maxDegree <= 1) {
5188*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMFieldCreateDefaultQuadrature(coordField,pointIS,&qGeom));
51893e9753d6SMatthew G. Knepley     }
51903e9753d6SMatthew G. Knepley     if (!qGeom) {
51913e9753d6SMatthew G. Knepley       PetscFE fe;
51923e9753d6SMatthew G. Knepley 
5193*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetDiscretization(prob, fieldI, (PetscObject *) &fe));
5194*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetFaceQuadrature(fe, &qGeom));
5195*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscObjectReference((PetscObject)qGeom));
51963e9753d6SMatthew G. Knepley     }
5197*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscQuadratureGetData(qGeom, NULL, NULL, &Nq, NULL, NULL));
5198*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMSNESGetFEGeom(coordField,pointIS,qGeom,PETSC_TRUE,&fgeom));
51993e9753d6SMatthew G. Knepley     for (face = 0; face < numFaces; ++face) {
5200f15274beSMatthew Knepley       const PetscInt point = points[face], *support;
52013e9753d6SMatthew G. Knepley       PetscScalar   *x     = NULL;
5202f15274beSMatthew Knepley       PetscInt       i;
52033e9753d6SMatthew G. Knepley 
5204*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetSupport(dm, point, &support));
5205*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecGetClosure(plex, section, locX, support[0], NULL, &x));
52063e9753d6SMatthew G. Knepley       for (i = 0; i < totDim; ++i) u[face*totDim+i] = x[i];
5207*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecRestoreClosure(plex, section, locX, support[0], NULL, &x));
52083e9753d6SMatthew G. Knepley       if (locX_t) {
5209*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecGetClosure(plex, section, locX_t, support[0], NULL, &x));
52103e9753d6SMatthew G. Knepley         for (i = 0; i < totDim; ++i) u_t[face*totDim+i] = x[i];
5211*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecRestoreClosure(plex, section, locX_t, support[0], NULL, &x));
52123e9753d6SMatthew G. Knepley       }
52133e9753d6SMatthew G. Knepley       if (locA) {
52143e9753d6SMatthew G. Knepley         PetscInt subp;
5215*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMGetEnclosurePoint(plexA, dm, encAux, support[0], &subp));
5216*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecGetClosure(plexA, sectionAux, locA, subp, NULL, &x));
52173e9753d6SMatthew G. Knepley         for (i = 0; i < totDimAux; ++i) a[face*totDimAux+i] = x[i];
5218*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecRestoreClosure(plexA, sectionAux, locA, subp, NULL, &x));
52193e9753d6SMatthew G. Knepley       }
52203e9753d6SMatthew G. Knepley     }
5221*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscArrayzero(elemMat, numFaces*totDim*totDim));
52223e9753d6SMatthew G. Knepley     {
52233e9753d6SMatthew G. Knepley       PetscFE         fe;
52243e9753d6SMatthew G. Knepley       PetscInt        Nb;
52253e9753d6SMatthew G. Knepley       /* Conforming batches */
52263e9753d6SMatthew G. Knepley       PetscInt        numChunks, numBatches, numBlocks, Ne, blockSize, batchSize;
52273e9753d6SMatthew G. Knepley       /* Remainder */
52283e9753d6SMatthew G. Knepley       PetscFEGeom    *chunkGeom = NULL;
52293e9753d6SMatthew G. Knepley       PetscInt        fieldJ, Nr, offset;
52303e9753d6SMatthew G. Knepley 
5231*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetDiscretization(prob, fieldI, (PetscObject *) &fe));
5232*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetDimension(fe, &Nb));
5233*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
52343e9753d6SMatthew G. Knepley       blockSize = Nb;
52353e9753d6SMatthew G. Knepley       batchSize = numBlocks * blockSize;
5236*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
52373e9753d6SMatthew G. Knepley       numChunks = numFaces / (numBatches*batchSize);
52383e9753d6SMatthew G. Knepley       Ne        = numChunks*numBatches*batchSize;
52393e9753d6SMatthew G. Knepley       Nr        = numFaces % (numBatches*batchSize);
52403e9753d6SMatthew G. Knepley       offset    = numFaces - Nr;
5241*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomGetChunk(fgeom,0,offset,&chunkGeom));
52423e9753d6SMatthew G. Knepley       for (fieldJ = 0; fieldJ < Nf; ++fieldJ) {
524345480ffeSMatthew G. Knepley         key.field = fieldI*Nf+fieldJ;
5244*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEIntegrateBdJacobian(prob, wf, key, Ne, chunkGeom, u, u_t, probAux, a, t, X_tShift, elemMat));
52453e9753d6SMatthew G. Knepley       }
5246*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomGetChunk(fgeom,offset,numFaces,&chunkGeom));
52473e9753d6SMatthew G. Knepley       for (fieldJ = 0; fieldJ < Nf; ++fieldJ) {
524845480ffeSMatthew G. Knepley         key.field = fieldI*Nf+fieldJ;
5249*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEIntegrateBdJacobian(prob, wf, key, Nr, chunkGeom, &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, probAux, a ? &a[offset*totDimAux] : NULL, t, X_tShift, &elemMat[offset*totDim*totDim]));
52503e9753d6SMatthew G. Knepley       }
5251*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomRestoreChunk(fgeom,offset,numFaces,&chunkGeom));
52523e9753d6SMatthew G. Knepley     }
52533e9753d6SMatthew G. Knepley     for (face = 0; face < numFaces; ++face) {
52543e9753d6SMatthew G. Knepley       const PetscInt point = points[face], *support;
52553e9753d6SMatthew G. Knepley 
52563e9753d6SMatthew G. Knepley       /* Transform to global basis before insertion in Jacobian */
5257*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetSupport(plex, point, &support));
5258*5f80ce2aSJacob Faibussowitsch       if (transform) CHKERRQ(DMPlexBasisTransformPointTensor_Internal(dm, tdm, tv, support[0], PETSC_TRUE, totDim, &elemMat[face*totDim*totDim]));
5259*5f80ce2aSJacob Faibussowitsch       if (mesh->printFEM > 1) CHKERRQ(DMPrintCellMatrix(point, "BdJacobian", totDim, totDim, &elemMat[face*totDim*totDim]));
5260*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexMatSetClosure(plex, section, globalSection, JacP, support[0], &elemMat[face*totDim*totDim], ADD_VALUES));
52613e9753d6SMatthew G. Knepley     }
5262*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMSNESRestoreFEGeom(coordField,pointIS,qGeom,PETSC_TRUE,&fgeom));
5263*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscQuadratureDestroy(&qGeom));
5264*5f80ce2aSJacob Faibussowitsch     CHKERRQ(ISRestoreIndices(pointIS, &points));
5265*5f80ce2aSJacob Faibussowitsch     CHKERRQ(ISDestroy(&pointIS));
5266*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFree4(u, u_t, elemMat, a));
52673e9753d6SMatthew G. Knepley   }
5268*5f80ce2aSJacob Faibussowitsch   if (plex)  CHKERRQ(DMDestroy(&plex));
5269*5f80ce2aSJacob Faibussowitsch   if (plexA) CHKERRQ(DMDestroy(&plexA));
52703e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
52713e9753d6SMatthew G. Knepley }
52723e9753d6SMatthew G. Knepley 
527345480ffeSMatthew G. Knepley PetscErrorCode DMPlexComputeBdJacobianSingle(DM dm, PetscReal t, PetscWeakForm wf, DMLabel label, PetscInt numValues, const PetscInt values[], PetscInt field, Vec locX, Vec locX_t, PetscReal X_tShift, Mat Jac, Mat JacP)
52743e9753d6SMatthew G. Knepley {
52753e9753d6SMatthew G. Knepley   DMField        coordField;
52763e9753d6SMatthew G. Knepley   DMLabel        depthLabel;
52773e9753d6SMatthew G. Knepley   IS             facetIS;
52783e9753d6SMatthew G. Knepley   PetscInt       dim;
52793e9753d6SMatthew G. Knepley 
52803e9753d6SMatthew G. Knepley   PetscFunctionBegin;
5281*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dm, &dim));
5282*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetDepthLabel(dm, &depthLabel));
5283*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMLabelGetStratumIS(depthLabel, dim-1, &facetIS));
5284*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateField(dm, &coordField));
5285*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexComputeBdJacobian_Single_Internal(dm, t, wf, label, numValues, values, field, locX, locX_t, X_tShift, Jac, JacP, coordField, facetIS));
5286*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISDestroy(&facetIS));
52873e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
52883e9753d6SMatthew G. Knepley }
52893e9753d6SMatthew G. Knepley 
52903e9753d6SMatthew G. Knepley PetscErrorCode DMPlexComputeBdJacobian_Internal(DM dm, Vec locX, Vec locX_t, PetscReal t, PetscReal X_tShift, Mat Jac, Mat JacP, void *user)
52913e9753d6SMatthew G. Knepley {
52923e9753d6SMatthew G. Knepley   PetscDS          prob;
52933e9753d6SMatthew G. Knepley   PetscInt         dim, numBd, bd;
52943e9753d6SMatthew G. Knepley   DMLabel          depthLabel;
52953e9753d6SMatthew G. Knepley   DMField          coordField = NULL;
52963e9753d6SMatthew G. Knepley   IS               facetIS;
52973e9753d6SMatthew G. Knepley 
52983e9753d6SMatthew G. Knepley   PetscFunctionBegin;
5299*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDS(dm, &prob));
5300*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetDepthLabel(dm, &depthLabel));
5301*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dm, &dim));
5302*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMLabelGetStratumIS(depthLabel, dim-1, &facetIS));
5303*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetNumBoundary(prob, &numBd));
5304*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateField(dm, &coordField));
53053e9753d6SMatthew G. Knepley   for (bd = 0; bd < numBd; ++bd) {
530645480ffeSMatthew G. Knepley     PetscWeakForm           wf;
53073e9753d6SMatthew G. Knepley     DMBoundaryConditionType type;
53083e9753d6SMatthew G. Knepley     DMLabel                 label;
53093e9753d6SMatthew G. Knepley     const PetscInt         *values;
53103e9753d6SMatthew G. Knepley     PetscInt                fieldI, numValues;
53113e9753d6SMatthew G. Knepley     PetscObject             obj;
53123e9753d6SMatthew G. Knepley     PetscClassId            id;
53133e9753d6SMatthew G. Knepley 
5314*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetBoundary(prob, bd, &wf, &type, NULL, &label, &numValues, &values, &fieldI, NULL, NULL, NULL, NULL, NULL));
5315*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, fieldI, &obj));
5316*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
53173e9753d6SMatthew G. Knepley     if ((id != PETSCFE_CLASSID) || (type & DM_BC_ESSENTIAL)) continue;
5318*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexComputeBdJacobian_Single_Internal(dm, t, wf, label, numValues, values, fieldI, locX, locX_t, X_tShift, Jac, JacP, coordField, facetIS));
53193e9753d6SMatthew G. Knepley   }
5320*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISDestroy(&facetIS));
53213e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
53223e9753d6SMatthew G. Knepley }
53233e9753d6SMatthew G. Knepley 
532406ad1575SMatthew G. Knepley PetscErrorCode DMPlexComputeJacobian_Internal(DM dm, PetscFormKey key, IS cellIS, PetscReal t, PetscReal X_tShift, Vec X, Vec X_t, Mat Jac, Mat JacP,void *user)
53253e9753d6SMatthew G. Knepley {
53263e9753d6SMatthew G. Knepley   DM_Plex        *mesh  = (DM_Plex *) dm->data;
53273e9753d6SMatthew G. Knepley   const char     *name  = "Jacobian";
53289a2a23afSMatthew G. Knepley   DM              dmAux = NULL, plex, tdm;
53293e9753d6SMatthew G. Knepley   DMEnclosureType encAux;
53303e9753d6SMatthew G. Knepley   Vec             A, tv;
53313e9753d6SMatthew G. Knepley   DMField         coordField;
53323e9753d6SMatthew G. Knepley   PetscDS         prob, probAux = NULL;
5333e432b41dSStefano Zampini   PetscSection    section, globalSection, sectionAux;
53343e9753d6SMatthew G. Knepley   PetscScalar    *elemMat, *elemMatP, *elemMatD, *u, *u_t, *a = NULL;
53353e9753d6SMatthew G. Knepley   const PetscInt *cells;
53363e9753d6SMatthew G. Knepley   PetscInt        Nf, fieldI, fieldJ;
53373e9753d6SMatthew G. Knepley   PetscInt        totDim, totDimAux, cStart, cEnd, numCells, c;
5338e432b41dSStefano Zampini   PetscBool       hasJac, hasPrec, hasDyn, hasFV = PETSC_FALSE, transform;
53393e9753d6SMatthew G. Knepley 
53403e9753d6SMatthew G. Knepley   PetscFunctionBegin;
5341*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventBegin(DMPLEX_JacobianFEM,dm,0,0,0));
5342*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISGetLocalSize(cellIS, &numCells));
5343*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
5344*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMHasBasisTransform(dm, &transform));
5345*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetBasisTransformDM_Internal(dm, &tdm));
5346*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetBasisTransformVec_Internal(dm, &tv));
5347*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &section));
5348*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetGlobalSection(dm, &globalSection));
5349*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCellDS(dm, cells ? cells[cStart] : cStart, &prob));
5350*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetNumFields(prob, &Nf));
5351*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetTotalDimension(prob, &totDim));
5352*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSHasJacobian(prob, &hasJac));
5353*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSHasJacobianPreconditioner(prob, &hasPrec));
53543e9753d6SMatthew G. Knepley   /* user passed in the same matrix, avoid double contributions and
53553e9753d6SMatthew G. Knepley      only assemble the Jacobian */
53563e9753d6SMatthew G. Knepley   if (hasJac && Jac == JacP) hasPrec = PETSC_FALSE;
5357*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSHasDynamicJacobian(prob, &hasDyn));
53583e9753d6SMatthew G. Knepley   hasDyn = hasDyn && (X_tShift != 0.0) ? PETSC_TRUE : PETSC_FALSE;
5359*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetAuxiliaryVec(dm, key.label, key.value, key.part, &A));
53609a2a23afSMatthew G. Knepley   if (A) {
5361*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetDM(A, &dmAux));
5362*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetEnclosureRelation(dmAux, dm, &encAux));
5363*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMConvert(dmAux, DMPLEX, &plex));
5364*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetLocalSection(plex, &sectionAux));
5365*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetDS(dmAux, &probAux));
5366*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetTotalDimension(probAux, &totDimAux));
53673e9753d6SMatthew G. Knepley   }
5368*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc5(numCells*totDim,&u,X_t ? numCells*totDim : 0,&u_t,hasJac ? numCells*totDim*totDim : 0,&elemMat,hasPrec ? numCells*totDim*totDim : 0, &elemMatP,hasDyn ? numCells*totDim*totDim : 0, &elemMatD));
5369*5f80ce2aSJacob Faibussowitsch   if (dmAux) CHKERRQ(PetscMalloc1(numCells*totDimAux, &a));
5370*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateField(dm, &coordField));
53713e9753d6SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
53723e9753d6SMatthew G. Knepley     const PetscInt cell = cells ? cells[c] : c;
53733e9753d6SMatthew G. Knepley     const PetscInt cind = c - cStart;
53743e9753d6SMatthew G. Knepley     PetscScalar   *x = NULL,  *x_t = NULL;
53753e9753d6SMatthew G. Knepley     PetscInt       i;
53763e9753d6SMatthew G. Knepley 
5377*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecGetClosure(dm, section, X, cell, NULL, &x));
53783e9753d6SMatthew G. Knepley     for (i = 0; i < totDim; ++i) u[cind*totDim+i] = x[i];
5379*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecRestoreClosure(dm, section, X, cell, NULL, &x));
53803e9753d6SMatthew G. Knepley     if (X_t) {
5381*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecGetClosure(dm, section, X_t, cell, NULL, &x_t));
53823e9753d6SMatthew G. Knepley       for (i = 0; i < totDim; ++i) u_t[cind*totDim+i] = x_t[i];
5383*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecRestoreClosure(dm, section, X_t, cell, NULL, &x_t));
53843e9753d6SMatthew G. Knepley     }
53853e9753d6SMatthew G. Knepley     if (dmAux) {
53863e9753d6SMatthew G. Knepley       PetscInt subcell;
5387*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMGetEnclosurePoint(dmAux, dm, encAux, cell, &subcell));
5388*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecGetClosure(plex, sectionAux, A, subcell, NULL, &x));
53893e9753d6SMatthew G. Knepley       for (i = 0; i < totDimAux; ++i) a[cind*totDimAux+i] = x[i];
5390*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecRestoreClosure(plex, sectionAux, A, subcell, NULL, &x));
53913e9753d6SMatthew G. Knepley     }
53923e9753d6SMatthew G. Knepley   }
5393*5f80ce2aSJacob Faibussowitsch   if (hasJac)  CHKERRQ(PetscArrayzero(elemMat,  numCells*totDim*totDim));
5394*5f80ce2aSJacob Faibussowitsch   if (hasPrec) CHKERRQ(PetscArrayzero(elemMatP, numCells*totDim*totDim));
5395*5f80ce2aSJacob Faibussowitsch   if (hasDyn)  CHKERRQ(PetscArrayzero(elemMatD, numCells*totDim*totDim));
53963e9753d6SMatthew G. Knepley   for (fieldI = 0; fieldI < Nf; ++fieldI) {
53973e9753d6SMatthew G. Knepley     PetscClassId    id;
53983e9753d6SMatthew G. Knepley     PetscFE         fe;
53993e9753d6SMatthew G. Knepley     PetscQuadrature qGeom = NULL;
54003e9753d6SMatthew G. Knepley     PetscInt        Nb;
54013e9753d6SMatthew G. Knepley     /* Conforming batches */
54023e9753d6SMatthew G. Knepley     PetscInt        numChunks, numBatches, numBlocks, Ne, blockSize, batchSize;
54033e9753d6SMatthew G. Knepley     /* Remainder */
54043e9753d6SMatthew G. Knepley     PetscInt        Nr, offset, Nq;
54053e9753d6SMatthew G. Knepley     PetscInt        maxDegree;
54063e9753d6SMatthew G. Knepley     PetscFEGeom     *cgeomFEM, *chunkGeom = NULL, *remGeom = NULL;
54073e9753d6SMatthew G. Knepley 
5408*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, fieldI, (PetscObject *) &fe));
5409*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId((PetscObject) fe, &id));
54103e9753d6SMatthew G. Knepley     if (id == PETSCFV_CLASSID) {hasFV = PETSC_TRUE; continue;}
5411*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGetDimension(fe, &Nb));
5412*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
5413*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMFieldGetDegree(coordField,cellIS,NULL,&maxDegree));
54143e9753d6SMatthew G. Knepley     if (maxDegree <= 1) {
5415*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMFieldCreateDefaultQuadrature(coordField,cellIS,&qGeom));
54163e9753d6SMatthew G. Knepley     }
54173e9753d6SMatthew G. Knepley     if (!qGeom) {
5418*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetQuadrature(fe,&qGeom));
5419*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscObjectReference((PetscObject)qGeom));
54203e9753d6SMatthew G. Knepley     }
5421*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscQuadratureGetData(qGeom, NULL, NULL, &Nq, NULL, NULL));
5422*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMSNESGetFEGeom(coordField,cellIS,qGeom,PETSC_FALSE,&cgeomFEM));
54233e9753d6SMatthew G. Knepley     blockSize = Nb;
54243e9753d6SMatthew G. Knepley     batchSize = numBlocks * blockSize;
5425*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
54263e9753d6SMatthew G. Knepley     numChunks = numCells / (numBatches*batchSize);
54273e9753d6SMatthew G. Knepley     Ne        = numChunks*numBatches*batchSize;
54283e9753d6SMatthew G. Knepley     Nr        = numCells % (numBatches*batchSize);
54293e9753d6SMatthew G. Knepley     offset    = numCells - Nr;
5430*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGeomGetChunk(cgeomFEM,0,offset,&chunkGeom));
5431*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGeomGetChunk(cgeomFEM,offset,numCells,&remGeom));
54323e9753d6SMatthew G. Knepley     for (fieldJ = 0; fieldJ < Nf; ++fieldJ) {
54336528b96dSMatthew G. Knepley       key.field = fieldI*Nf+fieldJ;
54343e9753d6SMatthew G. Knepley       if (hasJac) {
5435*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN, key, Ne, chunkGeom, u, u_t, probAux, a, t, X_tShift, elemMat));
5436*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN, key, Nr, remGeom, &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, probAux, &a[offset*totDimAux], t, X_tShift, &elemMat[offset*totDim*totDim]));
54373e9753d6SMatthew G. Knepley       }
54383e9753d6SMatthew G. Knepley       if (hasPrec) {
5439*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN_PRE, key, Ne, chunkGeom, u, u_t, probAux, a, t, X_tShift, elemMatP));
5440*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN_PRE, key, Nr, remGeom, &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, probAux, &a[offset*totDimAux], t, X_tShift, &elemMatP[offset*totDim*totDim]));
54413e9753d6SMatthew G. Knepley       }
54423e9753d6SMatthew G. Knepley       if (hasDyn) {
5443*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN_DYN, key, Ne, chunkGeom, u, u_t, probAux, a, t, X_tShift, elemMatD));
5444*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN_DYN, key, Nr, remGeom, &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, probAux, &a[offset*totDimAux], t, X_tShift, &elemMatD[offset*totDim*totDim]));
54453e9753d6SMatthew G. Knepley       }
54463e9753d6SMatthew G. Knepley     }
5447*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGeomRestoreChunk(cgeomFEM,offset,numCells,&remGeom));
5448*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGeomRestoreChunk(cgeomFEM,0,offset,&chunkGeom));
5449*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMSNESRestoreFEGeom(coordField,cellIS,qGeom,PETSC_FALSE,&cgeomFEM));
5450*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscQuadratureDestroy(&qGeom));
54513e9753d6SMatthew G. Knepley   }
54523e9753d6SMatthew G. Knepley   /*   Add contribution from X_t */
54533e9753d6SMatthew G. Knepley   if (hasDyn) {for (c = 0; c < numCells*totDim*totDim; ++c) elemMat[c] += X_tShift*elemMatD[c];}
54543e9753d6SMatthew G. Knepley   if (hasFV) {
54553e9753d6SMatthew G. Knepley     PetscClassId id;
54563e9753d6SMatthew G. Knepley     PetscFV      fv;
54573e9753d6SMatthew G. Knepley     PetscInt     offsetI, NcI, NbI = 1, fc, f;
54583e9753d6SMatthew G. Knepley 
54593e9753d6SMatthew G. Knepley     for (fieldI = 0; fieldI < Nf; ++fieldI) {
5460*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetDiscretization(prob, fieldI, (PetscObject *) &fv));
5461*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetFieldOffset(prob, fieldI, &offsetI));
5462*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscObjectGetClassId((PetscObject) fv, &id));
54633e9753d6SMatthew G. Knepley       if (id != PETSCFV_CLASSID) continue;
54643e9753d6SMatthew G. Knepley       /* Put in the identity */
5465*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetNumComponents(fv, &NcI));
54663e9753d6SMatthew G. Knepley       for (c = cStart; c < cEnd; ++c) {
54673e9753d6SMatthew G. Knepley         const PetscInt cind    = c - cStart;
54683e9753d6SMatthew G. Knepley         const PetscInt eOffset = cind*totDim*totDim;
54693e9753d6SMatthew G. Knepley         for (fc = 0; fc < NcI; ++fc) {
54703e9753d6SMatthew G. Knepley           for (f = 0; f < NbI; ++f) {
54713e9753d6SMatthew G. Knepley             const PetscInt i = offsetI + f*NcI+fc;
54723e9753d6SMatthew G. Knepley             if (hasPrec) {
54733e9753d6SMatthew G. Knepley               if (hasJac) {elemMat[eOffset+i*totDim+i] = 1.0;}
54743e9753d6SMatthew G. Knepley               elemMatP[eOffset+i*totDim+i] = 1.0;
54753e9753d6SMatthew G. Knepley             } else {elemMat[eOffset+i*totDim+i] = 1.0;}
54763e9753d6SMatthew G. Knepley           }
54773e9753d6SMatthew G. Knepley         }
54783e9753d6SMatthew G. Knepley       }
54793e9753d6SMatthew G. Knepley     }
54803e9753d6SMatthew G. Knepley     /* No allocated space for FV stuff, so ignore the zero entries */
5481*5f80ce2aSJacob Faibussowitsch     CHKERRQ(MatSetOption(JacP, MAT_IGNORE_ZERO_ENTRIES, PETSC_TRUE));
54823e9753d6SMatthew G. Knepley   }
54833e9753d6SMatthew G. Knepley   /* Insert values into matrix */
54843e9753d6SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
54853e9753d6SMatthew G. Knepley     const PetscInt cell = cells ? cells[c] : c;
54863e9753d6SMatthew G. Knepley     const PetscInt cind = c - cStart;
54873e9753d6SMatthew G. Knepley 
54883e9753d6SMatthew G. Knepley     /* Transform to global basis before insertion in Jacobian */
5489*5f80ce2aSJacob Faibussowitsch     if (transform) CHKERRQ(DMPlexBasisTransformPointTensor_Internal(dm, tdm, tv, cell, PETSC_TRUE, totDim, &elemMat[cind*totDim*totDim]));
54903e9753d6SMatthew G. Knepley     if (hasPrec) {
54913e9753d6SMatthew G. Knepley       if (hasJac) {
5492*5f80ce2aSJacob Faibussowitsch         if (mesh->printFEM > 1) CHKERRQ(DMPrintCellMatrix(cell, name, totDim, totDim, &elemMat[cind*totDim*totDim]));
5493*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexMatSetClosure(dm, section, globalSection, Jac, cell, &elemMat[cind*totDim*totDim], ADD_VALUES));
54943e9753d6SMatthew G. Knepley       }
5495*5f80ce2aSJacob Faibussowitsch       if (mesh->printFEM > 1) CHKERRQ(DMPrintCellMatrix(cell, name, totDim, totDim, &elemMatP[cind*totDim*totDim]));
5496*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexMatSetClosure(dm, section, globalSection, JacP, cell, &elemMatP[cind*totDim*totDim], ADD_VALUES));
54973e9753d6SMatthew G. Knepley     } else {
54983e9753d6SMatthew G. Knepley       if (hasJac) {
5499*5f80ce2aSJacob Faibussowitsch         if (mesh->printFEM > 1) CHKERRQ(DMPrintCellMatrix(cell, name, totDim, totDim, &elemMat[cind*totDim*totDim]));
5500*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexMatSetClosure(dm, section, globalSection, JacP, cell, &elemMat[cind*totDim*totDim], ADD_VALUES));
55013e9753d6SMatthew G. Knepley       }
55023e9753d6SMatthew G. Knepley     }
55033e9753d6SMatthew G. Knepley   }
5504*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
5505*5f80ce2aSJacob Faibussowitsch   if (hasFV) CHKERRQ(MatSetOption(JacP, MAT_IGNORE_ZERO_ENTRIES, PETSC_FALSE));
5506*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree5(u,u_t,elemMat,elemMatP,elemMatD));
55073e9753d6SMatthew G. Knepley   if (dmAux) {
5508*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFree(a));
5509*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMDestroy(&plex));
55103e9753d6SMatthew G. Knepley   }
55113e9753d6SMatthew G. Knepley   /* Compute boundary integrals */
5512*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexComputeBdJacobian_Internal(dm, X, X_t, t, X_tShift, Jac, JacP, user));
55133e9753d6SMatthew G. Knepley   /* Assemble matrix */
55143e9753d6SMatthew G. Knepley   if (hasJac && hasPrec) {
5515*5f80ce2aSJacob Faibussowitsch     CHKERRQ(MatAssemblyBegin(Jac, MAT_FINAL_ASSEMBLY));
5516*5f80ce2aSJacob Faibussowitsch     CHKERRQ(MatAssemblyEnd(Jac, MAT_FINAL_ASSEMBLY));
55173e9753d6SMatthew G. Knepley   }
5518*5f80ce2aSJacob Faibussowitsch   CHKERRQ(MatAssemblyBegin(JacP, MAT_FINAL_ASSEMBLY));
5519*5f80ce2aSJacob Faibussowitsch   CHKERRQ(MatAssemblyEnd(JacP, MAT_FINAL_ASSEMBLY));
5520*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventEnd(DMPLEX_JacobianFEM,dm,0,0,0));
55213e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
55223e9753d6SMatthew G. Knepley }
55233e9753d6SMatthew G. Knepley 
552406ad1575SMatthew G. Knepley PetscErrorCode DMPlexComputeJacobian_Hybrid_Internal(DM dm, PetscFormKey key[], IS cellIS, PetscReal t, PetscReal X_tShift, Vec locX, Vec locX_t, Mat Jac, Mat JacP, void *user)
55253e9753d6SMatthew G. Knepley {
55263e9753d6SMatthew G. Knepley   DM_Plex         *mesh          = (DM_Plex *) dm->data;
55273e9753d6SMatthew G. Knepley   const char      *name          = "Hybrid Jacobian";
5528148442b3SMatthew G. Knepley   DM               dmAux[3]      = {NULL, NULL, NULL};
5529148442b3SMatthew G. Knepley   DMLabel          ghostLabel    = NULL;
55303e9753d6SMatthew G. Knepley   DM               plex          = NULL;
55313e9753d6SMatthew G. Knepley   DM               plexA         = NULL;
5532148442b3SMatthew G. Knepley   PetscDS          ds            = NULL;
5533148442b3SMatthew G. Knepley   PetscDS          dsAux[3]      = {NULL, NULL, NULL};
5534148442b3SMatthew G. Knepley   Vec              locA[3]       = {NULL, NULL, NULL};
55353e9753d6SMatthew G. Knepley   PetscSection     section       = NULL;
5536148442b3SMatthew G. Knepley   PetscSection     sectionAux[3] = {NULL, NULL, NULL};
55373e9753d6SMatthew G. Knepley   DMField          coordField    = NULL;
5538148442b3SMatthew G. Knepley   PetscScalar     *u = NULL, *u_t, *a[3];
55393e9753d6SMatthew G. Knepley   PetscScalar     *elemMat, *elemMatP;
5540e432b41dSStefano Zampini   PetscSection     globalSection;
55413e9753d6SMatthew G. Knepley   IS               chunkIS;
55423e9753d6SMatthew G. Knepley   const PetscInt  *cells;
55433e9753d6SMatthew G. Knepley   PetscInt        *faces;
55443e9753d6SMatthew G. Knepley   PetscInt         cStart, cEnd, numCells;
5545148442b3SMatthew G. Knepley   PetscInt         Nf, fieldI, fieldJ, totDim, totDimAux[3], numChunks, cellChunkSize, chunk;
55463e9753d6SMatthew G. Knepley   PetscInt         maxDegree = PETSC_MAX_INT;
55473e9753d6SMatthew G. Knepley   PetscQuadrature  affineQuad = NULL, *quads = NULL;
55483e9753d6SMatthew G. Knepley   PetscFEGeom     *affineGeom = NULL, **geoms = NULL;
5549e432b41dSStefano Zampini   PetscBool        hasBdJac, hasBdPrec;
55503e9753d6SMatthew G. Knepley 
55513e9753d6SMatthew G. Knepley   PetscFunctionBegin;
55525fedec97SMatthew G. Knepley   if ((key[0].label == key[1].label) && (key[0].value == key[1].value) && (key[0].part == key[1].part)) {
55535fedec97SMatthew G. Knepley     const char *name;
5554*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetName((PetscObject) key[0].label, &name));
555598921bdaSJacob Faibussowitsch     SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Form keys for each side of a cohesive surface must be different (%s, %D, %D)", name, key[0].value, key[0].part);
55565fedec97SMatthew G. Knepley   }
5557*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventBegin(DMPLEX_JacobianFEM,dm,0,0,0));
5558*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISGetLocalSize(cellIS, &numCells));
5559*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
5560*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMConvert(dm, DMPLEX, &plex));
5561*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetSection(dm, &section));
5562*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetGlobalSection(dm, &globalSection));
5563*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLabel(dm, "ghost", &ghostLabel));
5564*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCellDS(dm, cStart, &ds));
5565*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetNumFields(ds, &Nf));
5566*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetTotalDimension(ds, &totDim));
5567*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSHasBdJacobian(ds, &hasBdJac));
5568*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSHasBdJacobianPreconditioner(ds, &hasBdPrec));
5569*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetAuxiliaryVec(dm, key[2].label, key[2].value, key[2].part, &locA[2]));
5570148442b3SMatthew G. Knepley   if (locA[2]) {
5571*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetDM(locA[2], &dmAux[2]));
5572*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMConvert(dmAux[2], DMPLEX, &plexA));
5573*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetSection(dmAux[2], &sectionAux[2]));
5574*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetCellDS(dmAux[2], cStart, &dsAux[2]));
5575*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetTotalDimension(dsAux[2], &totDimAux[2]));
5576148442b3SMatthew G. Knepley     {
5577148442b3SMatthew G. Knepley       const PetscInt *cone;
5578148442b3SMatthew G. Knepley       PetscInt        c;
5579148442b3SMatthew G. Knepley 
5580*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetCone(dm, cStart, &cone));
5581148442b3SMatthew G. Knepley       for (c = 0; c < 2; ++c) {
5582148442b3SMatthew G. Knepley         const PetscInt *support;
5583148442b3SMatthew G. Knepley         PetscInt ssize, s;
5584148442b3SMatthew G. Knepley 
5585*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexGetSupport(dm, cone[c], &support));
5586*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexGetSupportSize(dm, cone[c], &ssize));
5587*5f80ce2aSJacob Faibussowitsch         PetscCheck(ssize == 2,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Face %D from cell %D has support size %D != 2", cone[c], cStart, ssize);
5588148442b3SMatthew G. Knepley         if      (support[0] == cStart) s = 1;
5589148442b3SMatthew G. Knepley         else if (support[1] == cStart) s = 0;
559098921bdaSJacob Faibussowitsch         else SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Face %D does not have cell %D in its support", cone[c], cStart);
5591*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMGetAuxiliaryVec(dm, key[c].label, key[c].value, key[c].part, &locA[c]));
5592*5f80ce2aSJacob Faibussowitsch         if (locA[c]) CHKERRQ(VecGetDM(locA[c], &dmAux[c]));
5593148442b3SMatthew G. Knepley         else         {dmAux[c] = dmAux[2];}
5594*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMGetCellDS(dmAux[c], support[s], &dsAux[c]));
5595*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDSGetTotalDimension(dsAux[c], &totDimAux[c]));
5596148442b3SMatthew G. Knepley       }
5597148442b3SMatthew G. Knepley     }
55983e9753d6SMatthew G. Knepley   }
5599*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateField(dm, &coordField));
5600*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMFieldGetDegree(coordField, cellIS, NULL, &maxDegree));
56013e9753d6SMatthew G. Knepley   if (maxDegree > 1) {
56023e9753d6SMatthew G. Knepley     PetscInt f;
5603*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscCalloc2(Nf, &quads, Nf, &geoms));
56043e9753d6SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
56053e9753d6SMatthew G. Knepley       PetscFE fe;
56063e9753d6SMatthew G. Knepley 
5607*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetDiscretization(ds, f, (PetscObject *) &fe));
56083e9753d6SMatthew G. Knepley       if (fe) {
5609*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGetQuadrature(fe, &quads[f]));
5610*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscObjectReference((PetscObject) quads[f]));
56113e9753d6SMatthew G. Knepley       }
56123e9753d6SMatthew G. Knepley     }
56133e9753d6SMatthew G. Knepley   }
56143e9753d6SMatthew G. Knepley   cellChunkSize = numCells;
56153e9753d6SMatthew G. Knepley   numChunks     = !numCells ? 0 : PetscCeilReal(((PetscReal) numCells)/cellChunkSize);
5616*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscCalloc1(2*cellChunkSize, &faces));
5617*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISCreateGeneral(PETSC_COMM_SELF, cellChunkSize, faces, PETSC_USE_POINTER, &chunkIS));
5618*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetCellFields(dm, cellIS, locX, locX_t, locA[2], &u, &u_t, &a[2]));
5619*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetHybridAuxFields(dm, dmAux, dsAux, cellIS, locA, a));
5620*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetWorkArray(dm, hasBdJac  ? cellChunkSize*totDim*totDim : 0, MPIU_SCALAR, &elemMat));
5621*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetWorkArray(dm, hasBdPrec ? cellChunkSize*totDim*totDim : 0, MPIU_SCALAR, &elemMatP));
56223e9753d6SMatthew G. Knepley   for (chunk = 0; chunk < numChunks; ++chunk) {
56233e9753d6SMatthew G. Knepley     PetscInt cS = cStart+chunk*cellChunkSize, cE = PetscMin(cS+cellChunkSize, cEnd), numCells = cE - cS, c;
56243e9753d6SMatthew G. Knepley 
5625*5f80ce2aSJacob Faibussowitsch     if (hasBdJac)  CHKERRQ(PetscMemzero(elemMat,  numCells*totDim*totDim * sizeof(PetscScalar)));
5626*5f80ce2aSJacob Faibussowitsch     if (hasBdPrec) CHKERRQ(PetscMemzero(elemMatP, numCells*totDim*totDim * sizeof(PetscScalar)));
56273e9753d6SMatthew G. Knepley     /* Get faces */
56283e9753d6SMatthew G. Knepley     for (c = cS; c < cE; ++c) {
56293e9753d6SMatthew G. Knepley       const PetscInt  cell = cells ? cells[c] : c;
56303e9753d6SMatthew G. Knepley       const PetscInt *cone;
5631*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetCone(plex, cell, &cone));
56323e9753d6SMatthew G. Knepley       faces[(c-cS)*2+0] = cone[0];
56333e9753d6SMatthew G. Knepley       faces[(c-cS)*2+1] = cone[1];
56343e9753d6SMatthew G. Knepley     }
5635*5f80ce2aSJacob Faibussowitsch     CHKERRQ(ISGeneralSetIndices(chunkIS, cellChunkSize, faces, PETSC_USE_POINTER));
56363e9753d6SMatthew G. Knepley     if (maxDegree <= 1) {
5637*5f80ce2aSJacob Faibussowitsch       if (!affineQuad) CHKERRQ(DMFieldCreateDefaultQuadrature(coordField, chunkIS, &affineQuad));
5638*5f80ce2aSJacob Faibussowitsch       if (affineQuad)  CHKERRQ(DMSNESGetFEGeom(coordField, chunkIS, affineQuad, PETSC_TRUE, &affineGeom));
56393e9753d6SMatthew G. Knepley     } else {
56403e9753d6SMatthew G. Knepley       PetscInt f;
56413e9753d6SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
5642*5f80ce2aSJacob Faibussowitsch         if (quads[f]) CHKERRQ(DMSNESGetFEGeom(coordField, chunkIS, quads[f], PETSC_TRUE, &geoms[f]));
56433e9753d6SMatthew G. Knepley       }
56443e9753d6SMatthew G. Knepley     }
56453e9753d6SMatthew G. Knepley 
56463e9753d6SMatthew G. Knepley     for (fieldI = 0; fieldI < Nf; ++fieldI) {
56473e9753d6SMatthew G. Knepley       PetscFE         feI;
56483e9753d6SMatthew G. Knepley       PetscFEGeom    *geom = affineGeom ? affineGeom : geoms[fieldI];
56493e9753d6SMatthew G. Knepley       PetscFEGeom    *chunkGeom = NULL, *remGeom = NULL;
56503e9753d6SMatthew G. Knepley       PetscQuadrature quad = affineQuad ? affineQuad : quads[fieldI];
56513e9753d6SMatthew G. Knepley       PetscInt        numChunks, numBatches, batchSize, numBlocks, blockSize, Ne, Nr, offset, Nq, Nb;
56525fedec97SMatthew G. Knepley       PetscBool       isCohesiveField;
56533e9753d6SMatthew G. Knepley 
5654*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetDiscretization(ds, fieldI, (PetscObject *) &feI));
56553e9753d6SMatthew G. Knepley       if (!feI) continue;
5656*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetTileSizes(feI, NULL, &numBlocks, NULL, &numBatches));
5657*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscQuadratureGetData(quad, NULL, NULL, &Nq, NULL, NULL));
5658*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetDimension(feI, &Nb));
56593e9753d6SMatthew G. Knepley       blockSize = Nb;
56603e9753d6SMatthew G. Knepley       batchSize = numBlocks * blockSize;
5661*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFESetTileSizes(feI, blockSize, numBlocks, batchSize, numBatches));
56623e9753d6SMatthew G. Knepley       numChunks = numCells / (numBatches*batchSize);
56633e9753d6SMatthew G. Knepley       Ne        = numChunks*numBatches*batchSize;
56643e9753d6SMatthew G. Knepley       Nr        = numCells % (numBatches*batchSize);
56653e9753d6SMatthew G. Knepley       offset    = numCells - Nr;
5666*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomGetChunk(geom,0,offset,&chunkGeom));
5667*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomGetChunk(geom,offset,numCells,&remGeom));
5668*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetCohesive(ds, fieldI, &isCohesiveField));
56693e9753d6SMatthew G. Knepley       for (fieldJ = 0; fieldJ < Nf; ++fieldJ) {
56703e9753d6SMatthew G. Knepley         PetscFE feJ;
56713e9753d6SMatthew G. Knepley 
5672*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDSGetDiscretization(ds, fieldJ, (PetscObject *) &feJ));
56733e9753d6SMatthew G. Knepley         if (!feJ) continue;
5674148442b3SMatthew G. Knepley         key[0].field = fieldI*Nf+fieldJ;
5675148442b3SMatthew G. Knepley         key[1].field = fieldI*Nf+fieldJ;
56765fedec97SMatthew G. Knepley         key[2].field = fieldI*Nf+fieldJ;
5677148442b3SMatthew G. Knepley         if (hasBdJac) {
5678*5f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN, key[0], 0, Ne, chunkGeom, u, u_t, dsAux[0], a[0], t, X_tShift, elemMat));
5679*5f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN, key[0], 0, Nr, remGeom, &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, dsAux[0], &a[0][offset*totDimAux[0]], t, X_tShift, &elemMat[offset*totDim*totDim]));
5680*5f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN, key[1], 1, Ne, chunkGeom, u, u_t, dsAux[1], a[1], t, X_tShift, elemMat));
5681*5f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN, key[1], 1, Nr, remGeom, &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, dsAux[1], &a[1][offset*totDimAux[1]], t, X_tShift, &elemMat[offset*totDim*totDim]));
5682148442b3SMatthew G. Knepley         }
5683148442b3SMatthew G. Knepley         if (hasBdPrec) {
5684*5f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN_PRE, key[0], 0, Ne, chunkGeom, u, u_t, dsAux[0], a[0], t, X_tShift, elemMatP));
5685*5f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN_PRE, key[0], 0, Nr, remGeom, &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, dsAux[0], &a[0][offset*totDimAux[0]], t, X_tShift, &elemMatP[offset*totDim*totDim]));
5686*5f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN_PRE, key[1], 1, Ne, chunkGeom, u, u_t, dsAux[1], a[1], t, X_tShift, elemMatP));
5687*5f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN_PRE, key[1], 1, Nr, remGeom, &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, dsAux[1], &a[1][offset*totDimAux[1]], t, X_tShift, &elemMatP[offset*totDim*totDim]));
5688148442b3SMatthew G. Knepley         }
56895fedec97SMatthew G. Knepley         if (hasBdJac) {
5690*5f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN, key[2], 2, Ne, chunkGeom, u, u_t, dsAux[2], a[2], t, X_tShift, elemMat));
5691*5f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN, key[2], 2, Nr, remGeom, &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, dsAux[2], &a[2][offset*totDimAux[2]], t, X_tShift, &elemMat[offset*totDim*totDim]));
5692148442b3SMatthew G. Knepley         }
56935fedec97SMatthew G. Knepley         if (hasBdPrec) {
5694*5f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN_PRE, key[2], 2, Ne, chunkGeom, u, u_t, dsAux[2], a[2], t, X_tShift, elemMatP));
5695*5f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN_PRE, key[2], 2, Nr, remGeom, &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, dsAux[2], &a[2][offset*totDimAux[2]], t, X_tShift, &elemMatP[offset*totDim*totDim]));
56963e9753d6SMatthew G. Knepley         }
56973e9753d6SMatthew G. Knepley       }
5698*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomRestoreChunk(geom,offset,numCells,&remGeom));
5699*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomRestoreChunk(geom,0,offset,&chunkGeom));
57003e9753d6SMatthew G. Knepley     }
57013e9753d6SMatthew G. Knepley     /* Insert values into matrix */
57023e9753d6SMatthew G. Knepley     for (c = cS; c < cE; ++c) {
57033e9753d6SMatthew G. Knepley       const PetscInt cell = cells ? cells[c] : c;
57043e9753d6SMatthew G. Knepley       const PetscInt cind = c - cS;
57053e9753d6SMatthew G. Knepley 
57063e9753d6SMatthew G. Knepley       if (hasBdPrec) {
57073e9753d6SMatthew G. Knepley         if (hasBdJac) {
5708*5f80ce2aSJacob Faibussowitsch           if (mesh->printFEM > 1) CHKERRQ(DMPrintCellMatrix(cell, name, totDim, totDim, &elemMat[cind*totDim*totDim]));
5709*5f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexMatSetClosure(plex, section, globalSection, Jac, cell, &elemMat[cind*totDim*totDim], ADD_VALUES));
57103e9753d6SMatthew G. Knepley         }
5711*5f80ce2aSJacob Faibussowitsch         if (mesh->printFEM > 1) CHKERRQ(DMPrintCellMatrix(cell, name, totDim, totDim, &elemMatP[cind*totDim*totDim]));
5712*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexMatSetClosure(plex, section, globalSection, JacP, cell, &elemMatP[cind*totDim*totDim], ADD_VALUES));
57133e9753d6SMatthew G. Knepley       } else if (hasBdJac) {
5714*5f80ce2aSJacob Faibussowitsch         if (mesh->printFEM > 1) CHKERRQ(DMPrintCellMatrix(cell, name, totDim, totDim, &elemMat[cind*totDim*totDim]));
5715*5f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexMatSetClosure(plex, section, globalSection, JacP, cell, &elemMat[cind*totDim*totDim], ADD_VALUES));
57163e9753d6SMatthew G. Knepley       }
57173e9753d6SMatthew G. Knepley     }
57183e9753d6SMatthew G. Knepley   }
5719*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexRestoreCellFields(dm, cellIS, locX, locX_t, locA[2], &u, &u_t, &a[2]));
5720*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexRestoreHybridAuxFields(dmAux, dsAux, cellIS, locA, a));
5721*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreWorkArray(dm, hasBdJac  ? cellChunkSize*totDim*totDim : 0, MPIU_SCALAR, &elemMat));
5722*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreWorkArray(dm, hasBdPrec ? cellChunkSize*totDim*totDim : 0, MPIU_SCALAR, &elemMatP));
5723*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree(faces));
5724*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISDestroy(&chunkIS));
5725*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
57263e9753d6SMatthew G. Knepley   if (maxDegree <= 1) {
5727*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMSNESRestoreFEGeom(coordField,cellIS,affineQuad,PETSC_FALSE,&affineGeom));
5728*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscQuadratureDestroy(&affineQuad));
57293e9753d6SMatthew G. Knepley   } else {
57303e9753d6SMatthew G. Knepley     PetscInt f;
57313e9753d6SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
5732*5f80ce2aSJacob Faibussowitsch       if (geoms) CHKERRQ(DMSNESRestoreFEGeom(coordField,cellIS,quads[f],PETSC_FALSE, &geoms[f]));
5733*5f80ce2aSJacob Faibussowitsch       if (quads) CHKERRQ(PetscQuadratureDestroy(&quads[f]));
57343e9753d6SMatthew G. Knepley     }
5735*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFree2(quads,geoms));
57363e9753d6SMatthew G. Knepley   }
5737*5f80ce2aSJacob Faibussowitsch   if (dmAux[2]) CHKERRQ(DMDestroy(&plexA));
5738*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMDestroy(&plex));
57393e9753d6SMatthew G. Knepley   /* Assemble matrix */
57403e9753d6SMatthew G. Knepley   if (hasBdJac && hasBdPrec) {
5741*5f80ce2aSJacob Faibussowitsch     CHKERRQ(MatAssemblyBegin(Jac, MAT_FINAL_ASSEMBLY));
5742*5f80ce2aSJacob Faibussowitsch     CHKERRQ(MatAssemblyEnd(Jac, MAT_FINAL_ASSEMBLY));
57433e9753d6SMatthew G. Knepley   }
5744*5f80ce2aSJacob Faibussowitsch   CHKERRQ(MatAssemblyBegin(JacP, MAT_FINAL_ASSEMBLY));
5745*5f80ce2aSJacob Faibussowitsch   CHKERRQ(MatAssemblyEnd(JacP, MAT_FINAL_ASSEMBLY));
5746*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventEnd(DMPLEX_JacobianFEM,dm,0,0,0));
57473e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
57483e9753d6SMatthew G. Knepley }
57498e3a2eefSMatthew G. Knepley 
57508e3a2eefSMatthew G. Knepley /*
57518e3a2eefSMatthew G. Knepley   DMPlexComputeJacobian_Action_Internal - Form the local portion of the Jacobian action Z = J(X) Y at the local solution X using pointwise functions specified by the user.
57528e3a2eefSMatthew G. Knepley 
57538e3a2eefSMatthew G. Knepley   Input Parameters:
57548e3a2eefSMatthew G. Knepley + dm     - The mesh
57558e3a2eefSMatthew G. Knepley . key    - The PetscWeakFormKey indcating where integration should happen
575606ad1575SMatthew G. Knepley . cellIS - The cells to integrate over
57578e3a2eefSMatthew G. Knepley . t      - The time
57588e3a2eefSMatthew G. Knepley . X_tShift - The multiplier for the Jacobian with repsect to X_t
57598e3a2eefSMatthew G. Knepley . X      - Local solution vector
57608e3a2eefSMatthew G. Knepley . X_t    - Time-derivative of the local solution vector
57618e3a2eefSMatthew G. Knepley . Y      - Local input vector
576206ad1575SMatthew G. Knepley - user   - the user context
57638e3a2eefSMatthew G. Knepley 
57648e3a2eefSMatthew G. Knepley   Output Parameter:
57658e3a2eefSMatthew G. Knepley . Z - Local output vector
57668e3a2eefSMatthew G. Knepley 
57678e3a2eefSMatthew G. Knepley   Note:
57688e3a2eefSMatthew G. Knepley   We form the residual one batch of elements at a time. This allows us to offload work onto an accelerator,
57698e3a2eefSMatthew G. Knepley   like a GPU, or vectorize on a multicore machine.
57708e3a2eefSMatthew G. Knepley */
577106ad1575SMatthew G. Knepley PetscErrorCode DMPlexComputeJacobian_Action_Internal(DM dm, PetscFormKey key, IS cellIS, PetscReal t, PetscReal X_tShift, Vec X, Vec X_t, Vec Y, Vec Z, void *user)
57728e3a2eefSMatthew G. Knepley {
57738e3a2eefSMatthew G. Knepley   DM_Plex        *mesh  = (DM_Plex *) dm->data;
57748e3a2eefSMatthew G. Knepley   const char     *name  = "Jacobian";
57758e3a2eefSMatthew G. Knepley   DM              dmAux = NULL, plex, plexAux = NULL;
57768e3a2eefSMatthew G. Knepley   DMEnclosureType encAux;
57778e3a2eefSMatthew G. Knepley   Vec             A;
57788e3a2eefSMatthew G. Knepley   DMField         coordField;
57798e3a2eefSMatthew G. Knepley   PetscDS         prob, probAux = NULL;
57808e3a2eefSMatthew G. Knepley   PetscQuadrature quad;
57818e3a2eefSMatthew G. Knepley   PetscSection    section, globalSection, sectionAux;
57828e3a2eefSMatthew G. Knepley   PetscScalar    *elemMat, *elemMatD, *u, *u_t, *a = NULL, *y, *z;
57838e3a2eefSMatthew G. Knepley   const PetscInt *cells;
57848e3a2eefSMatthew G. Knepley   PetscInt        Nf, fieldI, fieldJ;
57858e3a2eefSMatthew G. Knepley   PetscInt        totDim, totDimAux = 0, cStart, cEnd, numCells, c;
57868e3a2eefSMatthew G. Knepley   PetscBool       hasDyn;
57878e3a2eefSMatthew G. Knepley 
57888e3a2eefSMatthew G. Knepley   PetscFunctionBegin;
5789*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventBegin(DMPLEX_JacobianFEM,dm,0,0,0));
5790*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMConvert(dm, DMPLEX, &plex));
57918e3a2eefSMatthew G. Knepley   if (!cellIS) {
57928e3a2eefSMatthew G. Knepley     PetscInt depth;
57938e3a2eefSMatthew G. Knepley 
5794*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexGetDepth(plex, &depth));
5795*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetStratumIS(plex, "dim", depth, &cellIS));
5796*5f80ce2aSJacob Faibussowitsch     if (!cellIS) CHKERRQ(DMGetStratumIS(plex, "depth", depth, &cellIS));
57978e3a2eefSMatthew G. Knepley   } else {
5798*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectReference((PetscObject) cellIS));
57998e3a2eefSMatthew G. Knepley   }
5800*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISGetLocalSize(cellIS, &numCells));
5801*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
5802*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &section));
5803*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetGlobalSection(dm, &globalSection));
5804*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCellDS(dm, cells ? cells[cStart] : cStart, &prob));
5805*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetNumFields(prob, &Nf));
5806*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetTotalDimension(prob, &totDim));
5807*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSHasDynamicJacobian(prob, &hasDyn));
58088e3a2eefSMatthew G. Knepley   hasDyn = hasDyn && (X_tShift != 0.0) ? PETSC_TRUE : PETSC_FALSE;
5809*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetAuxiliaryVec(dm, key.label, key.value, key.part, &A));
58108e3a2eefSMatthew G. Knepley   if (A) {
5811*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetDM(A, &dmAux));
5812*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetEnclosureRelation(dmAux, dm, &encAux));
5813*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMConvert(dmAux, DMPLEX, &plexAux));
5814*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetLocalSection(plexAux, &sectionAux));
5815*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetDS(dmAux, &probAux));
5816*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetTotalDimension(probAux, &totDimAux));
58178e3a2eefSMatthew G. Knepley   }
5818*5f80ce2aSJacob Faibussowitsch   CHKERRQ(VecSet(Z, 0.0));
5819*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc6(numCells*totDim,&u,X_t ? numCells*totDim : 0,&u_t,numCells*totDim*totDim,&elemMat,hasDyn ? numCells*totDim*totDim : 0, &elemMatD,numCells*totDim,&y,totDim,&z));
5820*5f80ce2aSJacob Faibussowitsch   if (dmAux) CHKERRQ(PetscMalloc1(numCells*totDimAux, &a));
5821*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateField(dm, &coordField));
58228e3a2eefSMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
58238e3a2eefSMatthew G. Knepley     const PetscInt cell = cells ? cells[c] : c;
58248e3a2eefSMatthew G. Knepley     const PetscInt cind = c - cStart;
58258e3a2eefSMatthew G. Knepley     PetscScalar   *x = NULL,  *x_t = NULL;
58268e3a2eefSMatthew G. Knepley     PetscInt       i;
58278e3a2eefSMatthew G. Knepley 
5828*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecGetClosure(plex, section, X, cell, NULL, &x));
58298e3a2eefSMatthew G. Knepley     for (i = 0; i < totDim; ++i) u[cind*totDim+i] = x[i];
5830*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecRestoreClosure(plex, section, X, cell, NULL, &x));
58318e3a2eefSMatthew G. Knepley     if (X_t) {
5832*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecGetClosure(plex, section, X_t, cell, NULL, &x_t));
58338e3a2eefSMatthew G. Knepley       for (i = 0; i < totDim; ++i) u_t[cind*totDim+i] = x_t[i];
5834*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecRestoreClosure(plex, section, X_t, cell, NULL, &x_t));
58358e3a2eefSMatthew G. Knepley     }
58368e3a2eefSMatthew G. Knepley     if (dmAux) {
58378e3a2eefSMatthew G. Knepley       PetscInt subcell;
5838*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMGetEnclosurePoint(dmAux, dm, encAux, cell, &subcell));
5839*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecGetClosure(plexAux, sectionAux, A, subcell, NULL, &x));
58408e3a2eefSMatthew G. Knepley       for (i = 0; i < totDimAux; ++i) a[cind*totDimAux+i] = x[i];
5841*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecRestoreClosure(plexAux, sectionAux, A, subcell, NULL, &x));
58428e3a2eefSMatthew G. Knepley     }
5843*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecGetClosure(plex, section, Y, cell, NULL, &x));
58448e3a2eefSMatthew G. Knepley     for (i = 0; i < totDim; ++i) y[cind*totDim+i] = x[i];
5845*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecRestoreClosure(plex, section, Y, cell, NULL, &x));
58468e3a2eefSMatthew G. Knepley   }
5847*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscArrayzero(elemMat, numCells*totDim*totDim));
5848*5f80ce2aSJacob Faibussowitsch   if (hasDyn)  CHKERRQ(PetscArrayzero(elemMatD, numCells*totDim*totDim));
58498e3a2eefSMatthew G. Knepley   for (fieldI = 0; fieldI < Nf; ++fieldI) {
58508e3a2eefSMatthew G. Knepley     PetscFE  fe;
58518e3a2eefSMatthew G. Knepley     PetscInt Nb;
58528e3a2eefSMatthew G. Knepley     /* Conforming batches */
58538e3a2eefSMatthew G. Knepley     PetscInt numChunks, numBatches, numBlocks, Ne, blockSize, batchSize;
58548e3a2eefSMatthew G. Knepley     /* Remainder */
58558e3a2eefSMatthew G. Knepley     PetscInt Nr, offset, Nq;
58568e3a2eefSMatthew G. Knepley     PetscQuadrature qGeom = NULL;
58578e3a2eefSMatthew G. Knepley     PetscInt    maxDegree;
58588e3a2eefSMatthew G. Knepley     PetscFEGeom *cgeomFEM, *chunkGeom = NULL, *remGeom = NULL;
58598e3a2eefSMatthew G. Knepley 
5860*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, fieldI, (PetscObject *) &fe));
5861*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGetQuadrature(fe, &quad));
5862*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGetDimension(fe, &Nb));
5863*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
5864*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMFieldGetDegree(coordField,cellIS,NULL,&maxDegree));
5865*5f80ce2aSJacob Faibussowitsch     if (maxDegree <= 1) CHKERRQ(DMFieldCreateDefaultQuadrature(coordField,cellIS,&qGeom));
58668e3a2eefSMatthew G. Knepley     if (!qGeom) {
5867*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetQuadrature(fe,&qGeom));
5868*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscObjectReference((PetscObject)qGeom));
58698e3a2eefSMatthew G. Knepley     }
5870*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscQuadratureGetData(qGeom, NULL, NULL, &Nq, NULL, NULL));
5871*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMSNESGetFEGeom(coordField,cellIS,qGeom,PETSC_FALSE,&cgeomFEM));
58728e3a2eefSMatthew G. Knepley     blockSize = Nb;
58738e3a2eefSMatthew G. Knepley     batchSize = numBlocks * blockSize;
5874*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
58758e3a2eefSMatthew G. Knepley     numChunks = numCells / (numBatches*batchSize);
58768e3a2eefSMatthew G. Knepley     Ne        = numChunks*numBatches*batchSize;
58778e3a2eefSMatthew G. Knepley     Nr        = numCells % (numBatches*batchSize);
58788e3a2eefSMatthew G. Knepley     offset    = numCells - Nr;
5879*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGeomGetChunk(cgeomFEM,0,offset,&chunkGeom));
5880*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGeomGetChunk(cgeomFEM,offset,numCells,&remGeom));
58818e3a2eefSMatthew G. Knepley     for (fieldJ = 0; fieldJ < Nf; ++fieldJ) {
58828e3a2eefSMatthew G. Knepley       key.field = fieldI*Nf + fieldJ;
5883*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN, key, Ne, chunkGeom, u, u_t, probAux, a, t, X_tShift, elemMat));
5884*5f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN, key, Nr, remGeom, &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, probAux, &a[offset*totDimAux], t, X_tShift, &elemMat[offset*totDim*totDim]));
58858e3a2eefSMatthew G. Knepley       if (hasDyn) {
5886*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN_DYN, key, Ne, chunkGeom, u, u_t, probAux, a, t, X_tShift, elemMatD));
5887*5f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN_DYN, key, Nr, remGeom, &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, probAux, &a[offset*totDimAux], t, X_tShift, &elemMatD[offset*totDim*totDim]));
58888e3a2eefSMatthew G. Knepley       }
58898e3a2eefSMatthew G. Knepley     }
5890*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGeomRestoreChunk(cgeomFEM,offset,numCells,&remGeom));
5891*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGeomRestoreChunk(cgeomFEM,0,offset,&chunkGeom));
5892*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMSNESRestoreFEGeom(coordField,cellIS,qGeom,PETSC_FALSE,&cgeomFEM));
5893*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscQuadratureDestroy(&qGeom));
58948e3a2eefSMatthew G. Knepley   }
58958e3a2eefSMatthew G. Knepley   if (hasDyn) {
58968e3a2eefSMatthew G. Knepley     for (c = 0; c < numCells*totDim*totDim; ++c) elemMat[c] += X_tShift*elemMatD[c];
58978e3a2eefSMatthew G. Knepley   }
58988e3a2eefSMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
58998e3a2eefSMatthew G. Knepley     const PetscInt     cell = cells ? cells[c] : c;
59008e3a2eefSMatthew G. Knepley     const PetscInt     cind = c - cStart;
59018e3a2eefSMatthew G. Knepley     const PetscBLASInt M = totDim, one = 1;
59028e3a2eefSMatthew G. Knepley     const PetscScalar  a = 1.0, b = 0.0;
59038e3a2eefSMatthew G. Knepley 
59048e3a2eefSMatthew G. Knepley     PetscStackCallBLAS("BLASgemv", BLASgemv_("N", &M, &M, &a, &elemMat[cind*totDim*totDim], &M, &y[cind*totDim], &one, &b, z, &one));
59058e3a2eefSMatthew G. Knepley     if (mesh->printFEM > 1) {
5906*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPrintCellMatrix(c, name, totDim, totDim, &elemMat[cind*totDim*totDim]));
5907*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPrintCellVector(c, "Y",  totDim, &y[cind*totDim]));
5908*5f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPrintCellVector(c, "Z",  totDim, z));
59098e3a2eefSMatthew G. Knepley     }
5910*5f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecSetClosure(dm, section, Z, cell, z, ADD_VALUES));
59118e3a2eefSMatthew G. Knepley   }
5912*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree6(u,u_t,elemMat,elemMatD,y,z));
59138e3a2eefSMatthew G. Knepley   if (mesh->printFEM) {
5914*5f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscPrintf(PetscObjectComm((PetscObject)Z), "Z:\n"));
5915*5f80ce2aSJacob Faibussowitsch     CHKERRQ(VecView(Z, NULL));
59168e3a2eefSMatthew G. Knepley   }
5917*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree(a));
5918*5f80ce2aSJacob Faibussowitsch   CHKERRQ(ISDestroy(&cellIS));
5919*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMDestroy(&plexAux));
5920*5f80ce2aSJacob Faibussowitsch   CHKERRQ(DMDestroy(&plex));
5921*5f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventEnd(DMPLEX_JacobianFEM,dm,0,0,0));
59228e3a2eefSMatthew G. Knepley   PetscFunctionReturn(0);
59238e3a2eefSMatthew G. Knepley }
5924