xref: /petsc/src/dm/impls/plex/plexfem.c (revision 792fecdfe9134cce4d631112660ddd34f063bc17)
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;
249566063dSJacob Faibussowitsch   PetscCall(PetscObjectTypeCompare((PetscObject) dm, DMPLEX, &isPlex));
252f856554SMatthew G. Knepley   if (isPlex) {
262f856554SMatthew G. Knepley     *plex = dm;
279566063dSJacob Faibussowitsch     PetscCall(PetscObjectReference((PetscObject) dm));
282f856554SMatthew G. Knepley   } else {
299566063dSJacob Faibussowitsch     PetscCall(PetscObjectQuery((PetscObject) dm, "dm_plex", (PetscObject *) plex));
302f856554SMatthew G. Knepley     if (!*plex) {
319566063dSJacob Faibussowitsch       PetscCall(DMConvert(dm, DMPLEX, plex));
329566063dSJacob Faibussowitsch       PetscCall(PetscObjectCompose((PetscObject) dm, "dm_plex", (PetscObject) *plex));
332f856554SMatthew G. Knepley       if (copy) {
342f856554SMatthew G. Knepley         DMSubDomainHookLink link;
359a2a23afSMatthew G. Knepley 
369566063dSJacob Faibussowitsch         PetscCall(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) {
399566063dSJacob Faibussowitsch           if (link->ddhook) PetscCall((*link->ddhook)(dm, *plex, link->ctx));
402f856554SMatthew G. Knepley         }
412f856554SMatthew G. Knepley       }
422f856554SMatthew G. Knepley     } else {
439566063dSJacob Faibussowitsch       PetscCall(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;
549566063dSJacob Faibussowitsch   PetscCall(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;
659566063dSJacob Faibussowitsch   PetscCall(PetscObjectGetId((PetscObject)quad,&id));
6663a3b9bcSJacob Faibussowitsch   PetscCall(PetscSNPrintf(composeStr, 32, "DMPlexGetFEGeom_%" PetscInt64_FMT "\n", id));
679566063dSJacob Faibussowitsch   PetscCall(PetscObjectQuery((PetscObject) pointIS, composeStr, (PetscObject *) &container));
689b6f715bSMatthew G. Knepley   if (container) {
699566063dSJacob Faibussowitsch     PetscCall(PetscContainerGetPointer(container, (void **) geom));
709b6f715bSMatthew G. Knepley   } else {
719566063dSJacob Faibussowitsch     PetscCall(DMFieldCreateFEGeom(coordField, pointIS, quad, faceData, geom));
729566063dSJacob Faibussowitsch     PetscCall(PetscContainerCreate(PETSC_COMM_SELF,&container));
739566063dSJacob Faibussowitsch     PetscCall(PetscContainerSetPointer(container, (void *) *geom));
749566063dSJacob Faibussowitsch     PetscCall(PetscContainerSetUserDestroy(container, PetscContainerUserDestroy_PetscFEGeom));
759566063dSJacob Faibussowitsch     PetscCall(PetscObjectCompose((PetscObject) pointIS, composeStr, (PetscObject) container));
769566063dSJacob Faibussowitsch     PetscCall(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 
102db781477SPatrick Sanan .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);
110dadcf809SJacob Faibussowitsch   PetscValidRealPointer(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 
127db781477SPatrick Sanan .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;
14863a3b9bcSJacob Faibussowitsch   PetscCheck(dim == dim2,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Input dimension %" PetscInt_FMT " does not match context dimension %" PetscInt_FMT, 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 
178db781477SPatrick Sanan .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;
1899566063dSJacob Faibussowitsch   PetscCall(PetscObjectGetComm((PetscObject) dm, &comm));
1909566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
1919566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateDim(dm, &dimEmbed));
1929566063dSJacob Faibussowitsch   PetscCall(DMGetNumFields(dm, &Nf));
19363a3b9bcSJacob Faibussowitsch   PetscCheck(!Nf || !(field < 0 || field >= Nf),comm, PETSC_ERR_ARG_OUTOFRANGE, "Field %" PetscInt_FMT " is not in [0, %" PetscInt_FMT ")", field, Nf);
19456cf3b9cSMatthew G. Knepley   if (dim == 1 && Nf < 2) {
1959566063dSJacob Faibussowitsch     PetscCall(MatNullSpaceCreate(comm, PETSC_TRUE, 0, NULL, sp));
196cb1e1211SMatthew G Knepley     PetscFunctionReturn(0);
197cb1e1211SMatthew G Knepley   }
1989566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
1999566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dm, &globalSection));
2009566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetConstrainedStorageSize(globalSection, &n));
2019566063dSJacob Faibussowitsch   PetscCall(PetscCalloc1(Nf, &func));
202b247467aSMatthew G. Knepley   m    = (dim*(dim+1))/2;
2039566063dSJacob Faibussowitsch   PetscCall(VecCreate(comm, &mode[0]));
2049566063dSJacob Faibussowitsch   PetscCall(VecSetType(mode[0], dm->vectype));
2059566063dSJacob Faibussowitsch   PetscCall(VecSetSizes(mode[0], n, PETSC_DETERMINE));
2069566063dSJacob Faibussowitsch   PetscCall(VecSetUp(mode[0]));
2079566063dSJacob Faibussowitsch   PetscCall(VecGetSize(mode[0], &n));
208b247467aSMatthew G. Knepley   mmin = PetscMin(m, n);
20956cf3b9cSMatthew G. Knepley   func[field] = DMPlexProjectRigidBody_Private;
2109566063dSJacob Faibussowitsch   for (i = 1; i < m; ++i) PetscCall(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;
2179566063dSJacob Faibussowitsch     PetscCall(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 
2239566063dSJacob Faibussowitsch     PetscCall(VecNormalize(mode[i], NULL));
2249566063dSJacob Faibussowitsch     PetscCall(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;
2279566063dSJacob Faibussowitsch       PetscCall(VecAXPY(mode[j], dots[j], mode[i]));
228b50a2c0aSJacob Faibussowitsch     }
229cb1e1211SMatthew G Knepley   }
2309566063dSJacob Faibussowitsch   PetscCall(MatNullSpaceCreate(comm, PETSC_FALSE, mmin, mode, sp));
2319566063dSJacob Faibussowitsch   for (i = 0; i < m; ++i) PetscCall(VecDestroy(&mode[i]));
2329566063dSJacob Faibussowitsch   PetscCall(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 
255db781477SPatrick Sanan .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;
2669566063dSJacob Faibussowitsch   PetscCall(PetscObjectGetComm((PetscObject)dm,&comm));
2679566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
2689566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateDim(dm, &dimEmbed));
2699566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
2709566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dm, &globalSection));
2719566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetConstrainedStorageSize(globalSection, &n));
27212adca46SMatthew G. Knepley   m    = nb * (dim*(dim+1))/2;
2739566063dSJacob Faibussowitsch   PetscCall(PetscMalloc2(m, &mode, m, &dots));
2749566063dSJacob Faibussowitsch   PetscCall(VecCreate(comm, &mode[0]));
2759566063dSJacob Faibussowitsch   PetscCall(VecSetSizes(mode[0], n, PETSC_DETERMINE));
2769566063dSJacob Faibussowitsch   PetscCall(VecSetUp(mode[0]));
2779566063dSJacob Faibussowitsch   for (i = 1; i < m; ++i) PetscCall(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;
2869566063dSJacob Faibussowitsch       PetscCall(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 
2949566063dSJacob Faibussowitsch     PetscCall(VecNormalize(mode[i], NULL));
2959566063dSJacob Faibussowitsch     PetscCall(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;
2989566063dSJacob Faibussowitsch       PetscCall(VecAXPY(mode[j], dots[j], mode[i]));
2995a0e29b9SJacob Faibussowitsch     }
30012adca46SMatthew G. Knepley   }
3019566063dSJacob Faibussowitsch   PetscCall(MatNullSpaceCreate(comm, PETSC_FALSE, m, mode, sp));
3029566063dSJacob Faibussowitsch   for (i = 0; i< m; ++i) PetscCall(VecDestroy(&mode[i]));
3039566063dSJacob Faibussowitsch   PetscCall(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 
322db781477SPatrick Sanan .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 
346db781477SPatrick Sanan .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;
3819566063dSJacob Faibussowitsch   PetscCall(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;
3879566063dSJacob Faibussowitsch     PetscCall(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;
3979566063dSJacob Faibussowitsch     PetscCall(PetscArraycpy(rc->RT, rc->R, PetscSqr(dim)));
398b458e8f1SJose E. Roman     DMPlex_Transpose3D_Internal(rc->RT);
399ca3d3a14SMatthew G. Knepley     break;
40063a3b9bcSJacob Faibussowitsch   default: SETERRQ(PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_OUTOFRANGE, "Dimension %" PetscInt_FMT " 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;
4109566063dSJacob Faibussowitsch   PetscCall(PetscFree2(rc->R, rc->RT));
4119566063dSJacob Faibussowitsch   PetscCall(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 
4359566063dSJacob Faibussowitsch       PetscCall(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 
4439566063dSJacob Faibussowitsch       PetscCall(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
4499566063dSJacob Faibussowitsch   PetscCall(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;
4599566063dSJacob Faibussowitsch   PetscCall((*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;
4749566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(tdm, &ts));
4759566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetFieldDof(ts, p, f, &dof));
4769566063dSJacob Faibussowitsch   PetscCall(VecGetArrayRead(tv, &ta));
4779566063dSJacob Faibussowitsch   PetscCall(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   }
4899566063dSJacob Faibussowitsch   PetscCall(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;
5009566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &s));
5019566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(tdm, &ts));
5029566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetFieldDof(s, pf, f, &fpdof));
5039566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetFieldDof(s, pg, g, &gpdof));
5049566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetFieldDof(ts, pf, f, &fdof));
5059566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetFieldDof(ts, pg, g, &gdof));
5069566063dSJacob Faibussowitsch   PetscCall(VecGetArrayRead(tv, &ta));
5079566063dSJacob Faibussowitsch   PetscCall(DMPlexPointLocalFieldRead(tdm, pf, f, ta, &tvaf));
5089566063dSJacob Faibussowitsch   PetscCall(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   }
5289566063dSJacob Faibussowitsch   PetscCall(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;
5429566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &s));
5439566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetNumFields(s, &Nf));
5449566063dSJacob Faibussowitsch   PetscCall(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) {
5479566063dSJacob Faibussowitsch       PetscCall(PetscSectionGetFieldDof(s, points[cp], f, &dof));
548ca3d3a14SMatthew G. Knepley       if (!dof) continue;
5499566063dSJacob Faibussowitsch       if (fieldActive[f]) PetscCall(DMPlexBasisTransformField_Internal(dm, tdm, tv, points[cp], f, l2g, &a[d]));
550ca3d3a14SMatthew G. Knepley       d += dof;
551ca3d3a14SMatthew G. Knepley     }
552ca3d3a14SMatthew G. Knepley   }
5539566063dSJacob Faibussowitsch   PetscCall(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;
5679566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &s));
5689566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetNumFields(s, &Nf));
5699566063dSJacob Faibussowitsch   PetscCall(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) {
5729566063dSJacob Faibussowitsch       PetscCall(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) {
5759566063dSJacob Faibussowitsch           PetscCall(PetscSectionGetFieldDof(s, points[cpg], g, &gdof));
5769566063dSJacob Faibussowitsch           PetscCall(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       }
58063a3b9bcSJacob Faibussowitsch       PetscCheck(c == lda,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Invalid number of columns %" PetscInt_FMT " should be %" PetscInt_FMT, c, lda);
581ca3d3a14SMatthew G. Knepley       r += fdof;
582ca3d3a14SMatthew G. Knepley     }
583ca3d3a14SMatthew G. Knepley   }
58463a3b9bcSJacob Faibussowitsch   PetscCheck(r == lda,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Invalid number of rows %" PetscInt_FMT " should be %" PetscInt_FMT, c, lda);
5859566063dSJacob Faibussowitsch   PetscCall(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;
5999566063dSJacob Faibussowitsch   PetscCall(DMGetBasisTransformDM_Internal(dm, &tdm));
6009566063dSJacob Faibussowitsch   PetscCall(DMGetBasisTransformVec_Internal(dm, &tv));
6019566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(tdm, &ts));
6029566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &s));
6039566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetChart(s, &pStart, &pEnd));
6049566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetNumFields(s, &Nf));
6059566063dSJacob Faibussowitsch   PetscCall(VecGetArray(lv, &a));
6069566063dSJacob Faibussowitsch   PetscCall(VecGetArrayRead(tv, &ta));
607ca3d3a14SMatthew G. Knepley   for (p = pStart; p < pEnd; ++p) {
608ca3d3a14SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
6099566063dSJacob Faibussowitsch       PetscCall(DMPlexPointLocalFieldRef(dm, p, f, a, &va));
6109566063dSJacob Faibussowitsch       PetscCall(DMPlexBasisTransformField_Internal(dm, tdm, tv, p, f, l2g, va));
611ca3d3a14SMatthew G. Knepley     }
612ca3d3a14SMatthew G. Knepley   }
6139566063dSJacob Faibussowitsch   PetscCall(VecRestoreArray(lv, &a));
6149566063dSJacob Faibussowitsch   PetscCall(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 
632db781477SPatrick Sanan .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);
6399566063dSJacob Faibussowitsch   PetscCall(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 
657db781477SPatrick Sanan .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);
6649566063dSJacob Faibussowitsch   PetscCall(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 
686db781477SPatrick Sanan .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;
6949566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateDim(dm, &cdim));
6959566063dSJacob Faibussowitsch   PetscCall(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;
7049566063dSJacob Faibussowitsch   PetscCall((*dm->transformSetUp)(dm, dm->transformCtx));
7059566063dSJacob Faibussowitsch   PetscCall(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 
729db781477SPatrick Sanan .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;
7389566063dSJacob Faibussowitsch   PetscCall(DMGetNumFields(dm, &numFields));
7399566063dSJacob Faibussowitsch   PetscCall(PetscCalloc2(numFields,&funcs,numFields,&ctxs));
740d7ddef95SMatthew G. Knepley   funcs[field] = func;
741d7ddef95SMatthew G. Knepley   ctxs[field]  = ctx;
7429566063dSJacob Faibussowitsch   PetscCall(DMProjectFunctionLabelLocal(dm, time, label, numids, ids, Nc, comps, funcs, ctxs, INSERT_BC_VALUES, locX));
7439566063dSJacob Faibussowitsch   PetscCall(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 
768db781477SPatrick Sanan .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;
7869566063dSJacob Faibussowitsch   PetscCall(DMGetNumFields(dm, &numFields));
7879566063dSJacob Faibussowitsch   PetscCall(PetscCalloc2(numFields,&funcs,numFields,&ctxs));
788c60e475cSMatthew G. Knepley   funcs[field] = func;
789c60e475cSMatthew G. Knepley   ctxs[field]  = ctx;
7909566063dSJacob Faibussowitsch   PetscCall(DMProjectFieldLabelLocal(dm, time, label, numids, ids, Nc, comps, locU, funcs, INSERT_BC_VALUES, locX));
7919566063dSJacob Faibussowitsch   PetscCall(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 
818db781477SPatrick Sanan .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;
8369566063dSJacob Faibussowitsch   PetscCall(DMGetNumFields(dm, &numFields));
8379566063dSJacob Faibussowitsch   PetscCall(PetscCalloc2(numFields,&funcs,numFields,&ctxs));
838ece3a9fcSMatthew G. Knepley   funcs[field] = func;
839ece3a9fcSMatthew G. Knepley   ctxs[field]  = ctx;
8409566063dSJacob Faibussowitsch   PetscCall(DMProjectBdFieldLabelLocal(dm, time, label, numids, ids, Nc, comps, locU, funcs, INSERT_BC_VALUES, locX));
8419566063dSJacob Faibussowitsch   PetscCall(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 
870db781477SPatrick Sanan .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;
8825f80ce2aSJacob Faibussowitsch   PetscErrorCode     ierru = 0;
883d7ddef95SMatthew G. Knepley 
884d7ddef95SMatthew G. Knepley   PetscFunctionBegin;
8859566063dSJacob Faibussowitsch   PetscCall(DMGetPointSF(dm, &sf));
8869566063dSJacob Faibussowitsch   PetscCall(PetscSFGetGraph(sf, NULL, &nleaves, &leaves, NULL));
887da97024aSMatthew G. Knepley   nleaves = PetscMax(0, nleaves);
8889566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
8899566063dSJacob Faibussowitsch   PetscCall(DMPlexGetHeightStratum(dm, 1, &fStart, &fEnd));
8909566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dm, &prob));
8919566063dSJacob Faibussowitsch   PetscCall(VecGetDM(faceGeometry, &dmFace));
8929566063dSJacob Faibussowitsch   PetscCall(VecGetArrayRead(faceGeometry, &facegeom));
89320369375SToby Isaac   if (cellGeometry) {
8949566063dSJacob Faibussowitsch     PetscCall(VecGetDM(cellGeometry, &dmCell));
8959566063dSJacob Faibussowitsch     PetscCall(VecGetArrayRead(cellGeometry, &cellgeom));
89620369375SToby Isaac   }
897d7ddef95SMatthew G. Knepley   if (Grad) {
898c0a6632aSMatthew G. Knepley     PetscFV fv;
899c0a6632aSMatthew G. Knepley 
9009566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, field, (PetscObject *) &fv));
9019566063dSJacob Faibussowitsch     PetscCall(VecGetDM(Grad, &dmGrad));
9029566063dSJacob Faibussowitsch     PetscCall(VecGetArrayRead(Grad, &grad));
9039566063dSJacob Faibussowitsch     PetscCall(PetscFVGetNumComponents(fv, &pdim));
9049566063dSJacob Faibussowitsch     PetscCall(DMGetWorkArray(dm, pdim, MPIU_SCALAR, &fx));
905d7ddef95SMatthew G. Knepley   }
9069566063dSJacob Faibussowitsch   PetscCall(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 
9129566063dSJacob Faibussowitsch     PetscCall(DMLabelGetStratumIS(label, ids[i], &faceIS));
913d7ddef95SMatthew G. Knepley     if (!faceIS) continue; /* No points with that id on this process */
9149566063dSJacob Faibussowitsch     PetscCall(ISGetLocalSize(faceIS, &numFaces));
9159566063dSJacob Faibussowitsch     PetscCall(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 */
9219566063dSJacob Faibussowitsch       PetscCall(PetscFindInt(face, nleaves, (PetscInt *) leaves, &loc));
922da97024aSMatthew G. Knepley       if (loc >= 0) continue;
9239566063dSJacob Faibussowitsch       PetscCall(DMPlexPointLocalRead(dmFace, face, facegeom, &fg));
9249566063dSJacob Faibussowitsch       PetscCall(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 
9329566063dSJacob Faibussowitsch         PetscCall(DMPlexPointLocalRead(dmCell, cells[0], cellgeom, &cg));
9339566063dSJacob Faibussowitsch         PetscCall(DMPlexPointLocalRead(dm, cells[0], x, &cx));
9349566063dSJacob Faibussowitsch         PetscCall(DMPlexPointLocalRead(dmGrad, cells[0], grad, &cgrad));
9359566063dSJacob Faibussowitsch         PetscCall(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);
9389566063dSJacob Faibussowitsch         PetscCall((*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 
9439566063dSJacob Faibussowitsch         PetscCall(DMPlexPointLocalRead(dm, cells[0], x, &xI));
9449566063dSJacob Faibussowitsch         PetscCall(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) {
9479566063dSJacob Faibussowitsch           PetscCall(ISRestoreIndices(faceIS, &faces));
9489566063dSJacob Faibussowitsch           PetscCall(ISDestroy(&faceIS));
949e735a8a9SMatthew G. Knepley           goto cleanup;
950e735a8a9SMatthew G. Knepley         }
951d7ddef95SMatthew G. Knepley       }
952d7ddef95SMatthew G. Knepley     }
9539566063dSJacob Faibussowitsch     PetscCall(ISRestoreIndices(faceIS, &faces));
9549566063dSJacob Faibussowitsch     PetscCall(ISDestroy(&faceIS));
955d7ddef95SMatthew G. Knepley   }
956e735a8a9SMatthew G. Knepley   cleanup:
9579566063dSJacob Faibussowitsch   PetscCall(VecRestoreArray(locX, &x));
958d7ddef95SMatthew G. Knepley   if (Grad) {
9599566063dSJacob Faibussowitsch     PetscCall(DMRestoreWorkArray(dm, pdim, MPIU_SCALAR, &fx));
9609566063dSJacob Faibussowitsch     PetscCall(VecRestoreArrayRead(Grad, &grad));
961d7ddef95SMatthew G. Knepley   }
9629566063dSJacob Faibussowitsch   if (cellGeometry) PetscCall(VecRestoreArrayRead(cellGeometry, &cellgeom));
9639566063dSJacob Faibussowitsch   PetscCall(VecRestoreArrayRead(faceGeometry, &facegeom));
9649566063dSJacob Faibussowitsch   PetscCall(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;
9829566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dm, &prob));
9839566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumBoundary(prob, &numBd));
9849566063dSJacob Faibussowitsch   PetscCall(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 
9999566063dSJacob Faibussowitsch     PetscCall(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;
10019566063dSJacob Faibussowitsch     PetscCall(DMGetField(dm, field, NULL, &obj));
10029566063dSJacob Faibussowitsch     PetscCall(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;
10119566063dSJacob Faibussowitsch           PetscCall(DMPlexLabelAddCells(dm,label));
10129566063dSJacob Faibussowitsch           PetscCall(DMPlexInsertBoundaryValuesEssential(dm, time, field, Nc, comps, label, numids, ids, func, ctx, locX));
10139566063dSJacob Faibussowitsch           PetscCall(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 
10209566063dSJacob Faibussowitsch           PetscCall(DMPlexLabelAddCells(dm,label));
10219566063dSJacob Faibussowitsch           PetscCall(DMPlexInsertBoundaryValuesEssentialField(dm, time, locX, field, Nc, comps, label, numids, ids, func, ctx, locX));
10229566063dSJacob Faibussowitsch           PetscCall(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;
10329566063dSJacob Faibussowitsch         PetscCall(DMPlexInsertBoundaryValuesRiemann(dm, time, faceGeomFVM, cellGeomFVM, gradFVM, field, Nc, comps, label, numids, ids, func, ctx, locX));
103345480ffeSMatthew G. Knepley       }
103463a3b9bcSJacob Faibussowitsch     } else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, 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);
10479566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dm, &prob));
10489566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumBoundary(prob, &numBd));
10499566063dSJacob Faibussowitsch   PetscCall(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 
10649566063dSJacob Faibussowitsch     PetscCall(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;
10669566063dSJacob Faibussowitsch     PetscCall(DMGetField(dm, field, NULL, &obj));
10679566063dSJacob Faibussowitsch     PetscCall(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;
10769566063dSJacob Faibussowitsch           PetscCall(DMPlexLabelAddCells(dm,label));
10779566063dSJacob Faibussowitsch           PetscCall(DMPlexInsertBoundaryValuesEssential(dm, time, field, Nc, comps, label, numids, ids, func_t, ctx, locX));
10789566063dSJacob Faibussowitsch           PetscCall(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 
10859566063dSJacob Faibussowitsch           PetscCall(DMPlexLabelAddCells(dm,label));
10869566063dSJacob Faibussowitsch           PetscCall(DMPlexInsertBoundaryValuesEssentialField(dm, time, locX, field, Nc, comps, label, numids, ids, func_t, ctx, locX));
10879566063dSJacob Faibussowitsch           PetscCall(DMPlexLabelClearCells(dm,label));
108845480ffeSMatthew G. Knepley         }
108956cf3b9cSMatthew G. Knepley         break;
109056cf3b9cSMatthew G. Knepley       default: break;
109156cf3b9cSMatthew G. Knepley       }
109263a3b9bcSJacob Faibussowitsch     } else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, 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 
1115db781477SPatrick Sanan .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);}
1125cac4c232SBarry Smith   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 
1145db781477SPatrick Sanan .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);}
1155cac4c232SBarry Smith   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;
11649566063dSJacob Faibussowitsch   PetscCall(DMGetLocalVector(dm, &localX));
11659566063dSJacob Faibussowitsch   PetscCall(DMPlexInsertBoundaryValues(dm, PETSC_TRUE, localX, time, NULL, NULL, NULL));
11669566063dSJacob Faibussowitsch   PetscCall(DMGlobalToLocalBegin(dm, X, INSERT_VALUES, localX));
11679566063dSJacob Faibussowitsch   PetscCall(DMGlobalToLocalEnd(dm, X, INSERT_VALUES, localX));
11689566063dSJacob Faibussowitsch   PetscCall(DMPlexComputeL2DiffLocal(dm, time, funcs, ctxs, localX, diff));
11699566063dSJacob Faibussowitsch   PetscCall(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 
1190db781477SPatrick Sanan .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 
1207cb1e1211SMatthew G Knepley   PetscFunctionBegin;
12089566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
12099566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateDim(dm, &coordDim));
12102a4e142eSMatthew G. Knepley   fegeom.dimEmbed = coordDim;
12119566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
12129566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetNumFields(section, &numFields));
12139566063dSJacob Faibussowitsch   PetscCall(DMGetBasisTransformDM_Internal(dm, &tdm));
12149566063dSJacob Faibussowitsch   PetscCall(DMGetBasisTransformVec_Internal(dm, &tv));
12159566063dSJacob Faibussowitsch   PetscCall(DMHasBasisTransform(dm, &transform));
1216cb1e1211SMatthew G Knepley   for (field = 0; field < numFields; ++field) {
121715496722SMatthew G. Knepley     PetscObject  obj;
121815496722SMatthew G. Knepley     PetscClassId id;
1219c5bbbd5bSMatthew G. Knepley     PetscInt     Nc;
1220c5bbbd5bSMatthew G. Knepley 
12219566063dSJacob Faibussowitsch     PetscCall(DMGetField(dm, field, NULL, &obj));
12229566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
122315496722SMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
122415496722SMatthew G. Knepley       PetscFE fe = (PetscFE) obj;
122515496722SMatthew G. Knepley 
12269566063dSJacob Faibussowitsch       PetscCall(PetscFEGetQuadrature(fe, &quad));
12279566063dSJacob Faibussowitsch       PetscCall(PetscFEGetNumComponents(fe, &Nc));
122815496722SMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
122915496722SMatthew G. Knepley       PetscFV fv = (PetscFV) obj;
123015496722SMatthew G. Knepley 
12319566063dSJacob Faibussowitsch       PetscCall(PetscFVGetQuadrature(fv, &quad));
12329566063dSJacob Faibussowitsch       PetscCall(PetscFVGetNumComponents(fv, &Nc));
123363a3b9bcSJacob Faibussowitsch     } else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, field);
1234c5bbbd5bSMatthew G. Knepley     numComponents += Nc;
1235cb1e1211SMatthew G Knepley   }
12369566063dSJacob Faibussowitsch   PetscCall(PetscQuadratureGetData(quad, NULL, &qNc, &Nq, NULL, &quadWeights));
123763a3b9bcSJacob Faibussowitsch   PetscCheck(!(qNc != 1) || !(qNc != numComponents),PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_SIZ, "Quadrature components %" PetscInt_FMT " != %" PetscInt_FMT " field components", qNc, numComponents);
12389566063dSJacob Faibussowitsch   PetscCall(PetscMalloc6(numComponents,&funcVal,numComponents,&interpolant,coordDim*Nq,&coords,Nq,&fegeom.detJ,coordDim*coordDim*Nq,&fegeom.J,coordDim*coordDim*Nq,&fegeom.invJ));
12399566063dSJacob Faibussowitsch   PetscCall(DMPlexGetVTKCellHeight(dm, &cellHeight));
12409566063dSJacob Faibussowitsch   PetscCall(DMPlexGetSimplexOrBoxCells(dm, cellHeight, &cStart, &cEnd));
1241cb1e1211SMatthew G Knepley   for (c = cStart; c < cEnd; ++c) {
1242a1e44745SMatthew G. Knepley     PetscScalar *x = NULL;
1243cb1e1211SMatthew G Knepley     PetscReal    elemDiff = 0.0;
12449c3cf19fSMatthew G. Knepley     PetscInt     qc = 0;
1245cb1e1211SMatthew G Knepley 
12469566063dSJacob Faibussowitsch     PetscCall(DMPlexComputeCellGeometryFEM(dm, c, quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
12479566063dSJacob Faibussowitsch     PetscCall(DMPlexVecGetClosure(dm, NULL, localX, c, NULL, &x));
1248cb1e1211SMatthew G Knepley 
124915496722SMatthew G. Knepley     for (field = 0, fieldOffset = 0; field < numFields; ++field) {
125015496722SMatthew G. Knepley       PetscObject  obj;
125115496722SMatthew G. Knepley       PetscClassId id;
1252c110b1eeSGeoffrey Irving       void * const ctx = ctxs ? ctxs[field] : NULL;
125315496722SMatthew G. Knepley       PetscInt     Nb, Nc, q, fc;
1254cb1e1211SMatthew G Knepley 
12559566063dSJacob Faibussowitsch       PetscCall(DMGetField(dm, field, NULL, &obj));
12569566063dSJacob Faibussowitsch       PetscCall(PetscObjectGetClassId(obj, &id));
12579566063dSJacob Faibussowitsch       if (id == PETSCFE_CLASSID)      {PetscCall(PetscFEGetNumComponents((PetscFE) obj, &Nc));PetscCall(PetscFEGetDimension((PetscFE) obj, &Nb));}
12589566063dSJacob Faibussowitsch       else if (id == PETSCFV_CLASSID) {PetscCall(PetscFVGetNumComponents((PetscFV) obj, &Nc));Nb = 1;}
125963a3b9bcSJacob Faibussowitsch       else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, field);
1260cb1e1211SMatthew G Knepley       if (debug) {
1261cb1e1211SMatthew G Knepley         char title[1024];
126263a3b9bcSJacob Faibussowitsch         PetscCall(PetscSNPrintf(title, 1023, "Solution for Field %" PetscInt_FMT, field));
12639566063dSJacob Faibussowitsch         PetscCall(DMPrintCellVector(c, title, Nb, &x[fieldOffset]));
1264cb1e1211SMatthew G Knepley       }
12657318780aSToby Isaac       for (q = 0; q < Nq; ++q) {
12662a4e142eSMatthew G. Knepley         PetscFEGeom    qgeom;
1267d0609cedSBarry Smith         PetscErrorCode ierr;
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];
127363a3b9bcSJacob Faibussowitsch         PetscCheck(fegeom.detJ[q] > 0.0,PETSC_COMM_SELF, PETSC_ERR_ARG_OUTOFRANGE, "Invalid determinant %g for element %" PetscInt_FMT ", point %" PetscInt_FMT, (double)fegeom.detJ[q], c, q);
1274d3a7d86cSMatthew G. Knepley         if (transform) {
1275d3a7d86cSMatthew G. Knepley           gcoords = &coords[coordDim*Nq];
12769566063dSJacob Faibussowitsch           PetscCall(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         }
12809566063dSJacob Faibussowitsch         PetscCall(PetscArrayzero(funcVal,Nc));
1281ca3d3a14SMatthew G. Knepley         ierr = (*funcs[field])(coordDim, time, gcoords, Nc, funcVal, ctx);
1282e735a8a9SMatthew G. Knepley         if (ierr) {
12839566063dSJacob Faibussowitsch           PetscCall(DMPlexVecRestoreClosure(dm, NULL, localX, c, NULL, &x));
12849566063dSJacob Faibussowitsch           PetscCall(DMRestoreLocalVector(dm, &localX));
12859566063dSJacob Faibussowitsch           PetscCall(PetscFree6(funcVal,interpolant,coords,fegeom.detJ,fegeom.J,fegeom.invJ));
1286e735a8a9SMatthew G. Knepley         }
12879566063dSJacob Faibussowitsch         if (transform) PetscCall(DMPlexBasisTransformApply_Internal(dm, &coords[coordDim*q], PETSC_FALSE, Nc, funcVal, funcVal, dm->transformCtx));
12889566063dSJacob Faibussowitsch         if (id == PETSCFE_CLASSID)      PetscCall(PetscFEInterpolate_Static((PetscFE) obj, &x[fieldOffset], &qgeom, q, interpolant));
12899566063dSJacob Faibussowitsch         else if (id == PETSCFV_CLASSID) PetscCall(PetscFVInterpolate_Static((PetscFV) obj, &x[fieldOffset], q, interpolant));
12902df84da0SMatthew G. Knepley         else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, field);
129115496722SMatthew G. Knepley         for (fc = 0; fc < Nc; ++fc) {
1292beaa55a6SMatthew G. Knepley           const PetscReal wt = quadWeights[q*qNc+(qNc == 1 ? 0 : qc+fc)];
129363a3b9bcSJacob Faibussowitsch           if (debug) PetscCall(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]), (double)PetscRealPart(interpolant[fc]), (double)PetscRealPart(funcVal[fc])));
12944bee2e38SMatthew G. Knepley           elemDiff += PetscSqr(PetscRealPart(interpolant[fc] - funcVal[fc]))*wt*fegeom.detJ[q];
1295cb1e1211SMatthew G Knepley         }
1296cb1e1211SMatthew G Knepley       }
12979c3cf19fSMatthew G. Knepley       fieldOffset += Nb;
1298beaa55a6SMatthew G. Knepley       qc += Nc;
1299cb1e1211SMatthew G Knepley     }
13009566063dSJacob Faibussowitsch     PetscCall(DMPlexVecRestoreClosure(dm, NULL, localX, c, NULL, &x));
13019566063dSJacob Faibussowitsch     if (debug) PetscCall(PetscPrintf(PETSC_COMM_SELF, "  elem %" PetscInt_FMT " diff %g\n", c, (double)elemDiff));
1302cb1e1211SMatthew G Knepley     localDiff += elemDiff;
1303cb1e1211SMatthew G Knepley   }
13049566063dSJacob Faibussowitsch   PetscCall(PetscFree6(funcVal,interpolant,coords,fegeom.detJ,fegeom.J,fegeom.invJ));
13051c2dc1cbSBarry Smith   PetscCall(MPIU_Allreduce(&localDiff, diff, 1, MPIU_REAL, MPIU_SUM, PetscObjectComm((PetscObject)dm)));
1306cb1e1211SMatthew G Knepley   *diff = PetscSqrtReal(*diff);
1307cb1e1211SMatthew G Knepley   PetscFunctionReturn(0);
1308cb1e1211SMatthew G Knepley }
1309cb1e1211SMatthew G Knepley 
1310b698f381SToby 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)
1311cb1e1211SMatthew G Knepley {
13120f09c10fSMatthew G. Knepley   const PetscInt   debug = ((DM_Plex*)dm->data)->printL2;
1313ca3d3a14SMatthew G. Knepley   DM               tdm;
1314cb1e1211SMatthew G Knepley   PetscSection     section;
131540e14135SMatthew G. Knepley   PetscQuadrature  quad;
1316ca3d3a14SMatthew G. Knepley   Vec              localX, tv;
13179c3cf19fSMatthew G. Knepley   PetscScalar     *funcVal, *interpolant;
13182a4e142eSMatthew G. Knepley   const PetscReal *quadWeights;
13194bee2e38SMatthew G. Knepley   PetscFEGeom      fegeom;
13204bee2e38SMatthew G. Knepley   PetscReal       *coords, *gcoords;
132140e14135SMatthew G. Knepley   PetscReal        localDiff = 0.0;
1322485ad865SMatthew G. Knepley   PetscInt         dim, coordDim, qNc = 0, Nq = 0, numFields, numComponents = 0, cStart, cEnd, c, field, fieldOffset;
1323ca3d3a14SMatthew G. Knepley   PetscBool        transform;
1324cb1e1211SMatthew G Knepley 
1325cb1e1211SMatthew G Knepley   PetscFunctionBegin;
13269566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
13279566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateDim(dm, &coordDim));
13284bee2e38SMatthew G. Knepley   fegeom.dimEmbed = coordDim;
13299566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
13309566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetNumFields(section, &numFields));
13319566063dSJacob Faibussowitsch   PetscCall(DMGetLocalVector(dm, &localX));
13329566063dSJacob Faibussowitsch   PetscCall(DMGlobalToLocalBegin(dm, X, INSERT_VALUES, localX));
13339566063dSJacob Faibussowitsch   PetscCall(DMGlobalToLocalEnd(dm, X, INSERT_VALUES, localX));
13349566063dSJacob Faibussowitsch   PetscCall(DMGetBasisTransformDM_Internal(dm, &tdm));
13359566063dSJacob Faibussowitsch   PetscCall(DMGetBasisTransformVec_Internal(dm, &tv));
13369566063dSJacob Faibussowitsch   PetscCall(DMHasBasisTransform(dm, &transform));
1337652b88e8SMatthew G. Knepley   for (field = 0; field < numFields; ++field) {
13380f2d7e86SMatthew G. Knepley     PetscFE  fe;
133940e14135SMatthew G. Knepley     PetscInt Nc;
1340652b88e8SMatthew G. Knepley 
13419566063dSJacob Faibussowitsch     PetscCall(DMGetField(dm, field, NULL, (PetscObject *) &fe));
13429566063dSJacob Faibussowitsch     PetscCall(PetscFEGetQuadrature(fe, &quad));
13439566063dSJacob Faibussowitsch     PetscCall(PetscFEGetNumComponents(fe, &Nc));
134440e14135SMatthew G. Knepley     numComponents += Nc;
1345652b88e8SMatthew G. Knepley   }
13469566063dSJacob Faibussowitsch   PetscCall(PetscQuadratureGetData(quad, NULL, &qNc, &Nq, NULL, &quadWeights));
134763a3b9bcSJacob Faibussowitsch   PetscCheck(!(qNc != 1) || !(qNc != numComponents),PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_SIZ, "Quadrature components %" PetscInt_FMT " != %" PetscInt_FMT " field components", qNc, numComponents);
13489566063dSJacob Faibussowitsch   /* PetscCall(DMProjectFunctionLocal(dm, fe, funcs, INSERT_BC_VALUES, localX)); */
13499566063dSJacob Faibussowitsch   PetscCall(PetscMalloc6(numComponents,&funcVal,coordDim*Nq,&coords,coordDim*coordDim*Nq,&fegeom.J,coordDim*coordDim*Nq,&fegeom.invJ,numComponents*coordDim,&interpolant,Nq,&fegeom.detJ));
13509566063dSJacob Faibussowitsch   PetscCall(DMPlexGetSimplexOrBoxCells(dm, 0, &cStart, &cEnd));
135140e14135SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
135240e14135SMatthew G. Knepley     PetscScalar *x = NULL;
135340e14135SMatthew G. Knepley     PetscReal    elemDiff = 0.0;
13549c3cf19fSMatthew G. Knepley     PetscInt     qc = 0;
1355652b88e8SMatthew G. Knepley 
13569566063dSJacob Faibussowitsch     PetscCall(DMPlexComputeCellGeometryFEM(dm, c, quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
13579566063dSJacob Faibussowitsch     PetscCall(DMPlexVecGetClosure(dm, NULL, localX, c, NULL, &x));
135840e14135SMatthew G. Knepley 
13599c3cf19fSMatthew G. Knepley     for (field = 0, fieldOffset = 0; field < numFields; ++field) {
13600f2d7e86SMatthew G. Knepley       PetscFE          fe;
136151259fa3SMatthew G. Knepley       void * const     ctx = ctxs ? ctxs[field] : NULL;
13629c3cf19fSMatthew G. Knepley       PetscInt         Nb, Nc, q, fc;
136340e14135SMatthew G. Knepley 
13649566063dSJacob Faibussowitsch       PetscCall(DMGetField(dm, field, NULL, (PetscObject *) &fe));
13659566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDimension(fe, &Nb));
13669566063dSJacob Faibussowitsch       PetscCall(PetscFEGetNumComponents(fe, &Nc));
136740e14135SMatthew G. Knepley       if (debug) {
136840e14135SMatthew G. Knepley         char title[1024];
13699566063dSJacob Faibussowitsch         PetscCall(PetscSNPrintf(title, 1023, "Solution for Field %" PetscInt_FMT, field));
13709566063dSJacob Faibussowitsch         PetscCall(DMPrintCellVector(c, title, Nb, &x[fieldOffset]));
1371652b88e8SMatthew G. Knepley       }
13729c3cf19fSMatthew G. Knepley       for (q = 0; q < Nq; ++q) {
13732a4e142eSMatthew G. Knepley         PetscFEGeom    qgeom;
1374d0609cedSBarry Smith         PetscErrorCode ierr;
13752a4e142eSMatthew G. Knepley 
13762a4e142eSMatthew G. Knepley         qgeom.dimEmbed = fegeom.dimEmbed;
13772a4e142eSMatthew G. Knepley         qgeom.J        = &fegeom.J[q*coordDim*coordDim];
13782a4e142eSMatthew G. Knepley         qgeom.invJ     = &fegeom.invJ[q*coordDim*coordDim];
13792a4e142eSMatthew G. Knepley         qgeom.detJ     = &fegeom.detJ[q];
13802df84da0SMatthew 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);
1381d3a7d86cSMatthew G. Knepley         if (transform) {
1382d3a7d86cSMatthew G. Knepley           gcoords = &coords[coordDim*Nq];
13839566063dSJacob Faibussowitsch           PetscCall(DMPlexBasisTransformApplyReal_Internal(dm, &coords[coordDim*q], PETSC_TRUE, coordDim, &coords[coordDim*q], gcoords, dm->transformCtx));
1384d3a7d86cSMatthew G. Knepley         } else {
1385d3a7d86cSMatthew G. Knepley           gcoords = &coords[coordDim*q];
1386d3a7d86cSMatthew G. Knepley         }
13879566063dSJacob Faibussowitsch         PetscCall(PetscArrayzero(funcVal,Nc));
13884bee2e38SMatthew G. Knepley         ierr = (*funcs[field])(coordDim, time, gcoords, n, Nc, funcVal, ctx);
1389e735a8a9SMatthew G. Knepley         if (ierr) {
13909566063dSJacob Faibussowitsch           PetscCall(DMPlexVecRestoreClosure(dm, NULL, localX, c, NULL, &x));
13919566063dSJacob Faibussowitsch           PetscCall(DMRestoreLocalVector(dm, &localX));
13929566063dSJacob Faibussowitsch           PetscCall(PetscFree6(funcVal,coords,fegeom.J,fegeom.invJ,interpolant,fegeom.detJ));
1393e735a8a9SMatthew G. Knepley         }
13949566063dSJacob Faibussowitsch         if (transform) PetscCall(DMPlexBasisTransformApply_Internal(dm, &coords[coordDim*q], PETSC_FALSE, Nc, funcVal, funcVal, dm->transformCtx));
13959566063dSJacob Faibussowitsch         PetscCall(PetscFEInterpolateGradient_Static(fe, 1, &x[fieldOffset], &qgeom, q, interpolant));
13964bee2e38SMatthew G. Knepley         /* Overwrite with the dot product if the normal is given */
13974bee2e38SMatthew G. Knepley         if (n) {
13984bee2e38SMatthew G. Knepley           for (fc = 0; fc < Nc; ++fc) {
13994bee2e38SMatthew G. Knepley             PetscScalar sum = 0.0;
14004bee2e38SMatthew G. Knepley             PetscInt    d;
14014bee2e38SMatthew G. Knepley             for (d = 0; d < dim; ++d) sum += interpolant[fc*dim+d]*n[d];
14024bee2e38SMatthew G. Knepley             interpolant[fc] = sum;
14034bee2e38SMatthew G. Knepley           }
14044bee2e38SMatthew G. Knepley         }
14059c3cf19fSMatthew G. Knepley         for (fc = 0; fc < Nc; ++fc) {
1406beaa55a6SMatthew G. Knepley           const PetscReal wt = quadWeights[q*qNc+(qNc == 1 ? 0 : qc+fc)];
140763a3b9bcSJacob Faibussowitsch           if (debug) PetscCall(PetscPrintf(PETSC_COMM_SELF, "    elem %" PetscInt_FMT " fieldDer %" PetscInt_FMT ",%" PetscInt_FMT " diff %g\n", c, field, fc, (double)(PetscSqr(PetscRealPart(interpolant[fc] - funcVal[fc]))*wt*fegeom.detJ[q])));
14084bee2e38SMatthew G. Knepley           elemDiff += PetscSqr(PetscRealPart(interpolant[fc] - funcVal[fc]))*wt*fegeom.detJ[q];
140940e14135SMatthew G. Knepley         }
141040e14135SMatthew G. Knepley       }
14119c3cf19fSMatthew G. Knepley       fieldOffset += Nb;
14129c3cf19fSMatthew G. Knepley       qc          += Nc;
141340e14135SMatthew G. Knepley     }
14149566063dSJacob Faibussowitsch     PetscCall(DMPlexVecRestoreClosure(dm, NULL, localX, c, NULL, &x));
141563a3b9bcSJacob Faibussowitsch     if (debug) PetscCall(PetscPrintf(PETSC_COMM_SELF, "  elem %" PetscInt_FMT " diff %g\n", c, (double)elemDiff));
141640e14135SMatthew G. Knepley     localDiff += elemDiff;
141740e14135SMatthew G. Knepley   }
14189566063dSJacob Faibussowitsch   PetscCall(PetscFree6(funcVal,coords,fegeom.J,fegeom.invJ,interpolant,fegeom.detJ));
14199566063dSJacob Faibussowitsch   PetscCall(DMRestoreLocalVector(dm, &localX));
14201c2dc1cbSBarry Smith   PetscCall(MPIU_Allreduce(&localDiff, diff, 1, MPIU_REAL, MPIU_SUM, PetscObjectComm((PetscObject)dm)));
142140e14135SMatthew G. Knepley   *diff = PetscSqrtReal(*diff);
1422cb1e1211SMatthew G Knepley   PetscFunctionReturn(0);
1423cb1e1211SMatthew G Knepley }
1424cb1e1211SMatthew G Knepley 
1425c6eecec3SToby Isaac PetscErrorCode DMComputeL2FieldDiff_Plex(DM dm, PetscReal time, PetscErrorCode (**funcs)(PetscInt, PetscReal, const PetscReal [], PetscInt, PetscScalar *, void *), void **ctxs, Vec X, PetscReal *diff)
142673d901b8SMatthew G. Knepley {
14270f09c10fSMatthew G. Knepley   const PetscInt   debug = ((DM_Plex*)dm->data)->printL2;
1428ca3d3a14SMatthew G. Knepley   DM               tdm;
1429083401c6SMatthew G. Knepley   DMLabel          depthLabel;
143073d901b8SMatthew G. Knepley   PetscSection     section;
1431ca3d3a14SMatthew G. Knepley   Vec              localX, tv;
143273d901b8SMatthew G. Knepley   PetscReal       *localDiff;
1433083401c6SMatthew G. Knepley   PetscInt         dim, depth, dE, Nf, f, Nds, s;
1434ca3d3a14SMatthew G. Knepley   PetscBool        transform;
143573d901b8SMatthew G. Knepley 
143673d901b8SMatthew G. Knepley   PetscFunctionBegin;
14379566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
14389566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateDim(dm, &dE));
14399566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
14409566063dSJacob Faibussowitsch   PetscCall(DMGetLocalVector(dm, &localX));
14419566063dSJacob Faibussowitsch   PetscCall(DMGetBasisTransformDM_Internal(dm, &tdm));
14429566063dSJacob Faibussowitsch   PetscCall(DMGetBasisTransformVec_Internal(dm, &tv));
14439566063dSJacob Faibussowitsch   PetscCall(DMHasBasisTransform(dm, &transform));
14449566063dSJacob Faibussowitsch   PetscCall(DMGetNumFields(dm, &Nf));
14459566063dSJacob Faibussowitsch   PetscCall(DMPlexGetDepthLabel(dm, &depthLabel));
14469566063dSJacob Faibussowitsch   PetscCall(DMLabelGetNumValues(depthLabel, &depth));
1447083401c6SMatthew G. Knepley 
14489566063dSJacob Faibussowitsch   PetscCall(VecSet(localX, 0.0));
14499566063dSJacob Faibussowitsch   PetscCall(DMGlobalToLocalBegin(dm, X, INSERT_VALUES, localX));
14509566063dSJacob Faibussowitsch   PetscCall(DMGlobalToLocalEnd(dm, X, INSERT_VALUES, localX));
14519566063dSJacob Faibussowitsch   PetscCall(DMProjectFunctionLocal(dm, time, funcs, ctxs, INSERT_BC_VALUES, localX));
14529566063dSJacob Faibussowitsch   PetscCall(DMGetNumDS(dm, &Nds));
14539566063dSJacob Faibussowitsch   PetscCall(PetscCalloc1(Nf, &localDiff));
1454083401c6SMatthew G. Knepley   for (s = 0; s < Nds; ++s) {
1455083401c6SMatthew G. Knepley     PetscDS          ds;
1456083401c6SMatthew G. Knepley     DMLabel          label;
1457083401c6SMatthew G. Knepley     IS               fieldIS, pointIS;
1458083401c6SMatthew G. Knepley     const PetscInt  *fields, *points = NULL;
1459083401c6SMatthew G. Knepley     PetscQuadrature  quad;
1460083401c6SMatthew G. Knepley     const PetscReal *quadPoints, *quadWeights;
1461083401c6SMatthew G. Knepley     PetscFEGeom      fegeom;
1462083401c6SMatthew G. Knepley     PetscReal       *coords, *gcoords;
1463083401c6SMatthew G. Knepley     PetscScalar     *funcVal, *interpolant;
14645fedec97SMatthew G. Knepley     PetscBool        isCohesive;
1465083401c6SMatthew G. Knepley     PetscInt         qNc, Nq, totNc, cStart = 0, cEnd, c, dsNf;
146673d901b8SMatthew G. Knepley 
14679566063dSJacob Faibussowitsch     PetscCall(DMGetRegionNumDS(dm, s, &label, &fieldIS, &ds));
14689566063dSJacob Faibussowitsch     PetscCall(ISGetIndices(fieldIS, &fields));
14699566063dSJacob Faibussowitsch     PetscCall(PetscDSIsCohesive(ds, &isCohesive));
14709566063dSJacob Faibussowitsch     PetscCall(PetscDSGetNumFields(ds, &dsNf));
14719566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalComponents(ds, &totNc));
14729566063dSJacob Faibussowitsch     PetscCall(PetscDSGetQuadrature(ds, &quad));
14739566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureGetData(quad, NULL, &qNc, &Nq, &quadPoints, &quadWeights));
147463a3b9bcSJacob Faibussowitsch     PetscCheck(!(qNc != 1) || !(qNc != totNc),PETSC_COMM_SELF, PETSC_ERR_ARG_SIZ, "Quadrature components %" PetscInt_FMT " != %" PetscInt_FMT " field components", qNc, totNc);
14759566063dSJacob Faibussowitsch     PetscCall(PetscCalloc6(totNc, &funcVal, totNc, &interpolant, dE*(Nq+1), &coords,Nq, &fegeom.detJ, dE*dE*Nq, &fegeom.J, dE*dE*Nq, &fegeom.invJ));
1476083401c6SMatthew G. Knepley     if (!label) {
14779566063dSJacob Faibussowitsch       PetscCall(DMPlexGetSimplexOrBoxCells(dm, 0, &cStart, &cEnd));
1478083401c6SMatthew G. Knepley     } else {
14799566063dSJacob Faibussowitsch       PetscCall(DMLabelGetStratumIS(label, 1, &pointIS));
14809566063dSJacob Faibussowitsch       PetscCall(ISGetLocalSize(pointIS, &cEnd));
14819566063dSJacob Faibussowitsch       PetscCall(ISGetIndices(pointIS, &points));
1482083401c6SMatthew G. Knepley     }
148373d901b8SMatthew G. Knepley     for (c = cStart; c < cEnd; ++c) {
1484083401c6SMatthew G. Knepley       const PetscInt cell  = points ? points[c] : c;
148573d901b8SMatthew G. Knepley       PetscScalar    *x    = NULL;
14865fedec97SMatthew G. Knepley       const PetscInt *cone;
14875fedec97SMatthew G. Knepley       PetscInt        qc   = 0, fOff = 0, dep;
148873d901b8SMatthew G. Knepley 
14899566063dSJacob Faibussowitsch       PetscCall(DMLabelGetValue(depthLabel, cell, &dep));
1490083401c6SMatthew G. Knepley       if (dep != depth-1) continue;
14915fedec97SMatthew G. Knepley       if (isCohesive) {
14929566063dSJacob Faibussowitsch         PetscCall(DMPlexGetCone(dm, cell, &cone));
14939566063dSJacob Faibussowitsch         PetscCall(DMPlexComputeCellGeometryFEM(dm, cone[0], quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
149496959cd1SMatthew G. Knepley       } else {
14959566063dSJacob Faibussowitsch         PetscCall(DMPlexComputeCellGeometryFEM(dm, cell, quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
149696959cd1SMatthew G. Knepley       }
14979566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(dm, NULL, localX, cell, NULL, &x));
14985fedec97SMatthew G. Knepley       for (f = 0; f < dsNf; ++f) {
149915496722SMatthew G. Knepley         PetscObject  obj;
150015496722SMatthew G. Knepley         PetscClassId id;
1501083401c6SMatthew G. Knepley         void * const ctx = ctxs ? ctxs[fields[f]] : NULL;
150215496722SMatthew G. Knepley         PetscInt     Nb, Nc, q, fc;
150315496722SMatthew G. Knepley         PetscReal    elemDiff = 0.0;
15045fedec97SMatthew G. Knepley         PetscBool    cohesive;
150515496722SMatthew G. Knepley 
15069566063dSJacob Faibussowitsch         PetscCall(PetscDSGetCohesive(ds, f, &cohesive));
15075fedec97SMatthew G. Knepley         if (isCohesive && !cohesive) continue;
15089566063dSJacob Faibussowitsch         PetscCall(PetscDSGetDiscretization(ds, f, &obj));
15099566063dSJacob Faibussowitsch         PetscCall(PetscObjectGetClassId(obj, &id));
15109566063dSJacob Faibussowitsch         if (id == PETSCFE_CLASSID)      {PetscCall(PetscFEGetNumComponents((PetscFE) obj, &Nc));PetscCall(PetscFEGetDimension((PetscFE) obj, &Nb));}
15119566063dSJacob Faibussowitsch         else if (id == PETSCFV_CLASSID) {PetscCall(PetscFVGetNumComponents((PetscFV) obj, &Nc));Nb = 1;}
151263a3b9bcSJacob Faibussowitsch         else SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, fields[f]);
151373d901b8SMatthew G. Knepley         if (debug) {
151473d901b8SMatthew G. Knepley           char title[1024];
151563a3b9bcSJacob Faibussowitsch           PetscCall(PetscSNPrintf(title, 1023, "Solution for Field %" PetscInt_FMT, fields[f]));
15169566063dSJacob Faibussowitsch           PetscCall(DMPrintCellVector(cell, title, Nb, &x[fOff]));
151773d901b8SMatthew G. Knepley         }
15187318780aSToby Isaac         for (q = 0; q < Nq; ++q) {
15192a4e142eSMatthew G. Knepley           PetscFEGeom    qgeom;
1520d0609cedSBarry Smith           PetscErrorCode ierr;
15212a4e142eSMatthew G. Knepley 
15222a4e142eSMatthew G. Knepley           qgeom.dimEmbed = fegeom.dimEmbed;
1523083401c6SMatthew G. Knepley           qgeom.J        = &fegeom.J[q*dE*dE];
1524083401c6SMatthew G. Knepley           qgeom.invJ     = &fegeom.invJ[q*dE*dE];
15252a4e142eSMatthew G. Knepley           qgeom.detJ     = &fegeom.detJ[q];
152663a3b9bcSJacob Faibussowitsch           PetscCheck(fegeom.detJ[q] > 0.0,PETSC_COMM_SELF, PETSC_ERR_ARG_OUTOFRANGE, "Invalid determinant %g for cell %" PetscInt_FMT ", quadrature point %" PetscInt_FMT, (double)fegeom.detJ[q], cell, q);
1527d3a7d86cSMatthew G. Knepley           if (transform) {
1528083401c6SMatthew G. Knepley             gcoords = &coords[dE*Nq];
15299566063dSJacob Faibussowitsch             PetscCall(DMPlexBasisTransformApplyReal_Internal(dm, &coords[dE*q], PETSC_TRUE, dE, &coords[dE*q], gcoords, dm->transformCtx));
1530d3a7d86cSMatthew G. Knepley           } else {
1531083401c6SMatthew G. Knepley             gcoords = &coords[dE*q];
1532d3a7d86cSMatthew G. Knepley           }
15332df84da0SMatthew G. Knepley           for (fc = 0; fc < Nc; ++fc) funcVal[fc] = 0.;
1534083401c6SMatthew G. Knepley           ierr = (*funcs[fields[f]])(dE, time, gcoords, Nc, funcVal, ctx);
1535e735a8a9SMatthew G. Knepley           if (ierr) {
15369566063dSJacob Faibussowitsch             PetscCall(DMPlexVecRestoreClosure(dm, NULL, localX, cell, NULL, &x));
15379566063dSJacob Faibussowitsch             PetscCall(DMRestoreLocalVector(dm, &localX));
15389566063dSJacob Faibussowitsch             PetscCall(PetscFree6(funcVal,interpolant,coords,fegeom.detJ,fegeom.J,fegeom.invJ));
1539e735a8a9SMatthew G. Knepley           }
15409566063dSJacob Faibussowitsch           if (transform) PetscCall(DMPlexBasisTransformApply_Internal(dm, &coords[dE*q], PETSC_FALSE, Nc, funcVal, funcVal, dm->transformCtx));
154196959cd1SMatthew G. Knepley           /* Call once for each face, except for lagrange field */
15429566063dSJacob Faibussowitsch           if (id == PETSCFE_CLASSID)      PetscCall(PetscFEInterpolate_Static((PetscFE) obj, &x[fOff], &qgeom, q, interpolant));
15439566063dSJacob Faibussowitsch           else if (id == PETSCFV_CLASSID) PetscCall(PetscFVInterpolate_Static((PetscFV) obj, &x[fOff], q, interpolant));
154463a3b9bcSJacob Faibussowitsch           else SETERRQ(PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, fields[f]);
154515496722SMatthew G. Knepley           for (fc = 0; fc < Nc; ++fc) {
1546beaa55a6SMatthew G. Knepley             const PetscReal wt = quadWeights[q*qNc+(qNc == 1 ? 0 : qc+fc)];
154763a3b9bcSJacob Faibussowitsch             if (debug) PetscCall(PetscPrintf(PETSC_COMM_SELF, "    cell %" PetscInt_FMT " field %" PetscInt_FMT ",%" PetscInt_FMT " 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])));
15484bee2e38SMatthew G. Knepley             elemDiff += PetscSqr(PetscRealPart(interpolant[fc] - funcVal[fc]))*wt*fegeom.detJ[q];
154973d901b8SMatthew G. Knepley           }
155073d901b8SMatthew G. Knepley         }
1551083401c6SMatthew G. Knepley         fOff += Nb;
15529c3cf19fSMatthew G. Knepley         qc   += Nc;
1553083401c6SMatthew G. Knepley         localDiff[fields[f]] += elemDiff;
155463a3b9bcSJacob Faibussowitsch         if (debug) PetscCall(PetscPrintf(PETSC_COMM_SELF, "  cell %" PetscInt_FMT " field %" PetscInt_FMT " cum diff %g\n", cell, fields[f], (double)localDiff[fields[f]]));
155573d901b8SMatthew G. Knepley       }
15569566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(dm, NULL, localX, cell, NULL, &x));
1557083401c6SMatthew G. Knepley     }
1558083401c6SMatthew G. Knepley     if (label) {
15599566063dSJacob Faibussowitsch       PetscCall(ISRestoreIndices(pointIS, &points));
15609566063dSJacob Faibussowitsch       PetscCall(ISDestroy(&pointIS));
1561083401c6SMatthew G. Knepley     }
15629566063dSJacob Faibussowitsch     PetscCall(ISRestoreIndices(fieldIS, &fields));
15639566063dSJacob Faibussowitsch     PetscCall(PetscFree6(funcVal, interpolant, coords, fegeom.detJ, fegeom.J, fegeom.invJ));
156473d901b8SMatthew G. Knepley   }
15659566063dSJacob Faibussowitsch   PetscCall(DMRestoreLocalVector(dm, &localX));
15661c2dc1cbSBarry Smith   PetscCall(MPIU_Allreduce(localDiff, diff, Nf, MPIU_REAL, MPIU_SUM, PetscObjectComm((PetscObject)dm)));
15679566063dSJacob Faibussowitsch   PetscCall(PetscFree(localDiff));
1568083401c6SMatthew G. Knepley   for (f = 0; f < Nf; ++f) diff[f] = PetscSqrtReal(diff[f]);
156973d901b8SMatthew G. Knepley   PetscFunctionReturn(0);
157073d901b8SMatthew G. Knepley }
157173d901b8SMatthew G. Knepley 
1572e729f68cSMatthew G. Knepley /*@C
1573e729f68cSMatthew 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.
1574e729f68cSMatthew G. Knepley 
1575d083f849SBarry Smith   Collective on dm
1576c0f8e1fdSMatthew G. Knepley 
1577e729f68cSMatthew G. Knepley   Input Parameters:
1578e729f68cSMatthew G. Knepley + dm    - The DM
15790163fd50SMatthew G. Knepley . time  - The time
1580ca3eba1bSToby Isaac . funcs - The functions to evaluate for each field component: NULL means that component does not contribute to error calculation
1581e729f68cSMatthew G. Knepley . ctxs  - Optional array of contexts to pass to each function, or NULL.
1582e729f68cSMatthew G. Knepley - X     - The coefficient vector u_h
1583e729f68cSMatthew G. Knepley 
1584e729f68cSMatthew G. Knepley   Output Parameter:
1585e729f68cSMatthew G. Knepley . D - A Vec which holds the difference ||u - u_h||_2 for each cell
1586e729f68cSMatthew G. Knepley 
1587e729f68cSMatthew G. Knepley   Level: developer
1588e729f68cSMatthew G. Knepley 
1589db781477SPatrick Sanan .seealso: `DMProjectFunction()`, `DMComputeL2Diff()`, `DMPlexComputeL2FieldDiff()`, `DMComputeL2GradientDiff()`
1590e729f68cSMatthew G. Knepley @*/
15910163fd50SMatthew G. Knepley PetscErrorCode DMPlexComputeL2DiffVec(DM dm, PetscReal time, PetscErrorCode (**funcs)(PetscInt, PetscReal, const PetscReal [], PetscInt, PetscScalar *, void *), void **ctxs, Vec X, Vec D)
1592e729f68cSMatthew G. Knepley {
1593e729f68cSMatthew G. Knepley   PetscSection     section;
1594e729f68cSMatthew G. Knepley   PetscQuadrature  quad;
1595e729f68cSMatthew G. Knepley   Vec              localX;
15964bee2e38SMatthew G. Knepley   PetscFEGeom      fegeom;
1597e729f68cSMatthew G. Knepley   PetscScalar     *funcVal, *interpolant;
15984bee2e38SMatthew G. Knepley   PetscReal       *coords;
1599e729f68cSMatthew G. Knepley   const PetscReal *quadPoints, *quadWeights;
1600485ad865SMatthew G. Knepley   PetscInt         dim, coordDim, numFields, numComponents = 0, qNc, Nq, cStart, cEnd, c, field, fieldOffset;
1601e729f68cSMatthew G. Knepley 
1602e729f68cSMatthew G. Knepley   PetscFunctionBegin;
16039566063dSJacob Faibussowitsch   PetscCall(VecSet(D, 0.0));
16049566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
16059566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateDim(dm, &coordDim));
16069566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
16079566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetNumFields(section, &numFields));
16089566063dSJacob Faibussowitsch   PetscCall(DMGetLocalVector(dm, &localX));
16099566063dSJacob Faibussowitsch   PetscCall(DMProjectFunctionLocal(dm, time, funcs, ctxs, INSERT_BC_VALUES, localX));
16109566063dSJacob Faibussowitsch   PetscCall(DMGlobalToLocalBegin(dm, X, INSERT_VALUES, localX));
16119566063dSJacob Faibussowitsch   PetscCall(DMGlobalToLocalEnd(dm, X, INSERT_VALUES, localX));
1612e729f68cSMatthew G. Knepley   for (field = 0; field < numFields; ++field) {
1613e729f68cSMatthew G. Knepley     PetscObject  obj;
1614e729f68cSMatthew G. Knepley     PetscClassId id;
1615e729f68cSMatthew G. Knepley     PetscInt     Nc;
1616e729f68cSMatthew G. Knepley 
16179566063dSJacob Faibussowitsch     PetscCall(DMGetField(dm, field, NULL, &obj));
16189566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
1619e729f68cSMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
1620e729f68cSMatthew G. Knepley       PetscFE fe = (PetscFE) obj;
1621e729f68cSMatthew G. Knepley 
16229566063dSJacob Faibussowitsch       PetscCall(PetscFEGetQuadrature(fe, &quad));
16239566063dSJacob Faibussowitsch       PetscCall(PetscFEGetNumComponents(fe, &Nc));
1624e729f68cSMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
1625e729f68cSMatthew G. Knepley       PetscFV fv = (PetscFV) obj;
1626e729f68cSMatthew G. Knepley 
16279566063dSJacob Faibussowitsch       PetscCall(PetscFVGetQuadrature(fv, &quad));
16289566063dSJacob Faibussowitsch       PetscCall(PetscFVGetNumComponents(fv, &Nc));
162963a3b9bcSJacob Faibussowitsch     } else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, field);
1630e729f68cSMatthew G. Knepley     numComponents += Nc;
1631e729f68cSMatthew G. Knepley   }
16329566063dSJacob Faibussowitsch   PetscCall(PetscQuadratureGetData(quad, NULL, &qNc, &Nq, &quadPoints, &quadWeights));
163363a3b9bcSJacob Faibussowitsch   PetscCheck(!(qNc != 1) || !(qNc != numComponents),PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_SIZ, "Quadrature components %" PetscInt_FMT " != %" PetscInt_FMT " field components", qNc, numComponents);
16349566063dSJacob Faibussowitsch   PetscCall(PetscMalloc6(numComponents,&funcVal,numComponents,&interpolant,coordDim*Nq,&coords,Nq,&fegeom.detJ,coordDim*coordDim*Nq,&fegeom.J,coordDim*coordDim*Nq,&fegeom.invJ));
16359566063dSJacob Faibussowitsch   PetscCall(DMPlexGetSimplexOrBoxCells(dm, 0, &cStart, &cEnd));
1636e729f68cSMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
1637e729f68cSMatthew G. Knepley     PetscScalar *x = NULL;
16386f288a59SMatthew G. Knepley     PetscScalar  elemDiff = 0.0;
16399c3cf19fSMatthew G. Knepley     PetscInt     qc = 0;
1640e729f68cSMatthew G. Knepley 
16419566063dSJacob Faibussowitsch     PetscCall(DMPlexComputeCellGeometryFEM(dm, c, quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
16429566063dSJacob Faibussowitsch     PetscCall(DMPlexVecGetClosure(dm, NULL, localX, c, NULL, &x));
1643e729f68cSMatthew G. Knepley 
1644e729f68cSMatthew G. Knepley     for (field = 0, fieldOffset = 0; field < numFields; ++field) {
1645e729f68cSMatthew G. Knepley       PetscObject  obj;
1646e729f68cSMatthew G. Knepley       PetscClassId id;
1647e729f68cSMatthew G. Knepley       void * const ctx = ctxs ? ctxs[field] : NULL;
1648e729f68cSMatthew G. Knepley       PetscInt     Nb, Nc, q, fc;
1649e729f68cSMatthew G. Knepley 
16509566063dSJacob Faibussowitsch       PetscCall(DMGetField(dm, field, NULL, &obj));
16519566063dSJacob Faibussowitsch       PetscCall(PetscObjectGetClassId(obj, &id));
16529566063dSJacob Faibussowitsch       if (id == PETSCFE_CLASSID)      {PetscCall(PetscFEGetNumComponents((PetscFE) obj, &Nc));PetscCall(PetscFEGetDimension((PetscFE) obj, &Nb));}
16539566063dSJacob Faibussowitsch       else if (id == PETSCFV_CLASSID) {PetscCall(PetscFVGetNumComponents((PetscFV) obj, &Nc));Nb = 1;}
165463a3b9bcSJacob Faibussowitsch       else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, field);
165523f34ed2SToby Isaac       if (funcs[field]) {
16567318780aSToby Isaac         for (q = 0; q < Nq; ++q) {
16572a4e142eSMatthew G. Knepley           PetscFEGeom qgeom;
16582a4e142eSMatthew G. Knepley 
16592a4e142eSMatthew G. Knepley           qgeom.dimEmbed = fegeom.dimEmbed;
16602a4e142eSMatthew G. Knepley           qgeom.J        = &fegeom.J[q*coordDim*coordDim];
16612a4e142eSMatthew G. Knepley           qgeom.invJ     = &fegeom.invJ[q*coordDim*coordDim];
16622a4e142eSMatthew G. Knepley           qgeom.detJ     = &fegeom.detJ[q];
166363a3b9bcSJacob Faibussowitsch           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);
16649566063dSJacob Faibussowitsch           PetscCall((*funcs[field])(coordDim, time, &coords[q*coordDim], Nc, funcVal, ctx));
1665c3e24edfSBarry Smith #if defined(needs_fix_with_return_code_argument)
1666e735a8a9SMatthew G. Knepley           if (ierr) {
16679566063dSJacob Faibussowitsch             PetscCall(DMPlexVecRestoreClosure(dm, NULL, localX, c, NULL, &x));
16689566063dSJacob Faibussowitsch             PetscCall(PetscFree6(funcVal,interpolant,coords,fegeom.detJ,fegeom.J,fegeom.invJ));
16699566063dSJacob Faibussowitsch             PetscCall(DMRestoreLocalVector(dm, &localX));
1670e735a8a9SMatthew G. Knepley           }
1671c3e24edfSBarry Smith #endif
16729566063dSJacob Faibussowitsch           if (id == PETSCFE_CLASSID)      PetscCall(PetscFEInterpolate_Static((PetscFE) obj, &x[fieldOffset], &qgeom, q, interpolant));
16739566063dSJacob Faibussowitsch           else if (id == PETSCFV_CLASSID) PetscCall(PetscFVInterpolate_Static((PetscFV) obj, &x[fieldOffset], q, interpolant));
167463a3b9bcSJacob Faibussowitsch           else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, field);
1675e729f68cSMatthew G. Knepley           for (fc = 0; fc < Nc; ++fc) {
1676beaa55a6SMatthew G. Knepley             const PetscReal wt = quadWeights[q*qNc+(qNc == 1 ? 0 : qc+fc)];
16774bee2e38SMatthew G. Knepley             elemDiff += PetscSqr(PetscRealPart(interpolant[fc] - funcVal[fc]))*wt*fegeom.detJ[q];
1678e729f68cSMatthew G. Knepley           }
1679e729f68cSMatthew G. Knepley         }
168023f34ed2SToby Isaac       }
1681beaa55a6SMatthew G. Knepley       fieldOffset += Nb;
16829c3cf19fSMatthew G. Knepley       qc          += Nc;
1683e729f68cSMatthew G. Knepley     }
16849566063dSJacob Faibussowitsch     PetscCall(DMPlexVecRestoreClosure(dm, NULL, localX, c, NULL, &x));
16859566063dSJacob Faibussowitsch     PetscCall(VecSetValue(D, c - cStart, elemDiff, INSERT_VALUES));
1686e729f68cSMatthew G. Knepley   }
16879566063dSJacob Faibussowitsch   PetscCall(PetscFree6(funcVal,interpolant,coords,fegeom.detJ,fegeom.J,fegeom.invJ));
16889566063dSJacob Faibussowitsch   PetscCall(DMRestoreLocalVector(dm, &localX));
16899566063dSJacob Faibussowitsch   PetscCall(VecSqrtAbs(D));
1690e729f68cSMatthew G. Knepley   PetscFunctionReturn(0);
1691e729f68cSMatthew G. Knepley }
1692e729f68cSMatthew G. Knepley 
16935f0b18bfSMatthew G. Knepley /*@
16945f0b18bfSMatthew 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.
16955f0b18bfSMatthew G. Knepley 
16965f0b18bfSMatthew G. Knepley   Collective on dm
16975f0b18bfSMatthew G. Knepley 
16985f0b18bfSMatthew G. Knepley   Input Parameters:
16995f0b18bfSMatthew G. Knepley + dm - The DM
17005f0b18bfSMatthew G. Knepley - locX  - The coefficient vector u_h
17015f0b18bfSMatthew G. Knepley 
17025f0b18bfSMatthew G. Knepley   Output Parameter:
17035f0b18bfSMatthew G. Knepley . locC - A Vec which holds the Clement interpolant of the function
17045f0b18bfSMatthew G. Knepley 
17055f0b18bfSMatthew G. Knepley   Notes:
17065f0b18bfSMatthew 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
17075f0b18bfSMatthew G. Knepley 
17085f0b18bfSMatthew G. Knepley   Level: developer
17095f0b18bfSMatthew G. Knepley 
1710db781477SPatrick Sanan .seealso: `DMProjectFunction()`, `DMComputeL2Diff()`, `DMPlexComputeL2FieldDiff()`, `DMComputeL2GradientDiff()`
17115f0b18bfSMatthew G. Knepley @*/
17125f0b18bfSMatthew G. Knepley PetscErrorCode DMPlexComputeClementInterpolant(DM dm, Vec locX, Vec locC)
17135f0b18bfSMatthew G. Knepley {
17145f0b18bfSMatthew G. Knepley   PetscInt         debug = ((DM_Plex *) dm->data)->printFEM;
17155f0b18bfSMatthew G. Knepley   DM               dmc;
17165f0b18bfSMatthew G. Knepley   PetscQuadrature  quad;
17175f0b18bfSMatthew G. Knepley   PetscScalar     *interpolant, *valsum;
17185f0b18bfSMatthew G. Knepley   PetscFEGeom      fegeom;
17195f0b18bfSMatthew G. Knepley   PetscReal       *coords;
17205f0b18bfSMatthew G. Knepley   const PetscReal *quadPoints, *quadWeights;
17215f0b18bfSMatthew G. Knepley   PetscInt         dim, cdim, Nf, f, Nc = 0, Nq, qNc, cStart, cEnd, vStart, vEnd, v;
17225f0b18bfSMatthew G. Knepley 
17235f0b18bfSMatthew G. Knepley   PetscFunctionBegin;
17249566063dSJacob Faibussowitsch   PetscCall(PetscCitationsRegister(ClementCitation, &Clementcite));
17259566063dSJacob Faibussowitsch   PetscCall(VecGetDM(locC, &dmc));
17269566063dSJacob Faibussowitsch   PetscCall(VecSet(locC, 0.0));
17279566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
17289566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateDim(dm, &cdim));
17295f0b18bfSMatthew G. Knepley   fegeom.dimEmbed = cdim;
17309566063dSJacob Faibussowitsch   PetscCall(DMGetNumFields(dm, &Nf));
17315f0b18bfSMatthew G. Knepley   PetscCheck(Nf > 0, PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of fields is zero!");
17325f0b18bfSMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
17335f0b18bfSMatthew G. Knepley     PetscObject  obj;
17345f0b18bfSMatthew G. Knepley     PetscClassId id;
17355f0b18bfSMatthew G. Knepley     PetscInt     fNc;
17365f0b18bfSMatthew G. Knepley 
17379566063dSJacob Faibussowitsch     PetscCall(DMGetField(dm, f, NULL, &obj));
17389566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
17395f0b18bfSMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
17405f0b18bfSMatthew G. Knepley       PetscFE fe = (PetscFE) obj;
17415f0b18bfSMatthew G. Knepley 
17429566063dSJacob Faibussowitsch       PetscCall(PetscFEGetQuadrature(fe, &quad));
17439566063dSJacob Faibussowitsch       PetscCall(PetscFEGetNumComponents(fe, &fNc));
17445f0b18bfSMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
17455f0b18bfSMatthew G. Knepley       PetscFV fv = (PetscFV) obj;
17465f0b18bfSMatthew G. Knepley 
17479566063dSJacob Faibussowitsch       PetscCall(PetscFVGetQuadrature(fv, &quad));
17489566063dSJacob Faibussowitsch       PetscCall(PetscFVGetNumComponents(fv, &fNc));
174963a3b9bcSJacob Faibussowitsch     } else SETERRQ(PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, f);
17505f0b18bfSMatthew G. Knepley     Nc += fNc;
17515f0b18bfSMatthew G. Knepley   }
17529566063dSJacob Faibussowitsch   PetscCall(PetscQuadratureGetData(quad, NULL, &qNc, &Nq, &quadPoints, &quadWeights));
175363a3b9bcSJacob Faibussowitsch   PetscCheck(qNc == 1,PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_SIZ, "Quadrature components %" PetscInt_FMT " > 1", qNc);
17549566063dSJacob Faibussowitsch   PetscCall(PetscMalloc6(Nc*2, &valsum, Nc, &interpolant, cdim*Nq, &coords, Nq, &fegeom.detJ, cdim*cdim*Nq, &fegeom.J, cdim*cdim*Nq, &fegeom.invJ));
17559566063dSJacob Faibussowitsch   PetscCall(DMPlexGetDepthStratum(dm, 0, &vStart, &vEnd));
17569566063dSJacob Faibussowitsch   PetscCall(DMPlexGetSimplexOrBoxCells(dm, 0, &cStart, &cEnd));
17575f0b18bfSMatthew G. Knepley   for (v = vStart; v < vEnd; ++v) {
17585f0b18bfSMatthew G. Knepley     PetscScalar volsum = 0.0;
17595f0b18bfSMatthew G. Knepley     PetscInt   *star   = NULL;
17605f0b18bfSMatthew G. Knepley     PetscInt    starSize, st, fc;
17615f0b18bfSMatthew G. Knepley 
17629566063dSJacob Faibussowitsch     PetscCall(PetscArrayzero(valsum, Nc));
17639566063dSJacob Faibussowitsch     PetscCall(DMPlexGetTransitiveClosure(dm, v, PETSC_FALSE, &starSize, &star));
17645f0b18bfSMatthew G. Knepley     for (st = 0; st < starSize*2; st += 2) {
17655f0b18bfSMatthew G. Knepley       const PetscInt cell = star[st];
17665f0b18bfSMatthew G. Knepley       PetscScalar   *val  = &valsum[Nc];
17675f0b18bfSMatthew G. Knepley       PetscScalar   *x    = NULL;
17685f0b18bfSMatthew G. Knepley       PetscReal      vol  = 0.0;
17695f0b18bfSMatthew G. Knepley       PetscInt       foff = 0;
17705f0b18bfSMatthew G. Knepley 
17715f0b18bfSMatthew G. Knepley       if ((cell < cStart) || (cell >= cEnd)) continue;
17729566063dSJacob Faibussowitsch       PetscCall(DMPlexComputeCellGeometryFEM(dm, cell, quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
17739566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(dm, NULL, locX, cell, NULL, &x));
17745f0b18bfSMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
17755f0b18bfSMatthew G. Knepley         PetscObject  obj;
17765f0b18bfSMatthew G. Knepley         PetscClassId id;
17775f0b18bfSMatthew G. Knepley         PetscInt     Nb, fNc, q;
17785f0b18bfSMatthew G. Knepley 
17799566063dSJacob Faibussowitsch         PetscCall(PetscArrayzero(val, Nc));
17809566063dSJacob Faibussowitsch         PetscCall(DMGetField(dm, f, NULL, &obj));
17819566063dSJacob Faibussowitsch         PetscCall(PetscObjectGetClassId(obj, &id));
17829566063dSJacob Faibussowitsch         if (id == PETSCFE_CLASSID)      {PetscCall(PetscFEGetNumComponents((PetscFE) obj, &fNc));PetscCall(PetscFEGetDimension((PetscFE) obj, &Nb));}
17839566063dSJacob Faibussowitsch         else if (id == PETSCFV_CLASSID) {PetscCall(PetscFVGetNumComponents((PetscFV) obj, &fNc));Nb = 1;}
178463a3b9bcSJacob Faibussowitsch         else SETERRQ(PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, f);
17855f0b18bfSMatthew G. Knepley         for (q = 0; q < Nq; ++q) {
17865f0b18bfSMatthew G. Knepley           const PetscReal wt = quadWeights[q]*fegeom.detJ[q];
17875f0b18bfSMatthew G. Knepley           PetscFEGeom     qgeom;
17885f0b18bfSMatthew G. Knepley 
17895f0b18bfSMatthew G. Knepley           qgeom.dimEmbed = fegeom.dimEmbed;
17905f0b18bfSMatthew G. Knepley           qgeom.J        = &fegeom.J[q*cdim*cdim];
17915f0b18bfSMatthew G. Knepley           qgeom.invJ     = &fegeom.invJ[q*cdim*cdim];
17925f0b18bfSMatthew G. Knepley           qgeom.detJ     = &fegeom.detJ[q];
179363a3b9bcSJacob Faibussowitsch           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], cell, q);
17949566063dSJacob Faibussowitsch           if (id == PETSCFE_CLASSID) PetscCall(PetscFEInterpolate_Static((PetscFE) obj, &x[foff], &qgeom, q, interpolant));
179563a3b9bcSJacob Faibussowitsch           else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, f);
17965f0b18bfSMatthew G. Knepley           for (fc = 0; fc < fNc; ++fc) val[foff+fc] += interpolant[fc]*wt;
17975f0b18bfSMatthew G. Knepley           vol += wt;
17985f0b18bfSMatthew G. Knepley         }
17995f0b18bfSMatthew G. Knepley         foff += Nb;
18005f0b18bfSMatthew G. Knepley       }
18019566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(dm, NULL, locX, cell, NULL, &x));
18025f0b18bfSMatthew G. Knepley       for (fc = 0; fc < Nc; ++fc) valsum[fc] += val[fc];
18035f0b18bfSMatthew G. Knepley       volsum += vol;
18045f0b18bfSMatthew G. Knepley       if (debug) {
18059566063dSJacob Faibussowitsch         PetscCall(PetscPrintf(PETSC_COMM_SELF, "Vertex %" PetscInt_FMT " Cell %" PetscInt_FMT " value: [", v, cell));
18065f0b18bfSMatthew G. Knepley         for (fc = 0; fc < Nc; ++fc) {
18079566063dSJacob Faibussowitsch           if (fc) PetscCall(PetscPrintf(PETSC_COMM_SELF, ", "));
18089566063dSJacob Faibussowitsch           PetscCall(PetscPrintf(PETSC_COMM_SELF, "%g", (double) PetscRealPart(val[fc])));
18095f0b18bfSMatthew G. Knepley         }
18109566063dSJacob Faibussowitsch         PetscCall(PetscPrintf(PETSC_COMM_SELF, "]\n"));
18115f0b18bfSMatthew G. Knepley       }
18125f0b18bfSMatthew G. Knepley     }
18135f0b18bfSMatthew G. Knepley     for (fc = 0; fc < Nc; ++fc) valsum[fc] /= volsum;
18149566063dSJacob Faibussowitsch     PetscCall(DMPlexRestoreTransitiveClosure(dm, v, PETSC_FALSE, &starSize, &star));
18159566063dSJacob Faibussowitsch     PetscCall(DMPlexVecSetClosure(dmc, NULL, locC, v, valsum, INSERT_VALUES));
18165f0b18bfSMatthew G. Knepley   }
18179566063dSJacob Faibussowitsch   PetscCall(PetscFree6(valsum, interpolant, coords, fegeom.detJ, fegeom.J, fegeom.invJ));
18185f0b18bfSMatthew G. Knepley   PetscFunctionReturn(0);
18195f0b18bfSMatthew G. Knepley }
18205f0b18bfSMatthew G. Knepley 
18215f0b18bfSMatthew G. Knepley /*@
18221555c271SMatthew 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.
18231555c271SMatthew G. Knepley 
1824d083f849SBarry Smith   Collective on dm
1825c0f8e1fdSMatthew G. Knepley 
18261555c271SMatthew G. Knepley   Input Parameters:
18271555c271SMatthew G. Knepley + dm - The DM
18285f0b18bfSMatthew G. Knepley - locX  - The coefficient vector u_h
18291555c271SMatthew G. Knepley 
18301555c271SMatthew G. Knepley   Output Parameter:
18311555c271SMatthew G. Knepley . locC - A Vec which holds the Clement interpolant of the gradient
18321555c271SMatthew G. Knepley 
183395452b02SPatrick Sanan   Notes:
18341555c271SMatthew 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
18351555c271SMatthew G. Knepley 
18361555c271SMatthew G. Knepley   Level: developer
18371555c271SMatthew G. Knepley 
1838db781477SPatrick Sanan .seealso: `DMProjectFunction()`, `DMComputeL2Diff()`, `DMPlexComputeL2FieldDiff()`, `DMComputeL2GradientDiff()`
18391555c271SMatthew G. Knepley @*/
18401555c271SMatthew G. Knepley PetscErrorCode DMPlexComputeGradientClementInterpolant(DM dm, Vec locX, Vec locC)
18411555c271SMatthew G. Knepley {
1842db1066baSMatthew G. Knepley   DM_Plex         *mesh  = (DM_Plex *) dm->data;
1843db1066baSMatthew G. Knepley   PetscInt         debug = mesh->printFEM;
18441555c271SMatthew G. Knepley   DM               dmC;
18451555c271SMatthew G. Knepley   PetscQuadrature  quad;
18461555c271SMatthew G. Knepley   PetscScalar     *interpolant, *gradsum;
18474bee2e38SMatthew G. Knepley   PetscFEGeom      fegeom;
18484bee2e38SMatthew G. Knepley   PetscReal       *coords;
18491555c271SMatthew G. Knepley   const PetscReal *quadPoints, *quadWeights;
1850485ad865SMatthew G. Knepley   PetscInt         dim, coordDim, numFields, numComponents = 0, qNc, Nq, cStart, cEnd, vStart, vEnd, v, field, fieldOffset;
18511555c271SMatthew G. Knepley 
18521555c271SMatthew G. Knepley   PetscFunctionBegin;
18539566063dSJacob Faibussowitsch   PetscCall(PetscCitationsRegister(ClementCitation, &Clementcite));
18549566063dSJacob Faibussowitsch   PetscCall(VecGetDM(locC, &dmC));
18559566063dSJacob Faibussowitsch   PetscCall(VecSet(locC, 0.0));
18569566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
18579566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateDim(dm, &coordDim));
18584bee2e38SMatthew G. Knepley   fegeom.dimEmbed = coordDim;
18599566063dSJacob Faibussowitsch   PetscCall(DMGetNumFields(dm, &numFields));
18605f80ce2aSJacob Faibussowitsch   PetscCheck(numFields,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of fields is zero!");
18611555c271SMatthew G. Knepley   for (field = 0; field < numFields; ++field) {
18621555c271SMatthew G. Knepley     PetscObject  obj;
18631555c271SMatthew G. Knepley     PetscClassId id;
18641555c271SMatthew G. Knepley     PetscInt     Nc;
18651555c271SMatthew G. Knepley 
18669566063dSJacob Faibussowitsch     PetscCall(DMGetField(dm, field, NULL, &obj));
18679566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
18681555c271SMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
18691555c271SMatthew G. Knepley       PetscFE fe = (PetscFE) obj;
18701555c271SMatthew G. Knepley 
18719566063dSJacob Faibussowitsch       PetscCall(PetscFEGetQuadrature(fe, &quad));
18729566063dSJacob Faibussowitsch       PetscCall(PetscFEGetNumComponents(fe, &Nc));
18731555c271SMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
18741555c271SMatthew G. Knepley       PetscFV fv = (PetscFV) obj;
18751555c271SMatthew G. Knepley 
18769566063dSJacob Faibussowitsch       PetscCall(PetscFVGetQuadrature(fv, &quad));
18779566063dSJacob Faibussowitsch       PetscCall(PetscFVGetNumComponents(fv, &Nc));
187863a3b9bcSJacob Faibussowitsch     } else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, field);
18791555c271SMatthew G. Knepley     numComponents += Nc;
18801555c271SMatthew G. Knepley   }
18819566063dSJacob Faibussowitsch   PetscCall(PetscQuadratureGetData(quad, NULL, &qNc, &Nq, &quadPoints, &quadWeights));
188263a3b9bcSJacob Faibussowitsch   PetscCheck(!(qNc != 1) || !(qNc != numComponents),PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_SIZ, "Quadrature components %" PetscInt_FMT " != %" PetscInt_FMT " field components", qNc, numComponents);
18839566063dSJacob Faibussowitsch   PetscCall(PetscMalloc6(coordDim*numComponents*2,&gradsum,coordDim*numComponents,&interpolant,coordDim*Nq,&coords,Nq,&fegeom.detJ,coordDim*coordDim*Nq,&fegeom.J,coordDim*coordDim*Nq,&fegeom.invJ));
18849566063dSJacob Faibussowitsch   PetscCall(DMPlexGetDepthStratum(dm, 0, &vStart, &vEnd));
18859566063dSJacob Faibussowitsch   PetscCall(DMPlexGetSimplexOrBoxCells(dm, 0, &cStart, &cEnd));
18861555c271SMatthew G. Knepley   for (v = vStart; v < vEnd; ++v) {
18871555c271SMatthew G. Knepley     PetscScalar volsum = 0.0;
18881555c271SMatthew G. Knepley     PetscInt   *star   = NULL;
18891555c271SMatthew G. Knepley     PetscInt    starSize, st, d, fc;
18901555c271SMatthew G. Knepley 
18919566063dSJacob Faibussowitsch     PetscCall(PetscArrayzero(gradsum, coordDim*numComponents));
18929566063dSJacob Faibussowitsch     PetscCall(DMPlexGetTransitiveClosure(dm, v, PETSC_FALSE, &starSize, &star));
18931555c271SMatthew G. Knepley     for (st = 0; st < starSize*2; st += 2) {
18941555c271SMatthew G. Knepley       const PetscInt cell = star[st];
18951555c271SMatthew G. Knepley       PetscScalar   *grad = &gradsum[coordDim*numComponents];
18961555c271SMatthew G. Knepley       PetscScalar   *x    = NULL;
18971555c271SMatthew G. Knepley       PetscReal      vol  = 0.0;
18981555c271SMatthew G. Knepley 
18991555c271SMatthew G. Knepley       if ((cell < cStart) || (cell >= cEnd)) continue;
19009566063dSJacob Faibussowitsch       PetscCall(DMPlexComputeCellGeometryFEM(dm, cell, quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
19019566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(dm, NULL, locX, cell, NULL, &x));
19021555c271SMatthew G. Knepley       for (field = 0, fieldOffset = 0; field < numFields; ++field) {
19031555c271SMatthew G. Knepley         PetscObject  obj;
19041555c271SMatthew G. Knepley         PetscClassId id;
19051555c271SMatthew G. Knepley         PetscInt     Nb, Nc, q, qc = 0;
19061555c271SMatthew G. Knepley 
19079566063dSJacob Faibussowitsch         PetscCall(PetscArrayzero(grad, coordDim*numComponents));
19089566063dSJacob Faibussowitsch         PetscCall(DMGetField(dm, field, NULL, &obj));
19099566063dSJacob Faibussowitsch         PetscCall(PetscObjectGetClassId(obj, &id));
19109566063dSJacob Faibussowitsch         if (id == PETSCFE_CLASSID)      {PetscCall(PetscFEGetNumComponents((PetscFE) obj, &Nc));PetscCall(PetscFEGetDimension((PetscFE) obj, &Nb));}
19119566063dSJacob Faibussowitsch         else if (id == PETSCFV_CLASSID) {PetscCall(PetscFVGetNumComponents((PetscFV) obj, &Nc));Nb = 1;}
191263a3b9bcSJacob Faibussowitsch         else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, field);
19131555c271SMatthew G. Knepley         for (q = 0; q < Nq; ++q) {
19142a4e142eSMatthew G. Knepley           PetscFEGeom qgeom;
19152a4e142eSMatthew G. Knepley 
19162a4e142eSMatthew G. Knepley           qgeom.dimEmbed = fegeom.dimEmbed;
19172a4e142eSMatthew G. Knepley           qgeom.J        = &fegeom.J[q*coordDim*coordDim];
19182a4e142eSMatthew G. Knepley           qgeom.invJ     = &fegeom.invJ[q*coordDim*coordDim];
19192a4e142eSMatthew G. Knepley           qgeom.detJ     = &fegeom.detJ[q];
192063a3b9bcSJacob Faibussowitsch           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], cell, q);
19219566063dSJacob Faibussowitsch           if (id == PETSCFE_CLASSID)      PetscCall(PetscFEInterpolateGradient_Static((PetscFE) obj, 1, &x[fieldOffset], &qgeom, q, interpolant));
192263a3b9bcSJacob Faibussowitsch           else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, field);
19231555c271SMatthew G. Knepley           for (fc = 0; fc < Nc; ++fc) {
192453d2db2dSJoe Wallwork             const PetscReal wt = quadWeights[q*qNc+qc];
19251555c271SMatthew G. Knepley 
19264bee2e38SMatthew G. Knepley             for (d = 0; d < coordDim; ++d) grad[fc*coordDim+d] += interpolant[fc*dim+d]*wt*fegeom.detJ[q];
19271555c271SMatthew G. Knepley           }
19284bee2e38SMatthew G. Knepley           vol += quadWeights[q*qNc]*fegeom.detJ[q];
19291555c271SMatthew G. Knepley         }
19301555c271SMatthew G. Knepley         fieldOffset += Nb;
19311555c271SMatthew G. Knepley         qc          += Nc;
19321555c271SMatthew G. Knepley       }
19339566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(dm, NULL, locX, cell, NULL, &x));
1934f8527842SMatthew G. Knepley       for (fc = 0; fc < numComponents; ++fc) {
1935f8527842SMatthew G. Knepley         for (d = 0; d < coordDim; ++d) {
1936f8527842SMatthew G. Knepley           gradsum[fc*coordDim+d] += grad[fc*coordDim+d];
1937f8527842SMatthew G. Knepley         }
1938f8527842SMatthew G. Knepley       }
1939f8527842SMatthew G. Knepley       volsum += vol;
1940db1066baSMatthew G. Knepley       if (debug) {
19419566063dSJacob Faibussowitsch         PetscCall(PetscPrintf(PETSC_COMM_SELF, "Vertex %" PetscInt_FMT " Cell %" PetscInt_FMT " gradient: [", v, cell));
19421555c271SMatthew G. Knepley         for (fc = 0; fc < numComponents; ++fc) {
19431555c271SMatthew G. Knepley           for (d = 0; d < coordDim; ++d) {
19449566063dSJacob Faibussowitsch             if (fc || d > 0) PetscCall(PetscPrintf(PETSC_COMM_SELF, ", "));
19459566063dSJacob Faibussowitsch             PetscCall(PetscPrintf(PETSC_COMM_SELF, "%g", (double)PetscRealPart(grad[fc*coordDim+d])));
19461555c271SMatthew G. Knepley           }
19471555c271SMatthew G. Knepley         }
19489566063dSJacob Faibussowitsch         PetscCall(PetscPrintf(PETSC_COMM_SELF, "]\n"));
1949db1066baSMatthew G. Knepley       }
19501555c271SMatthew G. Knepley     }
19511555c271SMatthew G. Knepley     for (fc = 0; fc < numComponents; ++fc) {
19521555c271SMatthew G. Knepley       for (d = 0; d < coordDim; ++d) gradsum[fc*coordDim+d] /= volsum;
19531555c271SMatthew G. Knepley     }
19549566063dSJacob Faibussowitsch     PetscCall(DMPlexRestoreTransitiveClosure(dm, v, PETSC_FALSE, &starSize, &star));
19559566063dSJacob Faibussowitsch     PetscCall(DMPlexVecSetClosure(dmC, NULL, locC, v, gradsum, INSERT_VALUES));
19561555c271SMatthew G. Knepley   }
19579566063dSJacob Faibussowitsch   PetscCall(PetscFree6(gradsum,interpolant,coords,fegeom.detJ,fegeom.J,fegeom.invJ));
19581555c271SMatthew G. Knepley   PetscFunctionReturn(0);
19591555c271SMatthew G. Knepley }
19601555c271SMatthew G. Knepley 
1961338f77d5SMatthew G. Knepley static PetscErrorCode DMPlexComputeIntegral_Internal(DM dm, Vec X, PetscInt cStart, PetscInt cEnd, PetscScalar *cintegral, void *user)
196273d901b8SMatthew G. Knepley {
1963338f77d5SMatthew G. Knepley   DM                 dmAux = NULL;
196461aaff12SToby Isaac   PetscDS            prob,    probAux = NULL;
196573d901b8SMatthew G. Knepley   PetscSection       section, sectionAux;
1966338f77d5SMatthew G. Knepley   Vec                locX,    locA;
1967c330f8ffSToby Isaac   PetscInt           dim, numCells = cEnd - cStart, c, f;
1968c330f8ffSToby Isaac   PetscBool          useFVM = PETSC_FALSE;
1969338f77d5SMatthew G. Knepley   /* DS */
1970338f77d5SMatthew G. Knepley   PetscInt           Nf,    totDim,    *uOff, *uOff_x, numConstants;
1971338f77d5SMatthew G. Knepley   PetscInt           NfAux, totDimAux, *aOff;
1972338f77d5SMatthew G. Knepley   PetscScalar       *u, *a;
1973338f77d5SMatthew G. Knepley   const PetscScalar *constants;
1974338f77d5SMatthew G. Knepley   /* Geometry */
1975c330f8ffSToby Isaac   PetscFEGeom       *cgeomFEM;
1976338f77d5SMatthew G. Knepley   DM                 dmGrad;
1977c330f8ffSToby Isaac   PetscQuadrature    affineQuad = NULL;
1978338f77d5SMatthew G. Knepley   Vec                cellGeometryFVM = NULL, faceGeometryFVM = NULL, locGrad = NULL;
1979b5a3613cSMatthew G. Knepley   PetscFVCellGeom   *cgeomFVM;
1980338f77d5SMatthew G. Knepley   const PetscScalar *lgrad;
1981b7260050SToby Isaac   PetscInt           maxDegree;
1982c330f8ffSToby Isaac   DMField            coordField;
1983c330f8ffSToby Isaac   IS                 cellIS;
198473d901b8SMatthew G. Knepley 
198573d901b8SMatthew G. Knepley   PetscFunctionBegin;
19869566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dm, &prob));
19879566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
19889566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
19899566063dSJacob Faibussowitsch   PetscCall(DMGetNumFields(dm, &Nf));
1990338f77d5SMatthew G. Knepley   /* Determine which discretizations we have */
1991b5a3613cSMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
1992b5a3613cSMatthew G. Knepley     PetscObject  obj;
1993b5a3613cSMatthew G. Knepley     PetscClassId id;
1994b5a3613cSMatthew G. Knepley 
19959566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, f, &obj));
19969566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
1997338f77d5SMatthew G. Knepley     if (id == PETSCFV_CLASSID) useFVM = PETSC_TRUE;
1998338f77d5SMatthew G. Knepley   }
1999338f77d5SMatthew G. Knepley   /* Get local solution with boundary values */
20009566063dSJacob Faibussowitsch   PetscCall(DMGetLocalVector(dm, &locX));
20019566063dSJacob Faibussowitsch   PetscCall(DMPlexInsertBoundaryValues(dm, PETSC_TRUE, locX, 0.0, NULL, NULL, NULL));
20029566063dSJacob Faibussowitsch   PetscCall(DMGlobalToLocalBegin(dm, X, INSERT_VALUES, locX));
20039566063dSJacob Faibussowitsch   PetscCall(DMGlobalToLocalEnd(dm, X, INSERT_VALUES, locX));
2004338f77d5SMatthew G. Knepley   /* Read DS information */
20059566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(prob, &totDim));
20069566063dSJacob Faibussowitsch   PetscCall(PetscDSGetComponentOffsets(prob, &uOff));
20079566063dSJacob Faibussowitsch   PetscCall(PetscDSGetComponentDerivativeOffsets(prob, &uOff_x));
20089566063dSJacob Faibussowitsch   PetscCall(ISCreateStride(PETSC_COMM_SELF,numCells,cStart,1,&cellIS));
20099566063dSJacob Faibussowitsch   PetscCall(PetscDSGetConstants(prob, &numConstants, &constants));
2010338f77d5SMatthew G. Knepley   /* Read Auxiliary DS information */
20119566063dSJacob Faibussowitsch   PetscCall(DMGetAuxiliaryVec(dm, NULL, 0, 0, &locA));
20129a2a23afSMatthew G. Knepley   if (locA) {
20139566063dSJacob Faibussowitsch     PetscCall(VecGetDM(locA, &dmAux));
20149566063dSJacob Faibussowitsch     PetscCall(DMGetDS(dmAux, &probAux));
20159566063dSJacob Faibussowitsch     PetscCall(PetscDSGetNumFields(probAux, &NfAux));
20169566063dSJacob Faibussowitsch     PetscCall(DMGetLocalSection(dmAux, &sectionAux));
20179566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalDimension(probAux, &totDimAux));
20189566063dSJacob Faibussowitsch     PetscCall(PetscDSGetComponentOffsets(probAux, &aOff));
2019338f77d5SMatthew G. Knepley   }
2020338f77d5SMatthew G. Knepley   /* Allocate data  arrays */
20219566063dSJacob Faibussowitsch   PetscCall(PetscCalloc1(numCells*totDim, &u));
20229566063dSJacob Faibussowitsch   if (dmAux) PetscCall(PetscMalloc1(numCells*totDimAux, &a));
2023338f77d5SMatthew G. Knepley   /* Read out geometry */
20249566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateField(dm,&coordField));
20259566063dSJacob Faibussowitsch   PetscCall(DMFieldGetDegree(coordField,cellIS,NULL,&maxDegree));
2026b7260050SToby Isaac   if (maxDegree <= 1) {
20279566063dSJacob Faibussowitsch     PetscCall(DMFieldCreateDefaultQuadrature(coordField,cellIS,&affineQuad));
2028c330f8ffSToby Isaac     if (affineQuad) {
20299566063dSJacob Faibussowitsch       PetscCall(DMFieldCreateFEGeom(coordField,cellIS,affineQuad,PETSC_FALSE,&cgeomFEM));
2030338f77d5SMatthew G. Knepley     }
2031b5a3613cSMatthew G. Knepley   }
2032b5a3613cSMatthew G. Knepley   if (useFVM) {
2033338f77d5SMatthew G. Knepley     PetscFV   fv = NULL;
2034b5a3613cSMatthew G. Knepley     Vec       grad;
2035b5a3613cSMatthew G. Knepley     PetscInt  fStart, fEnd;
2036b5a3613cSMatthew G. Knepley     PetscBool compGrad;
2037b5a3613cSMatthew G. Knepley 
2038338f77d5SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
2039338f77d5SMatthew G. Knepley       PetscObject  obj;
2040338f77d5SMatthew G. Knepley       PetscClassId id;
2041338f77d5SMatthew G. Knepley 
20429566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(prob, f, &obj));
20439566063dSJacob Faibussowitsch       PetscCall(PetscObjectGetClassId(obj, &id));
2044338f77d5SMatthew G. Knepley       if (id == PETSCFV_CLASSID) {fv = (PetscFV) obj; break;}
2045338f77d5SMatthew G. Knepley     }
20469566063dSJacob Faibussowitsch     PetscCall(PetscFVGetComputeGradients(fv, &compGrad));
20479566063dSJacob Faibussowitsch     PetscCall(PetscFVSetComputeGradients(fv, PETSC_TRUE));
20489566063dSJacob Faibussowitsch     PetscCall(DMPlexComputeGeometryFVM(dm, &cellGeometryFVM, &faceGeometryFVM));
20499566063dSJacob Faibussowitsch     PetscCall(DMPlexComputeGradientFVM(dm, fv, faceGeometryFVM, cellGeometryFVM, &dmGrad));
20509566063dSJacob Faibussowitsch     PetscCall(PetscFVSetComputeGradients(fv, compGrad));
20519566063dSJacob Faibussowitsch     PetscCall(VecGetArrayRead(cellGeometryFVM, (const PetscScalar **) &cgeomFVM));
2052b5a3613cSMatthew G. Knepley     /* Reconstruct and limit cell gradients */
20539566063dSJacob Faibussowitsch     PetscCall(DMPlexGetHeightStratum(dm, 1, &fStart, &fEnd));
20549566063dSJacob Faibussowitsch     PetscCall(DMGetGlobalVector(dmGrad, &grad));
20559566063dSJacob Faibussowitsch     PetscCall(DMPlexReconstructGradients_Internal(dm, fv, fStart, fEnd, faceGeometryFVM, cellGeometryFVM, locX, grad));
2056b5a3613cSMatthew G. Knepley     /* Communicate gradient values */
20579566063dSJacob Faibussowitsch     PetscCall(DMGetLocalVector(dmGrad, &locGrad));
20589566063dSJacob Faibussowitsch     PetscCall(DMGlobalToLocalBegin(dmGrad, grad, INSERT_VALUES, locGrad));
20599566063dSJacob Faibussowitsch     PetscCall(DMGlobalToLocalEnd(dmGrad, grad, INSERT_VALUES, locGrad));
20609566063dSJacob Faibussowitsch     PetscCall(DMRestoreGlobalVector(dmGrad, &grad));
2061b5a3613cSMatthew G. Knepley     /* Handle non-essential (e.g. outflow) boundary values */
20629566063dSJacob Faibussowitsch     PetscCall(DMPlexInsertBoundaryValues(dm, PETSC_FALSE, locX, 0.0, faceGeometryFVM, cellGeometryFVM, locGrad));
20639566063dSJacob Faibussowitsch     PetscCall(VecGetArrayRead(locGrad, &lgrad));
2064b5a3613cSMatthew G. Knepley   }
2065338f77d5SMatthew G. Knepley   /* Read out data from inputs */
206673d901b8SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
206773d901b8SMatthew G. Knepley     PetscScalar *x = NULL;
206873d901b8SMatthew G. Knepley     PetscInt     i;
206973d901b8SMatthew G. Knepley 
20709566063dSJacob Faibussowitsch     PetscCall(DMPlexVecGetClosure(dm, section, locX, c, NULL, &x));
20710f2d7e86SMatthew G. Knepley     for (i = 0; i < totDim; ++i) u[c*totDim+i] = x[i];
20729566063dSJacob Faibussowitsch     PetscCall(DMPlexVecRestoreClosure(dm, section, locX, c, NULL, &x));
207373d901b8SMatthew G. Knepley     if (dmAux) {
20749566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(dmAux, sectionAux, locA, c, NULL, &x));
20750f2d7e86SMatthew G. Knepley       for (i = 0; i < totDimAux; ++i) a[c*totDimAux+i] = x[i];
20769566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(dmAux, sectionAux, locA, c, NULL, &x));
207773d901b8SMatthew G. Knepley     }
207873d901b8SMatthew G. Knepley   }
2079338f77d5SMatthew G. Knepley   /* Do integration for each field */
208073d901b8SMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
2081c1f031eeSMatthew G. Knepley     PetscObject  obj;
2082c1f031eeSMatthew G. Knepley     PetscClassId id;
2083c1f031eeSMatthew G. Knepley     PetscInt     numChunks, numBatches, batchSize, numBlocks, blockSize, Ne, Nr, offset;
208473d901b8SMatthew G. Knepley 
20859566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, f, &obj));
20869566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
2087c1f031eeSMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
2088c1f031eeSMatthew G. Knepley       PetscFE         fe = (PetscFE) obj;
2089c1f031eeSMatthew G. Knepley       PetscQuadrature q;
2090c330f8ffSToby Isaac       PetscFEGeom     *chunkGeom = NULL;
2091c1f031eeSMatthew G. Knepley       PetscInt        Nq, Nb;
2092c1f031eeSMatthew G. Knepley 
20939566063dSJacob Faibussowitsch       PetscCall(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
20949566063dSJacob Faibussowitsch       PetscCall(PetscFEGetQuadrature(fe, &q));
20959566063dSJacob Faibussowitsch       PetscCall(PetscQuadratureGetData(q, NULL, NULL, &Nq, NULL, NULL));
20969566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDimension(fe, &Nb));
2097c1f031eeSMatthew G. Knepley       blockSize = Nb*Nq;
209873d901b8SMatthew G. Knepley       batchSize = numBlocks * blockSize;
20999566063dSJacob Faibussowitsch       PetscCall(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
210073d901b8SMatthew G. Knepley       numChunks = numCells / (numBatches*batchSize);
210173d901b8SMatthew G. Knepley       Ne        = numChunks*numBatches*batchSize;
210273d901b8SMatthew G. Knepley       Nr        = numCells % (numBatches*batchSize);
210373d901b8SMatthew G. Knepley       offset    = numCells - Nr;
2104c330f8ffSToby Isaac       if (!affineQuad) {
21059566063dSJacob Faibussowitsch         PetscCall(DMFieldCreateFEGeom(coordField,cellIS,q,PETSC_FALSE,&cgeomFEM));
2106c330f8ffSToby Isaac       }
21079566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomGetChunk(cgeomFEM,0,offset,&chunkGeom));
21089566063dSJacob Faibussowitsch       PetscCall(PetscFEIntegrate(prob, f, Ne, chunkGeom, u, probAux, a, cintegral));
21099566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomGetChunk(cgeomFEM,offset,numCells,&chunkGeom));
21109566063dSJacob Faibussowitsch       PetscCall(PetscFEIntegrate(prob, f, Nr, chunkGeom, &u[offset*totDim], probAux, &a[offset*totDimAux], &cintegral[offset*Nf]));
21119566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomRestoreChunk(cgeomFEM,offset,numCells,&chunkGeom));
2112c330f8ffSToby Isaac       if (!affineQuad) {
21139566063dSJacob Faibussowitsch         PetscCall(PetscFEGeomDestroy(&cgeomFEM));
2114c330f8ffSToby Isaac       }
2115c1f031eeSMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
2116c1f031eeSMatthew G. Knepley       PetscInt       foff;
2117420e96edSMatthew G. Knepley       PetscPointFunc obj_func;
2118b69edc29SMatthew G. Knepley       PetscScalar    lint;
2119c1f031eeSMatthew G. Knepley 
21209566063dSJacob Faibussowitsch       PetscCall(PetscDSGetObjective(prob, f, &obj_func));
21219566063dSJacob Faibussowitsch       PetscCall(PetscDSGetFieldOffset(prob, f, &foff));
2122c1f031eeSMatthew G. Knepley       if (obj_func) {
2123c1f031eeSMatthew G. Knepley         for (c = 0; c < numCells; ++c) {
2124b5a3613cSMatthew G. Knepley           PetscScalar *u_x;
2125b5a3613cSMatthew G. Knepley 
21269566063dSJacob Faibussowitsch           PetscCall(DMPlexPointLocalRead(dmGrad, c, lgrad, &u_x));
2127338f77d5SMatthew 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);
2128338f77d5SMatthew G. Knepley           cintegral[c*Nf+f] += PetscRealPart(lint)*cgeomFVM[c].volume;
212973d901b8SMatthew G. Knepley         }
2130c1f031eeSMatthew G. Knepley       }
213163a3b9bcSJacob Faibussowitsch     } else SETERRQ(PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, f);
2132c1f031eeSMatthew G. Knepley   }
2133338f77d5SMatthew G. Knepley   /* Cleanup data arrays */
2134b5a3613cSMatthew G. Knepley   if (useFVM) {
21359566063dSJacob Faibussowitsch     PetscCall(VecRestoreArrayRead(locGrad, &lgrad));
21369566063dSJacob Faibussowitsch     PetscCall(VecRestoreArrayRead(cellGeometryFVM, (const PetscScalar **) &cgeomFVM));
21379566063dSJacob Faibussowitsch     PetscCall(DMRestoreLocalVector(dmGrad, &locGrad));
21389566063dSJacob Faibussowitsch     PetscCall(VecDestroy(&faceGeometryFVM));
21399566063dSJacob Faibussowitsch     PetscCall(VecDestroy(&cellGeometryFVM));
21409566063dSJacob Faibussowitsch     PetscCall(DMDestroy(&dmGrad));
2141b5a3613cSMatthew G. Knepley   }
21429566063dSJacob Faibussowitsch   if (dmAux) PetscCall(PetscFree(a));
21439566063dSJacob Faibussowitsch   PetscCall(PetscFree(u));
2144338f77d5SMatthew G. Knepley   /* Cleanup */
2145f99c8401SToby Isaac   if (affineQuad) {
21469566063dSJacob Faibussowitsch     PetscCall(PetscFEGeomDestroy(&cgeomFEM));
2147f99c8401SToby Isaac   }
21489566063dSJacob Faibussowitsch   PetscCall(PetscQuadratureDestroy(&affineQuad));
21499566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&cellIS));
21509566063dSJacob Faibussowitsch   PetscCall(DMRestoreLocalVector(dm, &locX));
2151338f77d5SMatthew G. Knepley   PetscFunctionReturn(0);
2152338f77d5SMatthew G. Knepley }
2153338f77d5SMatthew G. Knepley 
2154338f77d5SMatthew G. Knepley /*@
2155338f77d5SMatthew G. Knepley   DMPlexComputeIntegralFEM - Form the integral over the domain from the global input X using pointwise functions specified by the user
2156338f77d5SMatthew G. Knepley 
2157338f77d5SMatthew G. Knepley   Input Parameters:
2158338f77d5SMatthew G. Knepley + dm - The mesh
2159338f77d5SMatthew G. Knepley . X  - Global input vector
2160338f77d5SMatthew G. Knepley - user - The user context
2161338f77d5SMatthew G. Knepley 
2162338f77d5SMatthew G. Knepley   Output Parameter:
2163338f77d5SMatthew G. Knepley . integral - Integral for each field
2164338f77d5SMatthew G. Knepley 
2165338f77d5SMatthew G. Knepley   Level: developer
2166338f77d5SMatthew G. Knepley 
2167db781477SPatrick Sanan .seealso: `DMPlexSNESComputeResidualFEM()`
2168338f77d5SMatthew G. Knepley @*/
2169b8feb594SMatthew G. Knepley PetscErrorCode DMPlexComputeIntegralFEM(DM dm, Vec X, PetscScalar *integral, void *user)
2170338f77d5SMatthew G. Knepley {
2171338f77d5SMatthew G. Knepley   DM_Plex       *mesh = (DM_Plex *) dm->data;
2172b8feb594SMatthew G. Knepley   PetscScalar   *cintegral, *lintegral;
2173412e9a14SMatthew G. Knepley   PetscInt       Nf, f, cellHeight, cStart, cEnd, cell;
2174338f77d5SMatthew G. Knepley 
2175338f77d5SMatthew G. Knepley   PetscFunctionBegin;
2176338f77d5SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
2177338f77d5SMatthew G. Knepley   PetscValidHeaderSpecific(X, VEC_CLASSID, 2);
2178dadcf809SJacob Faibussowitsch   PetscValidScalarPointer(integral, 3);
21799566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_IntegralFEM,dm,0,0,0));
21809566063dSJacob Faibussowitsch   PetscCall(DMGetNumFields(dm, &Nf));
21819566063dSJacob Faibussowitsch   PetscCall(DMPlexGetVTKCellHeight(dm, &cellHeight));
21829566063dSJacob Faibussowitsch   PetscCall(DMPlexGetSimplexOrBoxCells(dm, cellHeight, &cStart, &cEnd));
2183338f77d5SMatthew G. Knepley   /* TODO Introduce a loop over large chunks (right now this is a single chunk) */
21849566063dSJacob Faibussowitsch   PetscCall(PetscCalloc2(Nf, &lintegral, (cEnd-cStart)*Nf, &cintegral));
21859566063dSJacob Faibussowitsch   PetscCall(DMPlexComputeIntegral_Internal(dm, X, cStart, cEnd, cintegral, user));
2186338f77d5SMatthew G. Knepley   /* Sum up values */
2187338f77d5SMatthew G. Knepley   for (cell = cStart; cell < cEnd; ++cell) {
2188338f77d5SMatthew G. Knepley     const PetscInt c = cell - cStart;
2189338f77d5SMatthew G. Knepley 
21909566063dSJacob Faibussowitsch     if (mesh->printFEM > 1) PetscCall(DMPrintCellVector(cell, "Cell Integral", Nf, &cintegral[c*Nf]));
2191b8feb594SMatthew G. Knepley     for (f = 0; f < Nf; ++f) lintegral[f] += cintegral[c*Nf+f];
2192338f77d5SMatthew G. Knepley   }
21931c2dc1cbSBarry Smith   PetscCall(MPIU_Allreduce(lintegral, integral, Nf, MPIU_SCALAR, MPIU_SUM, PetscObjectComm((PetscObject) dm)));
219473d901b8SMatthew G. Knepley   if (mesh->printFEM) {
21959566063dSJacob Faibussowitsch     PetscCall(PetscPrintf(PetscObjectComm((PetscObject) dm), "Integral:"));
21969566063dSJacob Faibussowitsch     for (f = 0; f < Nf; ++f) PetscCall(PetscPrintf(PetscObjectComm((PetscObject) dm), " %g", (double) PetscRealPart(integral[f])));
21979566063dSJacob Faibussowitsch     PetscCall(PetscPrintf(PetscObjectComm((PetscObject) dm), "\n"));
219873d901b8SMatthew G. Knepley   }
21999566063dSJacob Faibussowitsch   PetscCall(PetscFree2(lintegral, cintegral));
22009566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_IntegralFEM,dm,0,0,0));
2201338f77d5SMatthew G. Knepley   PetscFunctionReturn(0);
2202338f77d5SMatthew G. Knepley }
2203338f77d5SMatthew G. Knepley 
2204338f77d5SMatthew G. Knepley /*@
2205338f77d5SMatthew G. Knepley   DMPlexComputeCellwiseIntegralFEM - Form the vector of cellwise integrals F from the global input X using pointwise functions specified by the user
2206338f77d5SMatthew G. Knepley 
2207338f77d5SMatthew G. Knepley   Input Parameters:
2208338f77d5SMatthew G. Knepley + dm - The mesh
2209338f77d5SMatthew G. Knepley . X  - Global input vector
2210338f77d5SMatthew G. Knepley - user - The user context
2211338f77d5SMatthew G. Knepley 
2212338f77d5SMatthew G. Knepley   Output Parameter:
2213338f77d5SMatthew G. Knepley . integral - Cellwise integrals for each field
2214338f77d5SMatthew G. Knepley 
2215338f77d5SMatthew G. Knepley   Level: developer
2216338f77d5SMatthew G. Knepley 
2217db781477SPatrick Sanan .seealso: `DMPlexSNESComputeResidualFEM()`
2218338f77d5SMatthew G. Knepley @*/
2219338f77d5SMatthew G. Knepley PetscErrorCode DMPlexComputeCellwiseIntegralFEM(DM dm, Vec X, Vec F, void *user)
2220338f77d5SMatthew G. Knepley {
2221338f77d5SMatthew G. Knepley   DM_Plex       *mesh = (DM_Plex *) dm->data;
2222338f77d5SMatthew G. Knepley   DM             dmF;
2223338f77d5SMatthew G. Knepley   PetscSection   sectionF;
2224338f77d5SMatthew G. Knepley   PetscScalar   *cintegral, *af;
2225412e9a14SMatthew G. Knepley   PetscInt       Nf, f, cellHeight, cStart, cEnd, cell;
2226338f77d5SMatthew G. Knepley 
2227338f77d5SMatthew G. Knepley   PetscFunctionBegin;
2228338f77d5SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
2229338f77d5SMatthew G. Knepley   PetscValidHeaderSpecific(X, VEC_CLASSID, 2);
2230338f77d5SMatthew G. Knepley   PetscValidHeaderSpecific(F, VEC_CLASSID, 3);
22319566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_IntegralFEM,dm,0,0,0));
22329566063dSJacob Faibussowitsch   PetscCall(DMGetNumFields(dm, &Nf));
22339566063dSJacob Faibussowitsch   PetscCall(DMPlexGetVTKCellHeight(dm, &cellHeight));
22349566063dSJacob Faibussowitsch   PetscCall(DMPlexGetSimplexOrBoxCells(dm, cellHeight, &cStart, &cEnd));
2235338f77d5SMatthew G. Knepley   /* TODO Introduce a loop over large chunks (right now this is a single chunk) */
22369566063dSJacob Faibussowitsch   PetscCall(PetscCalloc1((cEnd-cStart)*Nf, &cintegral));
22379566063dSJacob Faibussowitsch   PetscCall(DMPlexComputeIntegral_Internal(dm, X, cStart, cEnd, cintegral, user));
2238338f77d5SMatthew G. Knepley   /* Put values in F*/
22399566063dSJacob Faibussowitsch   PetscCall(VecGetDM(F, &dmF));
22409566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dmF, &sectionF));
22419566063dSJacob Faibussowitsch   PetscCall(VecGetArray(F, &af));
2242338f77d5SMatthew G. Knepley   for (cell = cStart; cell < cEnd; ++cell) {
2243338f77d5SMatthew G. Knepley     const PetscInt c = cell - cStart;
2244338f77d5SMatthew G. Knepley     PetscInt       dof, off;
2245338f77d5SMatthew G. Knepley 
22469566063dSJacob Faibussowitsch     if (mesh->printFEM > 1) PetscCall(DMPrintCellVector(cell, "Cell Integral", Nf, &cintegral[c*Nf]));
22479566063dSJacob Faibussowitsch     PetscCall(PetscSectionGetDof(sectionF, cell, &dof));
22489566063dSJacob Faibussowitsch     PetscCall(PetscSectionGetOffset(sectionF, cell, &off));
224963a3b9bcSJacob Faibussowitsch     PetscCheck(dof == Nf,PETSC_COMM_SELF, PETSC_ERR_ARG_SIZ, "The number of cell dofs %" PetscInt_FMT " != %" PetscInt_FMT, dof, Nf);
2250338f77d5SMatthew G. Knepley     for (f = 0; f < Nf; ++f) af[off+f] = cintegral[c*Nf+f];
2251338f77d5SMatthew G. Knepley   }
22529566063dSJacob Faibussowitsch   PetscCall(VecRestoreArray(F, &af));
22539566063dSJacob Faibussowitsch   PetscCall(PetscFree(cintegral));
22549566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_IntegralFEM,dm,0,0,0));
225573d901b8SMatthew G. Knepley   PetscFunctionReturn(0);
225673d901b8SMatthew G. Knepley }
225773d901b8SMatthew G. Knepley 
22589b6f715bSMatthew G. Knepley static PetscErrorCode DMPlexComputeBdIntegral_Internal(DM dm, Vec locX, IS pointIS,
22599b6f715bSMatthew G. Knepley                                                        void (*func)(PetscInt, PetscInt, PetscInt,
226064c72086SMatthew G. Knepley                                                                     const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
226164c72086SMatthew G. Knepley                                                                     const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
226264c72086SMatthew G. Knepley                                                                     PetscReal, const PetscReal[], const PetscReal[], PetscInt, const PetscScalar[], PetscScalar[]),
226364c72086SMatthew G. Knepley                                                        PetscScalar *fintegral, void *user)
226464c72086SMatthew G. Knepley {
22659b6f715bSMatthew G. Knepley   DM                 plex = NULL, plexA = NULL;
2266a6e0b375SMatthew G. Knepley   DMEnclosureType    encAux;
22679b6f715bSMatthew G. Knepley   PetscDS            prob, probAux = NULL;
22689b6f715bSMatthew G. Knepley   PetscSection       section, sectionAux = NULL;
22699b6f715bSMatthew G. Knepley   Vec                locA = NULL;
22709b6f715bSMatthew G. Knepley   DMField            coordField;
22719b6f715bSMatthew G. Knepley   PetscInt           Nf,        totDim,        *uOff, *uOff_x;
22729b6f715bSMatthew G. Knepley   PetscInt           NfAux = 0, totDimAux = 0, *aOff = NULL;
22739b6f715bSMatthew G. Knepley   PetscScalar       *u, *a = NULL;
227464c72086SMatthew G. Knepley   const PetscScalar *constants;
22759b6f715bSMatthew G. Knepley   PetscInt           numConstants, f;
227664c72086SMatthew G. Knepley 
227764c72086SMatthew G. Knepley   PetscFunctionBegin;
22789566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateField(dm, &coordField));
22799566063dSJacob Faibussowitsch   PetscCall(DMConvert(dm, DMPLEX, &plex));
22809566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dm, &prob));
22819566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
22829566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetNumFields(section, &Nf));
228364c72086SMatthew G. Knepley   /* Determine which discretizations we have */
22849b6f715bSMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
228564c72086SMatthew G. Knepley     PetscObject  obj;
228664c72086SMatthew G. Knepley     PetscClassId id;
228764c72086SMatthew G. Knepley 
22889566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, f, &obj));
22899566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
229063a3b9bcSJacob Faibussowitsch     PetscCheck(id != PETSCFV_CLASSID,PetscObjectComm((PetscObject) dm), PETSC_ERR_SUP, "Not supported for FVM (field %" PetscInt_FMT ")", f);
229164c72086SMatthew G. Knepley   }
229264c72086SMatthew G. Knepley   /* Read DS information */
22939566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(prob, &totDim));
22949566063dSJacob Faibussowitsch   PetscCall(PetscDSGetComponentOffsets(prob, &uOff));
22959566063dSJacob Faibussowitsch   PetscCall(PetscDSGetComponentDerivativeOffsets(prob, &uOff_x));
22969566063dSJacob Faibussowitsch   PetscCall(PetscDSGetConstants(prob, &numConstants, &constants));
229764c72086SMatthew G. Knepley   /* Read Auxiliary DS information */
22989566063dSJacob Faibussowitsch   PetscCall(DMGetAuxiliaryVec(dm, NULL, 0, 0, &locA));
22999b6f715bSMatthew G. Knepley   if (locA) {
23009b6f715bSMatthew G. Knepley     DM dmAux;
23019b6f715bSMatthew G. Knepley 
23029566063dSJacob Faibussowitsch     PetscCall(VecGetDM(locA, &dmAux));
23039566063dSJacob Faibussowitsch     PetscCall(DMGetEnclosureRelation(dmAux, dm, &encAux));
23049566063dSJacob Faibussowitsch     PetscCall(DMConvert(dmAux, DMPLEX, &plexA));
23059566063dSJacob Faibussowitsch     PetscCall(DMGetDS(dmAux, &probAux));
23069566063dSJacob Faibussowitsch     PetscCall(PetscDSGetNumFields(probAux, &NfAux));
23079566063dSJacob Faibussowitsch     PetscCall(DMGetLocalSection(dmAux, &sectionAux));
23089566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalDimension(probAux, &totDimAux));
23099566063dSJacob Faibussowitsch     PetscCall(PetscDSGetComponentOffsets(probAux, &aOff));
231064c72086SMatthew G. Knepley   }
23119b6f715bSMatthew G. Knepley   /* Integrate over points */
23129b6f715bSMatthew G. Knepley   {
23139b6f715bSMatthew G. Knepley     PetscFEGeom    *fgeom, *chunkGeom = NULL;
2314b7260050SToby Isaac     PetscInt        maxDegree;
23159b6f715bSMatthew G. Knepley     PetscQuadrature qGeom = NULL;
23169b6f715bSMatthew G. Knepley     const PetscInt *points;
23179b6f715bSMatthew G. Knepley     PetscInt        numFaces, face, Nq, field;
23189b6f715bSMatthew G. Knepley     PetscInt        numChunks, chunkSize, chunk, Nr, offset;
231964c72086SMatthew G. Knepley 
23209566063dSJacob Faibussowitsch     PetscCall(ISGetLocalSize(pointIS, &numFaces));
23219566063dSJacob Faibussowitsch     PetscCall(ISGetIndices(pointIS, &points));
23229566063dSJacob Faibussowitsch     PetscCall(PetscCalloc2(numFaces*totDim, &u, locA ? numFaces*totDimAux : 0, &a));
23239566063dSJacob Faibussowitsch     PetscCall(DMFieldGetDegree(coordField, pointIS, NULL, &maxDegree));
232464c72086SMatthew G. Knepley     for (field = 0; field < Nf; ++field) {
232564c72086SMatthew G. Knepley       PetscFE fe;
232664c72086SMatthew G. Knepley 
23279566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(prob, field, (PetscObject *) &fe));
23289566063dSJacob Faibussowitsch       if (maxDegree <= 1) PetscCall(DMFieldCreateDefaultQuadrature(coordField, pointIS, &qGeom));
23299b6f715bSMatthew G. Knepley       if (!qGeom) {
23309566063dSJacob Faibussowitsch         PetscCall(PetscFEGetFaceQuadrature(fe, &qGeom));
23319566063dSJacob Faibussowitsch         PetscCall(PetscObjectReference((PetscObject) qGeom));
23329b6f715bSMatthew G. Knepley       }
23339566063dSJacob Faibussowitsch       PetscCall(PetscQuadratureGetData(qGeom, NULL, NULL, &Nq, NULL, NULL));
23349566063dSJacob Faibussowitsch       PetscCall(DMPlexGetFEGeom(coordField, pointIS, qGeom, PETSC_TRUE, &fgeom));
23359b6f715bSMatthew G. Knepley       for (face = 0; face < numFaces; ++face) {
2336f15274beSMatthew Knepley         const PetscInt point = points[face], *support;
23379b6f715bSMatthew G. Knepley         PetscScalar    *x    = NULL;
2338f15274beSMatthew Knepley         PetscInt       i;
23399b6f715bSMatthew G. Knepley 
23409566063dSJacob Faibussowitsch         PetscCall(DMPlexGetSupport(dm, point, &support));
23419566063dSJacob Faibussowitsch         PetscCall(DMPlexVecGetClosure(plex, section, locX, support[0], NULL, &x));
23429b6f715bSMatthew G. Knepley         for (i = 0; i < totDim; ++i) u[face*totDim+i] = x[i];
23439566063dSJacob Faibussowitsch         PetscCall(DMPlexVecRestoreClosure(plex, section, locX, support[0], NULL, &x));
23449b6f715bSMatthew G. Knepley         if (locA) {
23459b6f715bSMatthew G. Knepley           PetscInt subp;
23469566063dSJacob Faibussowitsch           PetscCall(DMGetEnclosurePoint(plexA, dm, encAux, support[0], &subp));
23479566063dSJacob Faibussowitsch           PetscCall(DMPlexVecGetClosure(plexA, sectionAux, locA, subp, NULL, &x));
23489b6f715bSMatthew G. Knepley           for (i = 0; i < totDimAux; ++i) a[f*totDimAux+i] = x[i];
23499566063dSJacob Faibussowitsch           PetscCall(DMPlexVecRestoreClosure(plexA, sectionAux, locA, subp, NULL, &x));
23509b6f715bSMatthew G. Knepley         }
23519b6f715bSMatthew G. Knepley       }
23529b6f715bSMatthew G. Knepley       /* Get blocking */
23539b6f715bSMatthew G. Knepley       {
23549b6f715bSMatthew G. Knepley         PetscQuadrature q;
23559b6f715bSMatthew G. Knepley         PetscInt        numBatches, batchSize, numBlocks, blockSize;
23569b6f715bSMatthew G. Knepley         PetscInt        Nq, Nb;
23579b6f715bSMatthew G. Knepley 
23589566063dSJacob Faibussowitsch         PetscCall(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
23599566063dSJacob Faibussowitsch         PetscCall(PetscFEGetQuadrature(fe, &q));
23609566063dSJacob Faibussowitsch         PetscCall(PetscQuadratureGetData(q, NULL, NULL, &Nq, NULL, NULL));
23619566063dSJacob Faibussowitsch         PetscCall(PetscFEGetDimension(fe, &Nb));
236264c72086SMatthew G. Knepley         blockSize = Nb*Nq;
236364c72086SMatthew G. Knepley         batchSize = numBlocks * blockSize;
23649b6f715bSMatthew G. Knepley         chunkSize = numBatches*batchSize;
23659566063dSJacob Faibussowitsch         PetscCall(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
23669b6f715bSMatthew G. Knepley         numChunks = numFaces / chunkSize;
23679b6f715bSMatthew G. Knepley         Nr        = numFaces % chunkSize;
236864c72086SMatthew G. Knepley         offset    = numFaces - Nr;
236964c72086SMatthew G. Knepley       }
23709b6f715bSMatthew G. Knepley       /* Do integration for each field */
23719b6f715bSMatthew G. Knepley       for (chunk = 0; chunk < numChunks; ++chunk) {
23729566063dSJacob Faibussowitsch         PetscCall(PetscFEGeomGetChunk(fgeom, chunk*chunkSize, (chunk+1)*chunkSize, &chunkGeom));
23739566063dSJacob Faibussowitsch         PetscCall(PetscFEIntegrateBd(prob, field, func, chunkSize, chunkGeom, u, probAux, a, fintegral));
23749566063dSJacob Faibussowitsch         PetscCall(PetscFEGeomRestoreChunk(fgeom, 0, offset, &chunkGeom));
237564c72086SMatthew G. Knepley       }
23769566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomGetChunk(fgeom, offset, numFaces, &chunkGeom));
23779566063dSJacob Faibussowitsch       PetscCall(PetscFEIntegrateBd(prob, field, func, Nr, chunkGeom, &u[offset*totDim], probAux, a ? &a[offset*totDimAux] : NULL, &fintegral[offset*Nf]));
23789566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomRestoreChunk(fgeom, offset, numFaces, &chunkGeom));
237964c72086SMatthew G. Knepley       /* Cleanup data arrays */
23809566063dSJacob Faibussowitsch       PetscCall(DMPlexRestoreFEGeom(coordField, pointIS, qGeom, PETSC_TRUE, &fgeom));
23819566063dSJacob Faibussowitsch       PetscCall(PetscQuadratureDestroy(&qGeom));
23829566063dSJacob Faibussowitsch       PetscCall(PetscFree2(u, a));
23839566063dSJacob Faibussowitsch       PetscCall(ISRestoreIndices(pointIS, &points));
238464c72086SMatthew G. Knepley     }
238564c72086SMatthew G. Knepley   }
23869566063dSJacob Faibussowitsch   if (plex)  PetscCall(DMDestroy(&plex));
23879566063dSJacob Faibussowitsch   if (plexA) PetscCall(DMDestroy(&plexA));
23889b6f715bSMatthew G. Knepley   PetscFunctionReturn(0);
23899b6f715bSMatthew G. Knepley }
23909b6f715bSMatthew G. Knepley 
23919b6f715bSMatthew G. Knepley /*@
23929b6f715bSMatthew G. Knepley   DMPlexComputeBdIntegral - Form the integral over the specified boundary from the global input X using pointwise functions specified by the user
23939b6f715bSMatthew G. Knepley 
23949b6f715bSMatthew G. Knepley   Input Parameters:
23959b6f715bSMatthew G. Knepley + dm      - The mesh
23969b6f715bSMatthew G. Knepley . X       - Global input vector
23979b6f715bSMatthew G. Knepley . label   - The boundary DMLabel
23989b6f715bSMatthew G. Knepley . numVals - The number of label values to use, or PETSC_DETERMINE for all values
23999b6f715bSMatthew G. Knepley . vals    - The label values to use, or PETSC_NULL for all values
240067b8a455SSatish Balay . func    - The function to integrate along the boundary
24019b6f715bSMatthew G. Knepley - user    - The user context
24029b6f715bSMatthew G. Knepley 
24039b6f715bSMatthew G. Knepley   Output Parameter:
24049b6f715bSMatthew G. Knepley . integral - Integral for each field
24059b6f715bSMatthew G. Knepley 
24069b6f715bSMatthew G. Knepley   Level: developer
24079b6f715bSMatthew G. Knepley 
2408db781477SPatrick Sanan .seealso: `DMPlexComputeIntegralFEM()`, `DMPlexComputeBdResidualFEM()`
24099b6f715bSMatthew G. Knepley @*/
24109b6f715bSMatthew G. Knepley PetscErrorCode DMPlexComputeBdIntegral(DM dm, Vec X, DMLabel label, PetscInt numVals, const PetscInt vals[],
24119b6f715bSMatthew G. Knepley                                        void (*func)(PetscInt, PetscInt, PetscInt,
24129b6f715bSMatthew G. Knepley                                                     const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
24139b6f715bSMatthew G. Knepley                                                     const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
24149b6f715bSMatthew G. Knepley                                                     PetscReal, const PetscReal[], const PetscReal[], PetscInt, const PetscScalar[], PetscScalar[]),
24159b6f715bSMatthew G. Knepley                                        PetscScalar *integral, void *user)
24169b6f715bSMatthew G. Knepley {
24179b6f715bSMatthew G. Knepley   Vec            locX;
24189b6f715bSMatthew G. Knepley   PetscSection   section;
24199b6f715bSMatthew G. Knepley   DMLabel        depthLabel;
24209b6f715bSMatthew G. Knepley   IS             facetIS;
24219b6f715bSMatthew G. Knepley   PetscInt       dim, Nf, f, v;
24229b6f715bSMatthew G. Knepley 
24239b6f715bSMatthew G. Knepley   PetscFunctionBegin;
24249b6f715bSMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
24259b6f715bSMatthew G. Knepley   PetscValidHeaderSpecific(X, VEC_CLASSID, 2);
24269b6f715bSMatthew G. Knepley   PetscValidPointer(label, 3);
2427dadcf809SJacob Faibussowitsch   if (vals) PetscValidIntPointer(vals, 5);
2428dadcf809SJacob Faibussowitsch   PetscValidScalarPointer(integral, 7);
24299566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_IntegralFEM,dm,0,0,0));
24309566063dSJacob Faibussowitsch   PetscCall(DMPlexGetDepthLabel(dm, &depthLabel));
24319566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
24329566063dSJacob Faibussowitsch   PetscCall(DMLabelGetStratumIS(depthLabel, dim-1, &facetIS));
24339566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
24349566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetNumFields(section, &Nf));
24359b6f715bSMatthew G. Knepley   /* Get local solution with boundary values */
24369566063dSJacob Faibussowitsch   PetscCall(DMGetLocalVector(dm, &locX));
24379566063dSJacob Faibussowitsch   PetscCall(DMPlexInsertBoundaryValues(dm, PETSC_TRUE, locX, 0.0, NULL, NULL, NULL));
24389566063dSJacob Faibussowitsch   PetscCall(DMGlobalToLocalBegin(dm, X, INSERT_VALUES, locX));
24399566063dSJacob Faibussowitsch   PetscCall(DMGlobalToLocalEnd(dm, X, INSERT_VALUES, locX));
24409b6f715bSMatthew G. Knepley   /* Loop over label values */
24419566063dSJacob Faibussowitsch   PetscCall(PetscArrayzero(integral, Nf));
24429b6f715bSMatthew G. Knepley   for (v = 0; v < numVals; ++v) {
24439b6f715bSMatthew G. Knepley     IS           pointIS;
24449b6f715bSMatthew G. Knepley     PetscInt     numFaces, face;
24459b6f715bSMatthew G. Knepley     PetscScalar *fintegral;
24469b6f715bSMatthew G. Knepley 
24479566063dSJacob Faibussowitsch     PetscCall(DMLabelGetStratumIS(label, vals[v], &pointIS));
24489b6f715bSMatthew G. Knepley     if (!pointIS) continue; /* No points with that id on this process */
24499b6f715bSMatthew G. Knepley     {
24509b6f715bSMatthew G. Knepley       IS isectIS;
24519b6f715bSMatthew G. Knepley 
24529b6f715bSMatthew G. Knepley       /* TODO: Special cases of ISIntersect where it is quick to check a priori if one is a superset of the other */
24539566063dSJacob Faibussowitsch       PetscCall(ISIntersect_Caching_Internal(facetIS, pointIS, &isectIS));
24549566063dSJacob Faibussowitsch       PetscCall(ISDestroy(&pointIS));
24559b6f715bSMatthew G. Knepley       pointIS = isectIS;
24569b6f715bSMatthew G. Knepley     }
24579566063dSJacob Faibussowitsch     PetscCall(ISGetLocalSize(pointIS, &numFaces));
24589566063dSJacob Faibussowitsch     PetscCall(PetscCalloc1(numFaces*Nf, &fintegral));
24599566063dSJacob Faibussowitsch     PetscCall(DMPlexComputeBdIntegral_Internal(dm, locX, pointIS, func, fintegral, user));
24609b6f715bSMatthew G. Knepley     /* Sum point contributions into integral */
24619b6f715bSMatthew G. Knepley     for (f = 0; f < Nf; ++f) for (face = 0; face < numFaces; ++face) integral[f] += fintegral[face*Nf+f];
24629566063dSJacob Faibussowitsch     PetscCall(PetscFree(fintegral));
24639566063dSJacob Faibussowitsch     PetscCall(ISDestroy(&pointIS));
24649b6f715bSMatthew G. Knepley   }
24659566063dSJacob Faibussowitsch   PetscCall(DMRestoreLocalVector(dm, &locX));
24669566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&facetIS));
24679566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_IntegralFEM,dm,0,0,0));
246864c72086SMatthew G. Knepley   PetscFunctionReturn(0);
246964c72086SMatthew G. Knepley }
247064c72086SMatthew G. Knepley 
2471d69c5d34SMatthew G. Knepley /*@
2472cf51de39SMatthew G. Knepley   DMPlexComputeInterpolatorNested - Form the local portion of the interpolation matrix I from the coarse DM to a uniformly refined DM.
2473d69c5d34SMatthew G. Knepley 
2474d69c5d34SMatthew G. Knepley   Input Parameters:
2475cf51de39SMatthew G. Knepley + dmc  - The coarse mesh
2476cf51de39SMatthew G. Knepley . dmf  - The fine mesh
2477cf51de39SMatthew G. Knepley . isRefined - Flag indicating regular refinement, rather than the same topology
2478d69c5d34SMatthew G. Knepley - user - The user context
2479d69c5d34SMatthew G. Knepley 
2480d69c5d34SMatthew G. Knepley   Output Parameter:
2481934789fcSMatthew G. Knepley . In  - The interpolation matrix
2482d69c5d34SMatthew G. Knepley 
2483d69c5d34SMatthew G. Knepley   Level: developer
2484d69c5d34SMatthew G. Knepley 
2485db781477SPatrick Sanan .seealso: `DMPlexComputeInterpolatorGeneral()`, `DMPlexComputeJacobianFEM()`
2486d69c5d34SMatthew G. Knepley @*/
2487cf51de39SMatthew G. Knepley PetscErrorCode DMPlexComputeInterpolatorNested(DM dmc, DM dmf, PetscBool isRefined, Mat In, void *user)
2488d69c5d34SMatthew G. Knepley {
2489d69c5d34SMatthew G. Knepley   DM_Plex     *mesh  = (DM_Plex *) dmc->data;
2490d69c5d34SMatthew G. Knepley   const char  *name  = "Interpolator";
2491d69c5d34SMatthew G. Knepley   PetscFE     *feRef;
249297c42addSMatthew G. Knepley   PetscFV     *fvRef;
2493d69c5d34SMatthew G. Knepley   PetscSection fsection, fglobalSection;
2494d69c5d34SMatthew G. Knepley   PetscSection csection, cglobalSection;
2495d69c5d34SMatthew G. Knepley   PetscScalar *elemMat;
2496485ad865SMatthew G. Knepley   PetscInt     dim, Nf, f, fieldI, fieldJ, offsetI, offsetJ, cStart, cEnd, c;
24972ea9c922SToby Isaac   PetscInt     cTotDim = 0, rTotDim = 0;
2498d69c5d34SMatthew G. Knepley 
2499d69c5d34SMatthew G. Knepley   PetscFunctionBegin;
25009566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_InterpolatorFEM,dmc,dmf,0,0));
25019566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dmf, &dim));
25029566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dmf, &fsection));
25039566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dmf, &fglobalSection));
25049566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dmc, &csection));
25059566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dmc, &cglobalSection));
25069566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetNumFields(fsection, &Nf));
25079566063dSJacob Faibussowitsch   PetscCall(DMPlexGetSimplexOrBoxCells(dmc, 0, &cStart, &cEnd));
25089566063dSJacob Faibussowitsch   PetscCall(PetscCalloc2(Nf, &feRef, Nf, &fvRef));
2509d69c5d34SMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
25102ea9c922SToby Isaac     PetscObject  obj, objc;
25112ea9c922SToby Isaac     PetscClassId id, idc;
25122ea9c922SToby Isaac     PetscInt     rNb = 0, Nc = 0, cNb = 0;
2513d69c5d34SMatthew G. Knepley 
25149566063dSJacob Faibussowitsch     PetscCall(DMGetField(dmf, f, NULL, &obj));
25159566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
251697c42addSMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
251797c42addSMatthew G. Knepley       PetscFE fe = (PetscFE) obj;
251897c42addSMatthew G. Knepley 
2519cf51de39SMatthew G. Knepley       if (isRefined) {
25209566063dSJacob Faibussowitsch         PetscCall(PetscFERefine(fe, &feRef[f]));
2521cf51de39SMatthew G. Knepley       } else {
25229566063dSJacob Faibussowitsch         PetscCall(PetscObjectReference((PetscObject) fe));
2523cf51de39SMatthew G. Knepley         feRef[f] = fe;
2524cf51de39SMatthew G. Knepley       }
25259566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDimension(feRef[f], &rNb));
25269566063dSJacob Faibussowitsch       PetscCall(PetscFEGetNumComponents(fe, &Nc));
252797c42addSMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
252897c42addSMatthew G. Knepley       PetscFV        fv = (PetscFV) obj;
252997c42addSMatthew G. Knepley       PetscDualSpace Q;
253097c42addSMatthew G. Knepley 
2531cf51de39SMatthew G. Knepley       if (isRefined) {
25329566063dSJacob Faibussowitsch         PetscCall(PetscFVRefine(fv, &fvRef[f]));
2533cf51de39SMatthew G. Knepley       } else {
25349566063dSJacob Faibussowitsch         PetscCall(PetscObjectReference((PetscObject) fv));
2535cf51de39SMatthew G. Knepley         fvRef[f] = fv;
2536cf51de39SMatthew G. Knepley       }
25379566063dSJacob Faibussowitsch       PetscCall(PetscFVGetDualSpace(fvRef[f], &Q));
25389566063dSJacob Faibussowitsch       PetscCall(PetscDualSpaceGetDimension(Q, &rNb));
25399566063dSJacob Faibussowitsch       PetscCall(PetscFVGetDualSpace(fv, &Q));
25409566063dSJacob Faibussowitsch       PetscCall(PetscFVGetNumComponents(fv, &Nc));
254197c42addSMatthew G. Knepley     }
25429566063dSJacob Faibussowitsch     PetscCall(DMGetField(dmc, f, NULL, &objc));
25439566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(objc, &idc));
25442ea9c922SToby Isaac     if (idc == PETSCFE_CLASSID) {
25452ea9c922SToby Isaac       PetscFE fe = (PetscFE) objc;
25462ea9c922SToby Isaac 
25479566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDimension(fe, &cNb));
25482ea9c922SToby Isaac     } else if (id == PETSCFV_CLASSID) {
25492ea9c922SToby Isaac       PetscFV        fv = (PetscFV) obj;
25502ea9c922SToby Isaac       PetscDualSpace Q;
25512ea9c922SToby Isaac 
25529566063dSJacob Faibussowitsch       PetscCall(PetscFVGetDualSpace(fv, &Q));
25539566063dSJacob Faibussowitsch       PetscCall(PetscDualSpaceGetDimension(Q, &cNb));
2554d69c5d34SMatthew G. Knepley     }
25552ea9c922SToby Isaac     rTotDim += rNb;
25562ea9c922SToby Isaac     cTotDim += cNb;
25572ea9c922SToby Isaac   }
25589566063dSJacob Faibussowitsch   PetscCall(PetscMalloc1(rTotDim*cTotDim,&elemMat));
25599566063dSJacob Faibussowitsch   PetscCall(PetscArrayzero(elemMat, rTotDim*cTotDim));
2560d69c5d34SMatthew G. Knepley   for (fieldI = 0, offsetI = 0; fieldI < Nf; ++fieldI) {
2561d69c5d34SMatthew G. Knepley     PetscDualSpace   Qref;
2562d69c5d34SMatthew G. Knepley     PetscQuadrature  f;
2563d69c5d34SMatthew G. Knepley     const PetscReal *qpoints, *qweights;
2564d69c5d34SMatthew G. Knepley     PetscReal       *points;
2565d69c5d34SMatthew G. Knepley     PetscInt         npoints = 0, Nc, Np, fpdim, i, k, p, d;
2566d69c5d34SMatthew G. Knepley 
2567d69c5d34SMatthew G. Knepley     /* Compose points from all dual basis functionals */
256897c42addSMatthew G. Knepley     if (feRef[fieldI]) {
25699566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDualSpace(feRef[fieldI], &Qref));
25709566063dSJacob Faibussowitsch       PetscCall(PetscFEGetNumComponents(feRef[fieldI], &Nc));
257197c42addSMatthew G. Knepley     } else {
25729566063dSJacob Faibussowitsch       PetscCall(PetscFVGetDualSpace(fvRef[fieldI], &Qref));
25739566063dSJacob Faibussowitsch       PetscCall(PetscFVGetNumComponents(fvRef[fieldI], &Nc));
257497c42addSMatthew G. Knepley     }
25759566063dSJacob Faibussowitsch     PetscCall(PetscDualSpaceGetDimension(Qref, &fpdim));
2576d69c5d34SMatthew G. Knepley     for (i = 0; i < fpdim; ++i) {
25779566063dSJacob Faibussowitsch       PetscCall(PetscDualSpaceGetFunctional(Qref, i, &f));
25789566063dSJacob Faibussowitsch       PetscCall(PetscQuadratureGetData(f, NULL, NULL, &Np, NULL, NULL));
2579d69c5d34SMatthew G. Knepley       npoints += Np;
2580d69c5d34SMatthew G. Knepley     }
25819566063dSJacob Faibussowitsch     PetscCall(PetscMalloc1(npoints*dim,&points));
2582d69c5d34SMatthew G. Knepley     for (i = 0, k = 0; i < fpdim; ++i) {
25839566063dSJacob Faibussowitsch       PetscCall(PetscDualSpaceGetFunctional(Qref, i, &f));
25849566063dSJacob Faibussowitsch       PetscCall(PetscQuadratureGetData(f, NULL, NULL, &Np, &qpoints, NULL));
2585d69c5d34SMatthew G. Knepley       for (p = 0; p < Np; ++p, ++k) for (d = 0; d < dim; ++d) points[k*dim+d] = qpoints[p*dim+d];
2586d69c5d34SMatthew G. Knepley     }
2587d69c5d34SMatthew G. Knepley 
2588d69c5d34SMatthew G. Knepley     for (fieldJ = 0, offsetJ = 0; fieldJ < Nf; ++fieldJ) {
258997c42addSMatthew G. Knepley       PetscObject  obj;
259097c42addSMatthew G. Knepley       PetscClassId id;
25919c3cf19fSMatthew G. Knepley       PetscInt     NcJ = 0, cpdim = 0, j, qNc;
2592d69c5d34SMatthew G. Knepley 
25939566063dSJacob Faibussowitsch       PetscCall(DMGetField(dmc, fieldJ, NULL, &obj));
25949566063dSJacob Faibussowitsch       PetscCall(PetscObjectGetClassId(obj, &id));
259597c42addSMatthew G. Knepley       if (id == PETSCFE_CLASSID) {
259697c42addSMatthew G. Knepley         PetscFE           fe = (PetscFE) obj;
2597ef0bb6c7SMatthew G. Knepley         PetscTabulation T  = NULL;
2598d69c5d34SMatthew G. Knepley 
2599d69c5d34SMatthew G. Knepley         /* Evaluate basis at points */
26009566063dSJacob Faibussowitsch         PetscCall(PetscFEGetNumComponents(fe, &NcJ));
26019566063dSJacob Faibussowitsch         PetscCall(PetscFEGetDimension(fe, &cpdim));
2602ffe73a53SMatthew G. Knepley         /* For now, fields only interpolate themselves */
2603ffe73a53SMatthew G. Knepley         if (fieldI == fieldJ) {
260463a3b9bcSJacob Faibussowitsch           PetscCheck(Nc == NcJ,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of components in fine space field %" PetscInt_FMT " does not match coarse field %" PetscInt_FMT, Nc, NcJ);
26059566063dSJacob Faibussowitsch           PetscCall(PetscFECreateTabulation(fe, 1, npoints, points, 0, &T));
2606d69c5d34SMatthew G. Knepley           for (i = 0, k = 0; i < fpdim; ++i) {
26079566063dSJacob Faibussowitsch             PetscCall(PetscDualSpaceGetFunctional(Qref, i, &f));
26089566063dSJacob Faibussowitsch             PetscCall(PetscQuadratureGetData(f, NULL, &qNc, &Np, NULL, &qweights));
260963a3b9bcSJacob Faibussowitsch             PetscCheck(qNc == NcJ,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of components in quadrature %" PetscInt_FMT " does not match coarse field %" PetscInt_FMT, qNc, NcJ);
2610d69c5d34SMatthew G. Knepley             for (p = 0; p < Np; ++p, ++k) {
261136a6d9c0SMatthew G. Knepley               for (j = 0; j < cpdim; ++j) {
2612d172c84bSMatthew G. Knepley                 /*
2613d172c84bSMatthew G. Knepley                    cTotDim:            Total columns in element interpolation matrix, sum of number of dual basis functionals in each field
2614d172c84bSMatthew G. Knepley                    offsetI, offsetJ:   Offsets into the larger element interpolation matrix for different fields
2615d172c84bSMatthew G. Knepley                    fpdim, i, cpdim, j: Dofs for fine and coarse grids, correspond to dual space basis functionals
2616d172c84bSMatthew G. Knepley                    qNC, Nc, Ncj, c:    Number of components in this field
2617d172c84bSMatthew G. Knepley                    Np, p:              Number of quad points in the fine grid functional i
2618d172c84bSMatthew G. Knepley                    k:                  i*Np + p, overall point number for the interpolation
2619d172c84bSMatthew G. Knepley                 */
2620ef0bb6c7SMatthew 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];
262136a6d9c0SMatthew G. Knepley               }
2622d69c5d34SMatthew G. Knepley             }
2623d69c5d34SMatthew G. Knepley           }
26249566063dSJacob Faibussowitsch           PetscCall(PetscTabulationDestroy(&T));
2625ffe73a53SMatthew G. Knepley         }
262697c42addSMatthew G. Knepley       } else if (id == PETSCFV_CLASSID) {
262797c42addSMatthew G. Knepley         PetscFV        fv = (PetscFV) obj;
262897c42addSMatthew G. Knepley 
262997c42addSMatthew G. Knepley         /* Evaluate constant function at points */
26309566063dSJacob Faibussowitsch         PetscCall(PetscFVGetNumComponents(fv, &NcJ));
263197c42addSMatthew G. Knepley         cpdim = 1;
263297c42addSMatthew G. Knepley         /* For now, fields only interpolate themselves */
263397c42addSMatthew G. Knepley         if (fieldI == fieldJ) {
263463a3b9bcSJacob Faibussowitsch           PetscCheck(Nc == NcJ,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of components in fine space field %" PetscInt_FMT " does not match coarse field %" PetscInt_FMT, Nc, NcJ);
263597c42addSMatthew G. Knepley           for (i = 0, k = 0; i < fpdim; ++i) {
26369566063dSJacob Faibussowitsch             PetscCall(PetscDualSpaceGetFunctional(Qref, i, &f));
26379566063dSJacob Faibussowitsch             PetscCall(PetscQuadratureGetData(f, NULL, &qNc, &Np, NULL, &qweights));
263863a3b9bcSJacob Faibussowitsch             PetscCheck(qNc == NcJ,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of components in quadrature %" PetscInt_FMT " does not match coarse field %" PetscInt_FMT, qNc, NcJ);
263997c42addSMatthew G. Knepley             for (p = 0; p < Np; ++p, ++k) {
264097c42addSMatthew G. Knepley               for (j = 0; j < cpdim; ++j) {
2641458eb97cSMatthew G. Knepley                 for (c = 0; c < Nc; ++c) elemMat[(offsetI + i)*cTotDim + offsetJ + j] += 1.0*qweights[p*qNc+c];
264297c42addSMatthew G. Knepley               }
264397c42addSMatthew G. Knepley             }
264497c42addSMatthew G. Knepley           }
264597c42addSMatthew G. Knepley         }
264697c42addSMatthew G. Knepley       }
2647d172c84bSMatthew G. Knepley       offsetJ += cpdim;
2648d69c5d34SMatthew G. Knepley     }
2649d172c84bSMatthew G. Knepley     offsetI += fpdim;
26509566063dSJacob Faibussowitsch     PetscCall(PetscFree(points));
2651d69c5d34SMatthew G. Knepley   }
26529566063dSJacob Faibussowitsch   if (mesh->printFEM > 1) PetscCall(DMPrintCellMatrix(0, name, rTotDim, cTotDim, elemMat));
26537f5b169aSMatthew G. Knepley   /* Preallocate matrix */
26547f5b169aSMatthew G. Knepley   {
2655c094ef40SMatthew G. Knepley     Mat          preallocator;
2656c094ef40SMatthew G. Knepley     PetscScalar *vals;
2657c094ef40SMatthew G. Knepley     PetscInt    *cellCIndices, *cellFIndices;
2658c094ef40SMatthew G. Knepley     PetscInt     locRows, locCols, cell;
26597f5b169aSMatthew G. Knepley 
26609566063dSJacob Faibussowitsch     PetscCall(MatGetLocalSize(In, &locRows, &locCols));
26619566063dSJacob Faibussowitsch     PetscCall(MatCreate(PetscObjectComm((PetscObject) In), &preallocator));
26629566063dSJacob Faibussowitsch     PetscCall(MatSetType(preallocator, MATPREALLOCATOR));
26639566063dSJacob Faibussowitsch     PetscCall(MatSetSizes(preallocator, locRows, locCols, PETSC_DETERMINE, PETSC_DETERMINE));
26649566063dSJacob Faibussowitsch     PetscCall(MatSetUp(preallocator));
26659566063dSJacob Faibussowitsch     PetscCall(PetscCalloc3(rTotDim*cTotDim, &vals,cTotDim,&cellCIndices,rTotDim,&cellFIndices));
26667f5b169aSMatthew G. Knepley     for (cell = cStart; cell < cEnd; ++cell) {
2667cf51de39SMatthew G. Knepley       if (isRefined) {
26689566063dSJacob Faibussowitsch         PetscCall(DMPlexMatGetClosureIndicesRefined(dmf, fsection, fglobalSection, dmc, csection, cglobalSection, cell, cellCIndices, cellFIndices));
26699566063dSJacob Faibussowitsch         PetscCall(MatSetValues(preallocator, rTotDim, cellFIndices, cTotDim, cellCIndices, vals, INSERT_VALUES));
2670cf51de39SMatthew G. Knepley       } else {
26719566063dSJacob Faibussowitsch         PetscCall(DMPlexMatSetClosureGeneral(dmf, fsection, fglobalSection, dmc, csection, cglobalSection, preallocator, cell, vals, INSERT_VALUES));
2672cf51de39SMatthew G. Knepley       }
26737f5b169aSMatthew G. Knepley     }
26749566063dSJacob Faibussowitsch     PetscCall(PetscFree3(vals,cellCIndices,cellFIndices));
26759566063dSJacob Faibussowitsch     PetscCall(MatAssemblyBegin(preallocator, MAT_FINAL_ASSEMBLY));
26769566063dSJacob Faibussowitsch     PetscCall(MatAssemblyEnd(preallocator, MAT_FINAL_ASSEMBLY));
26779566063dSJacob Faibussowitsch     PetscCall(MatPreallocatorPreallocate(preallocator, PETSC_TRUE, In));
26789566063dSJacob Faibussowitsch     PetscCall(MatDestroy(&preallocator));
26797f5b169aSMatthew G. Knepley   }
26807f5b169aSMatthew G. Knepley   /* Fill matrix */
26819566063dSJacob Faibussowitsch   PetscCall(MatZeroEntries(In));
2682d69c5d34SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
2683cf51de39SMatthew G. Knepley     if (isRefined) {
26849566063dSJacob Faibussowitsch       PetscCall(DMPlexMatSetClosureRefined(dmf, fsection, fglobalSection, dmc, csection, cglobalSection, In, c, elemMat, INSERT_VALUES));
2685cf51de39SMatthew G. Knepley     } else {
26869566063dSJacob Faibussowitsch       PetscCall(DMPlexMatSetClosureGeneral(dmf, fsection, fglobalSection, dmc, csection, cglobalSection, In, c, elemMat, INSERT_VALUES));
2687cf51de39SMatthew G. Knepley     }
2688d69c5d34SMatthew G. Knepley   }
26899566063dSJacob Faibussowitsch   for (f = 0; f < Nf; ++f) PetscCall(PetscFEDestroy(&feRef[f]));
26909566063dSJacob Faibussowitsch   PetscCall(PetscFree2(feRef,fvRef));
26919566063dSJacob Faibussowitsch   PetscCall(PetscFree(elemMat));
26929566063dSJacob Faibussowitsch   PetscCall(MatAssemblyBegin(In, MAT_FINAL_ASSEMBLY));
26939566063dSJacob Faibussowitsch   PetscCall(MatAssemblyEnd(In, MAT_FINAL_ASSEMBLY));
26949318fe57SMatthew G. Knepley   if (mesh->printFEM > 1) {
26959566063dSJacob Faibussowitsch     PetscCall(PetscPrintf(PetscObjectComm((PetscObject)In), "%s:\n", name));
26969566063dSJacob Faibussowitsch     PetscCall(MatChop(In, 1.0e-10));
26979566063dSJacob Faibussowitsch     PetscCall(MatView(In, NULL));
2698d69c5d34SMatthew G. Knepley   }
26999566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_InterpolatorFEM,dmc,dmf,0,0));
2700d69c5d34SMatthew G. Knepley   PetscFunctionReturn(0);
2701d69c5d34SMatthew G. Knepley }
27026c73c22cSMatthew G. Knepley 
2703bd041c0cSMatthew G. Knepley PetscErrorCode DMPlexComputeMassMatrixNested(DM dmc, DM dmf, Mat mass, void *user)
2704bd041c0cSMatthew G. Knepley {
2705bd041c0cSMatthew G. Knepley   SETERRQ(PetscObjectComm((PetscObject) dmc), PETSC_ERR_SUP, "Laziness");
2706bd041c0cSMatthew G. Knepley }
2707bd041c0cSMatthew G. Knepley 
270868132eb9SMatthew G. Knepley /*@
270968132eb9SMatthew G. Knepley   DMPlexComputeInterpolatorGeneral - Form the local portion of the interpolation matrix I from the coarse DM to a non-nested fine DM.
271068132eb9SMatthew G. Knepley 
271168132eb9SMatthew G. Knepley   Input Parameters:
271268132eb9SMatthew G. Knepley + dmf  - The fine mesh
271368132eb9SMatthew G. Knepley . dmc  - The coarse mesh
271468132eb9SMatthew G. Knepley - user - The user context
271568132eb9SMatthew G. Knepley 
271668132eb9SMatthew G. Knepley   Output Parameter:
271768132eb9SMatthew G. Knepley . In  - The interpolation matrix
271868132eb9SMatthew G. Knepley 
271968132eb9SMatthew G. Knepley   Level: developer
272068132eb9SMatthew G. Knepley 
2721db781477SPatrick Sanan .seealso: `DMPlexComputeInterpolatorNested()`, `DMPlexComputeJacobianFEM()`
272268132eb9SMatthew G. Knepley @*/
272368132eb9SMatthew G. Knepley PetscErrorCode DMPlexComputeInterpolatorGeneral(DM dmc, DM dmf, Mat In, void *user)
27244ef9d792SMatthew G. Knepley {
272564e98e1dSMatthew G. Knepley   DM_Plex     *mesh = (DM_Plex *) dmf->data;
272664e98e1dSMatthew G. Knepley   const char  *name = "Interpolator";
27274ef9d792SMatthew G. Knepley   PetscDS      prob;
2728a0806964SMatthew G. Knepley   Mat          interp;
2729a0806964SMatthew G. Knepley   PetscSection fsection, globalFSection;
2730a0806964SMatthew G. Knepley   PetscSection csection, globalCSection;
2731a0806964SMatthew G. Knepley   PetscInt     locRows, locCols;
27324ef9d792SMatthew G. Knepley   PetscReal   *x, *v0, *J, *invJ, detJ;
27334ef9d792SMatthew G. Knepley   PetscReal   *v0c, *Jc, *invJc, detJc;
27344ef9d792SMatthew G. Knepley   PetscScalar *elemMat;
2735a0806964SMatthew G. Knepley   PetscInt     dim, Nf, field, totDim, cStart, cEnd, cell, ccell, s;
27364ef9d792SMatthew G. Knepley 
27374ef9d792SMatthew G. Knepley   PetscFunctionBegin;
27389566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_InterpolatorFEM,dmc,dmf,0,0));
27399566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateDim(dmc, &dim));
27409566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dmc, &prob));
27419566063dSJacob Faibussowitsch   PetscCall(PetscDSGetWorkspace(prob, &x, NULL, NULL, NULL, NULL));
27429566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumFields(prob, &Nf));
27439566063dSJacob Faibussowitsch   PetscCall(PetscMalloc3(dim,&v0,dim*dim,&J,dim*dim,&invJ));
27449566063dSJacob Faibussowitsch   PetscCall(PetscMalloc3(dim,&v0c,dim*dim,&Jc,dim*dim,&invJc));
27459566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dmf, &fsection));
27469566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dmf, &globalFSection));
27479566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dmc, &csection));
27489566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dmc, &globalCSection));
2749a0806964SMatthew G. Knepley   PetscCall(DMPlexGetSimplexOrBoxCells(dmf, 0, &cStart, &cEnd));
27509566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(prob, &totDim));
27519566063dSJacob Faibussowitsch   PetscCall(PetscMalloc1(totDim, &elemMat));
27524ef9d792SMatthew G. Knepley 
2753a0806964SMatthew G. Knepley   PetscCall(MatGetLocalSize(In, &locRows, &locCols));
2754a0806964SMatthew G. Knepley   PetscCall(MatCreate(PetscObjectComm((PetscObject) In), &interp));
2755a0806964SMatthew G. Knepley   PetscCall(MatSetType(interp, MATPREALLOCATOR));
2756a0806964SMatthew G. Knepley   PetscCall(MatSetSizes(interp, locRows, locCols, PETSC_DETERMINE, PETSC_DETERMINE));
2757a0806964SMatthew G. Knepley   PetscCall(MatSetUp(interp));
2758a0806964SMatthew G. Knepley   for (s = 0; s < 2; ++s) {
27594ef9d792SMatthew G. Knepley     for (field = 0; field < Nf; ++field) {
27604ef9d792SMatthew G. Knepley       PetscObject      obj;
27614ef9d792SMatthew G. Knepley       PetscClassId     id;
2762c0d7054bSMatthew G. Knepley       PetscDualSpace   Q = NULL;
2763ef0bb6c7SMatthew G. Knepley       PetscTabulation  T = NULL;
27644ef9d792SMatthew G. Knepley       PetscQuadrature  f;
27654ef9d792SMatthew G. Knepley       const PetscReal *qpoints, *qweights;
2766d0f6233fSMatthew G. Knepley       PetscInt         Nc, qNc, Np, fpdim, off, i, d;
27674ef9d792SMatthew G. Knepley 
2768d0f6233fSMatthew G. Knepley       PetscCall(PetscDSGetFieldOffset(prob, field, &off));
27699566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(prob, field, &obj));
27709566063dSJacob Faibussowitsch       PetscCall(PetscObjectGetClassId(obj, &id));
27714ef9d792SMatthew G. Knepley       if (id == PETSCFE_CLASSID) {
27724ef9d792SMatthew G. Knepley         PetscFE fe = (PetscFE) obj;
27734ef9d792SMatthew G. Knepley 
27749566063dSJacob Faibussowitsch         PetscCall(PetscFEGetDualSpace(fe, &Q));
27759566063dSJacob Faibussowitsch         PetscCall(PetscFEGetNumComponents(fe, &Nc));
2776a0806964SMatthew G. Knepley         if (s) PetscCall(PetscFECreateTabulation(fe, 1, 1, x, 0, &T));
27774ef9d792SMatthew G. Knepley       } else if (id == PETSCFV_CLASSID) {
27784ef9d792SMatthew G. Knepley         PetscFV fv = (PetscFV) obj;
27794ef9d792SMatthew G. Knepley 
27809566063dSJacob Faibussowitsch         PetscCall(PetscFVGetDualSpace(fv, &Q));
27814ef9d792SMatthew G. Knepley         Nc = 1;
278263a3b9bcSJacob Faibussowitsch       } else SETERRQ(PetscObjectComm((PetscObject) dmc), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, field);
27839566063dSJacob Faibussowitsch       PetscCall(PetscDualSpaceGetDimension(Q, &fpdim));
27844ef9d792SMatthew G. Knepley       /* For each fine grid cell */
27854ef9d792SMatthew G. Knepley       for (cell = cStart; cell < cEnd; ++cell) {
27864ef9d792SMatthew G. Knepley         PetscInt *findices,   *cindices;
27874ef9d792SMatthew G. Knepley         PetscInt  numFIndices, numCIndices;
27884ef9d792SMatthew G. Knepley 
27899566063dSJacob Faibussowitsch         PetscCall(DMPlexGetClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
27909566063dSJacob Faibussowitsch         PetscCall(DMPlexComputeCellGeometryFEM(dmf, cell, NULL, v0, J, invJ, &detJ));
2791d0f6233fSMatthew G. Knepley         PetscCheck(numFIndices == totDim, PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of fine indices %" PetscInt_FMT " != %" PetscInt_FMT " dual basis vecs", numFIndices, totDim);
27924ef9d792SMatthew G. Knepley         for (i = 0; i < fpdim; ++i) {
27934ef9d792SMatthew G. Knepley           Vec                pointVec;
27944ef9d792SMatthew G. Knepley           PetscScalar       *pV;
279512111d7cSToby Isaac           PetscSF            coarseCellSF = NULL;
27963a93e3b7SToby Isaac           const PetscSFNode *coarseCells;
2797d0f6233fSMatthew G. Knepley           PetscInt           numCoarseCells, cpdim, row = findices[i+off], q, c, j;
27984ef9d792SMatthew G. Knepley 
27994ef9d792SMatthew G. Knepley           /* Get points from the dual basis functional quadrature */
28009566063dSJacob Faibussowitsch           PetscCall(PetscDualSpaceGetFunctional(Q, i, &f));
28019566063dSJacob Faibussowitsch           PetscCall(PetscQuadratureGetData(f, NULL, &qNc, &Np, &qpoints, &qweights));
280263a3b9bcSJacob Faibussowitsch           PetscCheck(qNc == Nc,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of components in quadrature %" PetscInt_FMT " does not match coarse field %" PetscInt_FMT, qNc, Nc);
28039566063dSJacob Faibussowitsch           PetscCall(VecCreateSeq(PETSC_COMM_SELF, Np*dim, &pointVec));
28049566063dSJacob Faibussowitsch           PetscCall(VecSetBlockSize(pointVec, dim));
28059566063dSJacob Faibussowitsch           PetscCall(VecGetArray(pointVec, &pV));
28064ef9d792SMatthew G. Knepley           for (q = 0; q < Np; ++q) {
2807c330f8ffSToby Isaac             const PetscReal xi0[3] = {-1., -1., -1.};
2808c330f8ffSToby Isaac 
28094ef9d792SMatthew G. Knepley             /* Transform point to real space */
2810c330f8ffSToby Isaac             CoordinatesRefToReal(dim, dim, xi0, v0, J, &qpoints[q*dim], x);
28114ef9d792SMatthew G. Knepley             for (d = 0; d < dim; ++d) pV[q*dim+d] = x[d];
28124ef9d792SMatthew G. Knepley           }
28139566063dSJacob Faibussowitsch           PetscCall(VecRestoreArray(pointVec, &pV));
28144ef9d792SMatthew G. Knepley           /* Get set of coarse cells that overlap points (would like to group points by coarse cell) */
28151555c271SMatthew G. Knepley           /* OPT: Read this out from preallocation information */
28169566063dSJacob Faibussowitsch           PetscCall(DMLocatePoints(dmc, pointVec, DM_POINTLOCATION_NEAREST, &coarseCellSF));
28174ef9d792SMatthew G. Knepley           /* Update preallocation info */
28189566063dSJacob Faibussowitsch           PetscCall(PetscSFGetGraph(coarseCellSF, NULL, &numCoarseCells, NULL, &coarseCells));
28195f80ce2aSJacob Faibussowitsch           PetscCheck(numCoarseCells == Np, PETSC_COMM_SELF, PETSC_ERR_PLIB, "Not all closure points located");
28209566063dSJacob Faibussowitsch           PetscCall(VecGetArray(pointVec, &pV));
28214ef9d792SMatthew G. Knepley           for (ccell = 0; ccell < numCoarseCells; ++ccell) {
2822826eb36dSMatthew G. Knepley             PetscReal pVReal[3];
2823c330f8ffSToby Isaac             const PetscReal xi0[3] = {-1., -1., -1.};
2824826eb36dSMatthew G. Knepley 
28259566063dSJacob Faibussowitsch             PetscCall(DMPlexGetClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
2826a0806964SMatthew G. Knepley             if (id == PETSCFE_CLASSID) PetscCall(PetscFEGetDimension((PetscFE) obj, &cpdim));
2827a0806964SMatthew G. Knepley             else                       cpdim = 1;
2828a0806964SMatthew G. Knepley 
2829a0806964SMatthew G. Knepley             if (s) {
28304ef9d792SMatthew G. Knepley               /* Transform points from real space to coarse reference space */
28319566063dSJacob Faibussowitsch               PetscCall(DMPlexComputeCellGeometryFEM(dmc, coarseCells[ccell].index, NULL, v0c, Jc, invJc, &detJc));
2832e2d86523SMatthew G. Knepley               for (d = 0; d < dim; ++d) pVReal[d] = PetscRealPart(pV[ccell*dim+d]);
2833c330f8ffSToby Isaac               CoordinatesRealToRef(dim, dim, xi0, v0c, invJc, pVReal, x);
28344ef9d792SMatthew G. Knepley 
28354ef9d792SMatthew G. Knepley               if (id == PETSCFE_CLASSID) {
28364ef9d792SMatthew G. Knepley                 /* Evaluate coarse basis on contained point */
2837a0806964SMatthew G. Knepley                 PetscCall(PetscFEComputeTabulation((PetscFE) obj, 1, x, 0, T));
28389566063dSJacob Faibussowitsch                 PetscCall(PetscArrayzero(elemMat, cpdim));
28394ef9d792SMatthew G. Knepley                 /* Get elemMat entries by multiplying by weight */
28404ef9d792SMatthew G. Knepley                 for (j = 0; j < cpdim; ++j) {
2841ef0bb6c7SMatthew G. Knepley                   for (c = 0; c < Nc; ++c) elemMat[j] += T->T[0][j*Nc + c]*qweights[ccell*qNc + c];
28424ef9d792SMatthew G. Knepley                 }
28434ef9d792SMatthew G. Knepley               } else {
28444ef9d792SMatthew G. Knepley                 for (j = 0; j < cpdim; ++j) {
28459c3cf19fSMatthew G. Knepley                   for (c = 0; c < Nc; ++c) elemMat[j] += 1.0*qweights[ccell*qNc + c];
28464ef9d792SMatthew G. Knepley                 }
28474ef9d792SMatthew G. Knepley               }
28489566063dSJacob Faibussowitsch               if (mesh->printFEM > 1) PetscCall(DMPrintCellMatrix(cell, name, 1, numCIndices, elemMat));
2849a0806964SMatthew G. Knepley             }
2850a0806964SMatthew G. Knepley             /* Update interpolator */
2851d0f6233fSMatthew G. Knepley             PetscCheck(numCIndices == totDim,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Number of element matrix columns %" PetscInt_FMT " != %" PetscInt_FMT, numCIndices, totDim);
2852a0806964SMatthew G. Knepley             PetscCall(MatSetValues(interp, 1, &row, cpdim, &cindices[off], elemMat, INSERT_VALUES));
28539566063dSJacob Faibussowitsch             PetscCall(DMPlexRestoreClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
28544ef9d792SMatthew G. Knepley           }
28559566063dSJacob Faibussowitsch           PetscCall(VecRestoreArray(pointVec, &pV));
28569566063dSJacob Faibussowitsch           PetscCall(PetscSFDestroy(&coarseCellSF));
28579566063dSJacob Faibussowitsch           PetscCall(VecDestroy(&pointVec));
28584ef9d792SMatthew G. Knepley         }
28599566063dSJacob Faibussowitsch         PetscCall(DMPlexRestoreClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
28604ef9d792SMatthew G. Knepley       }
2861a0806964SMatthew G. Knepley       if (s && id == PETSCFE_CLASSID) PetscCall(PetscTabulationDestroy(&T));
2862a0806964SMatthew G. Knepley     }
2863a0806964SMatthew G. Knepley     if (!s) {
2864a0806964SMatthew G. Knepley       PetscCall(MatAssemblyBegin(interp, MAT_FINAL_ASSEMBLY));
2865a0806964SMatthew G. Knepley       PetscCall(MatAssemblyEnd(interp, MAT_FINAL_ASSEMBLY));
2866a0806964SMatthew G. Knepley       PetscCall(MatPreallocatorPreallocate(interp, PETSC_TRUE, In));
2867a0806964SMatthew G. Knepley       PetscCall(MatDestroy(&interp));
2868a0806964SMatthew G. Knepley       interp = In;
2869a0806964SMatthew G. Knepley     }
28704ef9d792SMatthew G. Knepley   }
28719566063dSJacob Faibussowitsch   PetscCall(PetscFree3(v0, J, invJ));
28729566063dSJacob Faibussowitsch   PetscCall(PetscFree3(v0c, Jc, invJc));
28739566063dSJacob Faibussowitsch   PetscCall(PetscFree(elemMat));
28749566063dSJacob Faibussowitsch   PetscCall(MatAssemblyBegin(In, MAT_FINAL_ASSEMBLY));
28759566063dSJacob Faibussowitsch   PetscCall(MatAssemblyEnd(In, MAT_FINAL_ASSEMBLY));
28769566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_InterpolatorFEM,dmc,dmf,0,0));
28774ef9d792SMatthew G. Knepley   PetscFunctionReturn(0);
28784ef9d792SMatthew G. Knepley }
28794ef9d792SMatthew G. Knepley 
288046fa42a0SMatthew G. Knepley /*@
2881bd041c0cSMatthew G. Knepley   DMPlexComputeMassMatrixGeneral - Form the local portion of the mass matrix M from the coarse DM to a non-nested fine DM.
2882bd041c0cSMatthew G. Knepley 
2883bd041c0cSMatthew G. Knepley   Input Parameters:
2884bd041c0cSMatthew G. Knepley + dmf  - The fine mesh
2885bd041c0cSMatthew G. Knepley . dmc  - The coarse mesh
2886bd041c0cSMatthew G. Knepley - user - The user context
2887bd041c0cSMatthew G. Knepley 
2888bd041c0cSMatthew G. Knepley   Output Parameter:
2889bd041c0cSMatthew G. Knepley . mass  - The mass matrix
2890bd041c0cSMatthew G. Knepley 
2891bd041c0cSMatthew G. Knepley   Level: developer
2892bd041c0cSMatthew G. Knepley 
2893db781477SPatrick Sanan .seealso: `DMPlexComputeMassMatrixNested()`, `DMPlexComputeInterpolatorNested()`, `DMPlexComputeInterpolatorGeneral()`, `DMPlexComputeJacobianFEM()`
2894bd041c0cSMatthew G. Knepley @*/
2895bd041c0cSMatthew G. Knepley PetscErrorCode DMPlexComputeMassMatrixGeneral(DM dmc, DM dmf, Mat mass, void *user)
2896bd041c0cSMatthew G. Knepley {
2897bd041c0cSMatthew G. Knepley   DM_Plex       *mesh = (DM_Plex *) dmf->data;
2898bd041c0cSMatthew G. Knepley   const char    *name = "Mass Matrix";
2899bd041c0cSMatthew G. Knepley   PetscDS        prob;
2900bd041c0cSMatthew G. Knepley   PetscSection   fsection, csection, globalFSection, globalCSection;
2901e8f14785SLisandro Dalcin   PetscHSetIJ    ht;
2902bd041c0cSMatthew G. Knepley   PetscLayout    rLayout;
2903bd041c0cSMatthew G. Knepley   PetscInt      *dnz, *onz;
2904bd041c0cSMatthew G. Knepley   PetscInt       locRows, rStart, rEnd;
2905bd041c0cSMatthew G. Knepley   PetscReal     *x, *v0, *J, *invJ, detJ;
2906bd041c0cSMatthew G. Knepley   PetscReal     *v0c, *Jc, *invJc, detJc;
2907bd041c0cSMatthew G. Knepley   PetscScalar   *elemMat;
2908bd041c0cSMatthew G. Knepley   PetscInt       dim, Nf, field, totDim, cStart, cEnd, cell, ccell;
2909bd041c0cSMatthew G. Knepley 
2910bd041c0cSMatthew G. Knepley   PetscFunctionBegin;
29119566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateDim(dmc, &dim));
29129566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dmc, &prob));
29139566063dSJacob Faibussowitsch   PetscCall(PetscDSGetWorkspace(prob, &x, NULL, NULL, NULL, NULL));
29149566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumFields(prob, &Nf));
29159566063dSJacob Faibussowitsch   PetscCall(PetscMalloc3(dim,&v0,dim*dim,&J,dim*dim,&invJ));
29169566063dSJacob Faibussowitsch   PetscCall(PetscMalloc3(dim,&v0c,dim*dim,&Jc,dim*dim,&invJc));
29179566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dmf, &fsection));
29189566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dmf, &globalFSection));
29199566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dmc, &csection));
29209566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dmc, &globalCSection));
29219566063dSJacob Faibussowitsch   PetscCall(DMPlexGetHeightStratum(dmf, 0, &cStart, &cEnd));
29229566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(prob, &totDim));
29239566063dSJacob Faibussowitsch   PetscCall(PetscMalloc1(totDim, &elemMat));
2924bd041c0cSMatthew G. Knepley 
29259566063dSJacob Faibussowitsch   PetscCall(MatGetLocalSize(mass, &locRows, NULL));
29269566063dSJacob Faibussowitsch   PetscCall(PetscLayoutCreate(PetscObjectComm((PetscObject) mass), &rLayout));
29279566063dSJacob Faibussowitsch   PetscCall(PetscLayoutSetLocalSize(rLayout, locRows));
29289566063dSJacob Faibussowitsch   PetscCall(PetscLayoutSetBlockSize(rLayout, 1));
29299566063dSJacob Faibussowitsch   PetscCall(PetscLayoutSetUp(rLayout));
29309566063dSJacob Faibussowitsch   PetscCall(PetscLayoutGetRange(rLayout, &rStart, &rEnd));
29319566063dSJacob Faibussowitsch   PetscCall(PetscLayoutDestroy(&rLayout));
29329566063dSJacob Faibussowitsch   PetscCall(PetscCalloc2(locRows,&dnz,locRows,&onz));
29339566063dSJacob Faibussowitsch   PetscCall(PetscHSetIJCreate(&ht));
2934bd041c0cSMatthew G. Knepley   for (field = 0; field < Nf; ++field) {
2935bd041c0cSMatthew G. Knepley     PetscObject      obj;
2936bd041c0cSMatthew G. Knepley     PetscClassId     id;
2937bd041c0cSMatthew G. Knepley     PetscQuadrature  quad;
2938bd041c0cSMatthew G. Knepley     const PetscReal *qpoints;
2939bd041c0cSMatthew G. Knepley     PetscInt         Nq, Nc, i, d;
2940bd041c0cSMatthew G. Knepley 
29419566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, field, &obj));
29429566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
29439566063dSJacob Faibussowitsch     if (id == PETSCFE_CLASSID) PetscCall(PetscFEGetQuadrature((PetscFE) obj, &quad));
29449566063dSJacob Faibussowitsch     else                       PetscCall(PetscFVGetQuadrature((PetscFV) obj, &quad));
29459566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureGetData(quad, NULL, &Nc, &Nq, &qpoints, NULL));
2946bd041c0cSMatthew G. Knepley     /* For each fine grid cell */
2947bd041c0cSMatthew G. Knepley     for (cell = cStart; cell < cEnd; ++cell) {
2948bd041c0cSMatthew G. Knepley       Vec                pointVec;
2949bd041c0cSMatthew G. Knepley       PetscScalar       *pV;
2950bd041c0cSMatthew G. Knepley       PetscSF            coarseCellSF = NULL;
2951bd041c0cSMatthew G. Knepley       const PetscSFNode *coarseCells;
2952bd041c0cSMatthew G. Knepley       PetscInt           numCoarseCells, q, c;
2953bd041c0cSMatthew G. Knepley       PetscInt          *findices,   *cindices;
2954bd041c0cSMatthew G. Knepley       PetscInt           numFIndices, numCIndices;
2955bd041c0cSMatthew G. Knepley 
29569566063dSJacob Faibussowitsch       PetscCall(DMPlexGetClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
29579566063dSJacob Faibussowitsch       PetscCall(DMPlexComputeCellGeometryFEM(dmf, cell, NULL, v0, J, invJ, &detJ));
2958bd041c0cSMatthew G. Knepley       /* Get points from the quadrature */
29599566063dSJacob Faibussowitsch       PetscCall(VecCreateSeq(PETSC_COMM_SELF, Nq*dim, &pointVec));
29609566063dSJacob Faibussowitsch       PetscCall(VecSetBlockSize(pointVec, dim));
29619566063dSJacob Faibussowitsch       PetscCall(VecGetArray(pointVec, &pV));
2962bd041c0cSMatthew G. Knepley       for (q = 0; q < Nq; ++q) {
2963c330f8ffSToby Isaac         const PetscReal xi0[3] = {-1., -1., -1.};
2964c330f8ffSToby Isaac 
2965bd041c0cSMatthew G. Knepley         /* Transform point to real space */
2966c330f8ffSToby Isaac         CoordinatesRefToReal(dim, dim, xi0, v0, J, &qpoints[q*dim], x);
2967bd041c0cSMatthew G. Knepley         for (d = 0; d < dim; ++d) pV[q*dim+d] = x[d];
2968bd041c0cSMatthew G. Knepley       }
29699566063dSJacob Faibussowitsch       PetscCall(VecRestoreArray(pointVec, &pV));
2970bd041c0cSMatthew G. Knepley       /* Get set of coarse cells that overlap points (would like to group points by coarse cell) */
29719566063dSJacob Faibussowitsch       PetscCall(DMLocatePoints(dmc, pointVec, DM_POINTLOCATION_NEAREST, &coarseCellSF));
29729566063dSJacob Faibussowitsch       PetscCall(PetscSFViewFromOptions(coarseCellSF, NULL, "-interp_sf_view"));
2973bd041c0cSMatthew G. Knepley       /* Update preallocation info */
29749566063dSJacob Faibussowitsch       PetscCall(PetscSFGetGraph(coarseCellSF, NULL, &numCoarseCells, NULL, &coarseCells));
29755f80ce2aSJacob Faibussowitsch       PetscCheck(numCoarseCells == Nq,PETSC_COMM_SELF,PETSC_ERR_PLIB,"Not all closure points located");
2976bd041c0cSMatthew G. Knepley       {
2977e8f14785SLisandro Dalcin         PetscHashIJKey key;
2978e8f14785SLisandro Dalcin         PetscBool      missing;
2979bd041c0cSMatthew G. Knepley 
2980bd041c0cSMatthew G. Knepley         for (i = 0; i < numFIndices; ++i) {
2981e8f14785SLisandro Dalcin           key.i = findices[i];
2982e8f14785SLisandro Dalcin           if (key.i >= 0) {
2983bd041c0cSMatthew G. Knepley             /* Get indices for coarse elements */
2984bd041c0cSMatthew G. Knepley             for (ccell = 0; ccell < numCoarseCells; ++ccell) {
29859566063dSJacob Faibussowitsch               PetscCall(DMPlexGetClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
2986bd041c0cSMatthew G. Knepley               for (c = 0; c < numCIndices; ++c) {
2987e8f14785SLisandro Dalcin                 key.j = cindices[c];
2988e8f14785SLisandro Dalcin                 if (key.j < 0) continue;
29899566063dSJacob Faibussowitsch                 PetscCall(PetscHSetIJQueryAdd(ht, key, &missing));
2990bd041c0cSMatthew G. Knepley                 if (missing) {
2991e8f14785SLisandro Dalcin                   if ((key.j >= rStart) && (key.j < rEnd)) ++dnz[key.i-rStart];
2992e8f14785SLisandro Dalcin                   else                                     ++onz[key.i-rStart];
2993bd041c0cSMatthew G. Knepley                 }
2994bd041c0cSMatthew G. Knepley               }
29959566063dSJacob Faibussowitsch               PetscCall(DMPlexRestoreClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
2996bd041c0cSMatthew G. Knepley             }
2997bd041c0cSMatthew G. Knepley           }
2998bd041c0cSMatthew G. Knepley         }
2999bd041c0cSMatthew G. Knepley       }
30009566063dSJacob Faibussowitsch       PetscCall(PetscSFDestroy(&coarseCellSF));
30019566063dSJacob Faibussowitsch       PetscCall(VecDestroy(&pointVec));
30029566063dSJacob Faibussowitsch       PetscCall(DMPlexRestoreClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
3003bd041c0cSMatthew G. Knepley     }
3004bd041c0cSMatthew G. Knepley   }
30059566063dSJacob Faibussowitsch   PetscCall(PetscHSetIJDestroy(&ht));
30069566063dSJacob Faibussowitsch   PetscCall(MatXAIJSetPreallocation(mass, 1, dnz, onz, NULL, NULL));
30079566063dSJacob Faibussowitsch   PetscCall(MatSetOption(mass, MAT_NEW_NONZERO_ALLOCATION_ERR,PETSC_TRUE));
30089566063dSJacob Faibussowitsch   PetscCall(PetscFree2(dnz,onz));
3009bd041c0cSMatthew G. Knepley   for (field = 0; field < Nf; ++field) {
3010bd041c0cSMatthew G. Knepley     PetscObject       obj;
3011bd041c0cSMatthew G. Knepley     PetscClassId      id;
3012ef0bb6c7SMatthew G. Knepley     PetscTabulation T, Tfine;
3013bd041c0cSMatthew G. Knepley     PetscQuadrature   quad;
3014bd041c0cSMatthew G. Knepley     const PetscReal  *qpoints, *qweights;
3015bd041c0cSMatthew G. Knepley     PetscInt          Nq, Nc, i, d;
3016bd041c0cSMatthew G. Knepley 
30179566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, field, &obj));
30189566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
3019ef0bb6c7SMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
30209566063dSJacob Faibussowitsch       PetscCall(PetscFEGetQuadrature((PetscFE) obj, &quad));
30219566063dSJacob Faibussowitsch       PetscCall(PetscFEGetCellTabulation((PetscFE) obj, 1, &Tfine));
30229566063dSJacob Faibussowitsch       PetscCall(PetscFECreateTabulation((PetscFE) obj, 1, 1, x, 0, &T));
3023ef0bb6c7SMatthew G. Knepley     } else {
30249566063dSJacob Faibussowitsch       PetscCall(PetscFVGetQuadrature((PetscFV) obj, &quad));
3025ef0bb6c7SMatthew G. Knepley     }
30269566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureGetData(quad, NULL, &Nc, &Nq, &qpoints, &qweights));
3027bd041c0cSMatthew G. Knepley     /* For each fine grid cell */
3028bd041c0cSMatthew G. Knepley     for (cell = cStart; cell < cEnd; ++cell) {
3029bd041c0cSMatthew G. Knepley       Vec                pointVec;
3030bd041c0cSMatthew G. Knepley       PetscScalar       *pV;
3031bd041c0cSMatthew G. Knepley       PetscSF            coarseCellSF = NULL;
3032bd041c0cSMatthew G. Knepley       const PetscSFNode *coarseCells;
3033bd041c0cSMatthew G. Knepley       PetscInt           numCoarseCells, cpdim, q, c, j;
3034bd041c0cSMatthew G. Knepley       PetscInt          *findices,   *cindices;
3035bd041c0cSMatthew G. Knepley       PetscInt           numFIndices, numCIndices;
3036bd041c0cSMatthew G. Knepley 
30379566063dSJacob Faibussowitsch       PetscCall(DMPlexGetClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
30389566063dSJacob Faibussowitsch       PetscCall(DMPlexComputeCellGeometryFEM(dmf, cell, NULL, v0, J, invJ, &detJ));
3039bd041c0cSMatthew G. Knepley       /* Get points from the quadrature */
30409566063dSJacob Faibussowitsch       PetscCall(VecCreateSeq(PETSC_COMM_SELF, Nq*dim, &pointVec));
30419566063dSJacob Faibussowitsch       PetscCall(VecSetBlockSize(pointVec, dim));
30429566063dSJacob Faibussowitsch       PetscCall(VecGetArray(pointVec, &pV));
3043bd041c0cSMatthew G. Knepley       for (q = 0; q < Nq; ++q) {
3044c330f8ffSToby Isaac         const PetscReal xi0[3] = {-1., -1., -1.};
3045c330f8ffSToby Isaac 
3046bd041c0cSMatthew G. Knepley         /* Transform point to real space */
3047c330f8ffSToby Isaac         CoordinatesRefToReal(dim, dim, xi0, v0, J, &qpoints[q*dim], x);
3048bd041c0cSMatthew G. Knepley         for (d = 0; d < dim; ++d) pV[q*dim+d] = x[d];
3049bd041c0cSMatthew G. Knepley       }
30509566063dSJacob Faibussowitsch       PetscCall(VecRestoreArray(pointVec, &pV));
3051bd041c0cSMatthew G. Knepley       /* Get set of coarse cells that overlap points (would like to group points by coarse cell) */
30529566063dSJacob Faibussowitsch       PetscCall(DMLocatePoints(dmc, pointVec, DM_POINTLOCATION_NEAREST, &coarseCellSF));
3053bd041c0cSMatthew G. Knepley       /* Update matrix */
30549566063dSJacob Faibussowitsch       PetscCall(PetscSFGetGraph(coarseCellSF, NULL, &numCoarseCells, NULL, &coarseCells));
30555f80ce2aSJacob Faibussowitsch       PetscCheck(numCoarseCells == Nq,PETSC_COMM_SELF,PETSC_ERR_PLIB,"Not all closure points located");
30569566063dSJacob Faibussowitsch       PetscCall(VecGetArray(pointVec, &pV));
3057bd041c0cSMatthew G. Knepley       for (ccell = 0; ccell < numCoarseCells; ++ccell) {
3058bd041c0cSMatthew G. Knepley         PetscReal pVReal[3];
3059c330f8ffSToby Isaac         const PetscReal xi0[3] = {-1., -1., -1.};
3060c330f8ffSToby Isaac 
30619566063dSJacob Faibussowitsch         PetscCall(DMPlexGetClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
3062bd041c0cSMatthew G. Knepley         /* Transform points from real space to coarse reference space */
30639566063dSJacob Faibussowitsch         PetscCall(DMPlexComputeCellGeometryFEM(dmc, coarseCells[ccell].index, NULL, v0c, Jc, invJc, &detJc));
3064bd041c0cSMatthew G. Knepley         for (d = 0; d < dim; ++d) pVReal[d] = PetscRealPart(pV[ccell*dim+d]);
3065c330f8ffSToby Isaac         CoordinatesRealToRef(dim, dim, xi0, v0c, invJc, pVReal, x);
3066bd041c0cSMatthew G. Knepley 
3067bd041c0cSMatthew G. Knepley         if (id == PETSCFE_CLASSID) {
3068bd041c0cSMatthew G. Knepley           PetscFE fe = (PetscFE) obj;
3069bd041c0cSMatthew G. Knepley 
3070bd041c0cSMatthew G. Knepley           /* Evaluate coarse basis on contained point */
30719566063dSJacob Faibussowitsch           PetscCall(PetscFEGetDimension(fe, &cpdim));
30729566063dSJacob Faibussowitsch           PetscCall(PetscFEComputeTabulation(fe, 1, x, 0, T));
3073bd041c0cSMatthew G. Knepley           /* Get elemMat entries by multiplying by weight */
3074bd041c0cSMatthew G. Knepley           for (i = 0; i < numFIndices; ++i) {
30759566063dSJacob Faibussowitsch             PetscCall(PetscArrayzero(elemMat, cpdim));
3076bd041c0cSMatthew G. Knepley             for (j = 0; j < cpdim; ++j) {
3077ef0bb6c7SMatthew 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;
3078bd041c0cSMatthew G. Knepley             }
3079bd041c0cSMatthew G. Knepley             /* Update interpolator */
30809566063dSJacob Faibussowitsch             if (mesh->printFEM > 1) PetscCall(DMPrintCellMatrix(cell, name, 1, numCIndices, elemMat));
308163a3b9bcSJacob Faibussowitsch             PetscCheck(numCIndices == cpdim,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Number of element matrix columns %" PetscInt_FMT " != %" PetscInt_FMT, numCIndices, cpdim);
30829566063dSJacob Faibussowitsch             PetscCall(MatSetValues(mass, 1, &findices[i], numCIndices, cindices, elemMat, ADD_VALUES));
3083bd041c0cSMatthew G. Knepley           }
3084bd041c0cSMatthew G. Knepley         } else {
3085bd041c0cSMatthew G. Knepley           cpdim = 1;
3086bd041c0cSMatthew G. Knepley           for (i = 0; i < numFIndices; ++i) {
30879566063dSJacob Faibussowitsch             PetscCall(PetscArrayzero(elemMat, cpdim));
3088bd041c0cSMatthew G. Knepley             for (j = 0; j < cpdim; ++j) {
3089bd041c0cSMatthew G. Knepley               for (c = 0; c < Nc; ++c) elemMat[j] += 1.0*1.0*qweights[ccell*Nc + c]*detJ;
3090bd041c0cSMatthew G. Knepley             }
3091bd041c0cSMatthew G. Knepley             /* Update interpolator */
30929566063dSJacob Faibussowitsch             if (mesh->printFEM > 1) PetscCall(DMPrintCellMatrix(cell, name, 1, numCIndices, elemMat));
309363a3b9bcSJacob Faibussowitsch             PetscCall(PetscPrintf(PETSC_COMM_SELF, "Nq: %" PetscInt_FMT " %" PetscInt_FMT " Nf: %" PetscInt_FMT " %" PetscInt_FMT " Nc: %" PetscInt_FMT " %" PetscInt_FMT "\n", ccell, Nq, i, numFIndices, j, numCIndices));
309463a3b9bcSJacob Faibussowitsch             PetscCheck(numCIndices == cpdim,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Number of element matrix columns %" PetscInt_FMT " != %" PetscInt_FMT, numCIndices, cpdim);
30959566063dSJacob Faibussowitsch             PetscCall(MatSetValues(mass, 1, &findices[i], numCIndices, cindices, elemMat, ADD_VALUES));
3096bd041c0cSMatthew G. Knepley           }
3097bd041c0cSMatthew G. Knepley         }
30989566063dSJacob Faibussowitsch         PetscCall(DMPlexRestoreClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
3099bd041c0cSMatthew G. Knepley       }
31009566063dSJacob Faibussowitsch       PetscCall(VecRestoreArray(pointVec, &pV));
31019566063dSJacob Faibussowitsch       PetscCall(PetscSFDestroy(&coarseCellSF));
31029566063dSJacob Faibussowitsch       PetscCall(VecDestroy(&pointVec));
31039566063dSJacob Faibussowitsch       PetscCall(DMPlexRestoreClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
3104bd041c0cSMatthew G. Knepley     }
31059566063dSJacob Faibussowitsch     if (id == PETSCFE_CLASSID) PetscCall(PetscTabulationDestroy(&T));
3106bd041c0cSMatthew G. Knepley   }
31079566063dSJacob Faibussowitsch   PetscCall(PetscFree3(v0,J,invJ));
31089566063dSJacob Faibussowitsch   PetscCall(PetscFree3(v0c,Jc,invJc));
31099566063dSJacob Faibussowitsch   PetscCall(PetscFree(elemMat));
31109566063dSJacob Faibussowitsch   PetscCall(MatAssemblyBegin(mass, MAT_FINAL_ASSEMBLY));
31119566063dSJacob Faibussowitsch   PetscCall(MatAssemblyEnd(mass, MAT_FINAL_ASSEMBLY));
3112bd041c0cSMatthew G. Knepley   PetscFunctionReturn(0);
3113bd041c0cSMatthew G. Knepley }
3114bd041c0cSMatthew G. Knepley 
3115bd041c0cSMatthew G. Knepley /*@
311646fa42a0SMatthew G. Knepley   DMPlexComputeInjectorFEM - Compute a mapping from coarse unknowns to fine unknowns
311746fa42a0SMatthew G. Knepley 
311846fa42a0SMatthew G. Knepley   Input Parameters:
311946fa42a0SMatthew G. Knepley + dmc  - The coarse mesh
312046fa42a0SMatthew G. Knepley - dmf  - The fine mesh
312146fa42a0SMatthew G. Knepley - user - The user context
312246fa42a0SMatthew G. Knepley 
312346fa42a0SMatthew G. Knepley   Output Parameter:
312446fa42a0SMatthew G. Knepley . sc   - The mapping
312546fa42a0SMatthew G. Knepley 
312646fa42a0SMatthew G. Knepley   Level: developer
312746fa42a0SMatthew G. Knepley 
3128db781477SPatrick Sanan .seealso: `DMPlexComputeInterpolatorNested()`, `DMPlexComputeJacobianFEM()`
312946fa42a0SMatthew G. Knepley @*/
31307c927364SMatthew G. Knepley PetscErrorCode DMPlexComputeInjectorFEM(DM dmc, DM dmf, VecScatter *sc, void *user)
31317c927364SMatthew G. Knepley {
3132e9d4ef1bSMatthew G. Knepley   PetscDS        prob;
31337c927364SMatthew G. Knepley   PetscFE       *feRef;
313497c42addSMatthew G. Knepley   PetscFV       *fvRef;
31357c927364SMatthew G. Knepley   Vec            fv, cv;
31367c927364SMatthew G. Knepley   IS             fis, cis;
31377c927364SMatthew G. Knepley   PetscSection   fsection, fglobalSection, csection, cglobalSection;
31387c927364SMatthew G. Knepley   PetscInt      *cmap, *cellCIndices, *cellFIndices, *cindices, *findices;
3139485ad865SMatthew G. Knepley   PetscInt       cTotDim, fTotDim = 0, Nf, f, field, cStart, cEnd, c, dim, d, startC, endC, offsetC, offsetF, m;
31406f3d3cbcSMatthew G. Knepley   PetscBool     *needAvg;
31417c927364SMatthew G. Knepley 
31427c927364SMatthew G. Knepley   PetscFunctionBegin;
31439566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_InjectorFEM,dmc,dmf,0,0));
31449566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dmf, &dim));
31459566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dmf, &fsection));
31469566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dmf, &fglobalSection));
31479566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dmc, &csection));
31489566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dmc, &cglobalSection));
31499566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetNumFields(fsection, &Nf));
31509566063dSJacob Faibussowitsch   PetscCall(DMPlexGetSimplexOrBoxCells(dmc, 0, &cStart, &cEnd));
31519566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dmc, &prob));
31529566063dSJacob Faibussowitsch   PetscCall(PetscCalloc3(Nf,&feRef,Nf,&fvRef,Nf,&needAvg));
31537c927364SMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
315497c42addSMatthew G. Knepley     PetscObject  obj;
315597c42addSMatthew G. Knepley     PetscClassId id;
3156aa7890ccSMatthew G. Knepley     PetscInt     fNb = 0, Nc = 0;
31577c927364SMatthew G. Knepley 
31589566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, f, &obj));
31599566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
316097c42addSMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
316197c42addSMatthew G. Knepley       PetscFE    fe = (PetscFE) obj;
31626f3d3cbcSMatthew G. Knepley       PetscSpace sp;
31639b2fc754SMatthew G. Knepley       PetscInt   maxDegree;
316497c42addSMatthew G. Knepley 
31659566063dSJacob Faibussowitsch       PetscCall(PetscFERefine(fe, &feRef[f]));
31669566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDimension(feRef[f], &fNb));
31679566063dSJacob Faibussowitsch       PetscCall(PetscFEGetNumComponents(fe, &Nc));
31689566063dSJacob Faibussowitsch       PetscCall(PetscFEGetBasisSpace(fe, &sp));
31699566063dSJacob Faibussowitsch       PetscCall(PetscSpaceGetDegree(sp, NULL, &maxDegree));
31709b2fc754SMatthew G. Knepley       if (!maxDegree) needAvg[f] = PETSC_TRUE;
317197c42addSMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
317297c42addSMatthew G. Knepley       PetscFV        fv = (PetscFV) obj;
317397c42addSMatthew G. Knepley       PetscDualSpace Q;
317497c42addSMatthew G. Knepley 
31759566063dSJacob Faibussowitsch       PetscCall(PetscFVRefine(fv, &fvRef[f]));
31769566063dSJacob Faibussowitsch       PetscCall(PetscFVGetDualSpace(fvRef[f], &Q));
31779566063dSJacob Faibussowitsch       PetscCall(PetscDualSpaceGetDimension(Q, &fNb));
31789566063dSJacob Faibussowitsch       PetscCall(PetscFVGetNumComponents(fv, &Nc));
31796f3d3cbcSMatthew G. Knepley       needAvg[f] = PETSC_TRUE;
318097c42addSMatthew G. Knepley     }
3181d172c84bSMatthew G. Knepley     fTotDim += fNb;
31827c927364SMatthew G. Knepley   }
31839566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(prob, &cTotDim));
31849566063dSJacob Faibussowitsch   PetscCall(PetscMalloc1(cTotDim,&cmap));
31857c927364SMatthew G. Knepley   for (field = 0, offsetC = 0, offsetF = 0; field < Nf; ++field) {
31867c927364SMatthew G. Knepley     PetscFE        feC;
318797c42addSMatthew G. Knepley     PetscFV        fvC;
31887c927364SMatthew G. Knepley     PetscDualSpace QF, QC;
3189d172c84bSMatthew G. Knepley     PetscInt       order = -1, NcF, NcC, fpdim, cpdim;
31907c927364SMatthew G. Knepley 
319197c42addSMatthew G. Knepley     if (feRef[field]) {
31929566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(prob, field, (PetscObject *) &feC));
31939566063dSJacob Faibussowitsch       PetscCall(PetscFEGetNumComponents(feC, &NcC));
31949566063dSJacob Faibussowitsch       PetscCall(PetscFEGetNumComponents(feRef[field], &NcF));
31959566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDualSpace(feRef[field], &QF));
31969566063dSJacob Faibussowitsch       PetscCall(PetscDualSpaceGetOrder(QF, &order));
31979566063dSJacob Faibussowitsch       PetscCall(PetscDualSpaceGetDimension(QF, &fpdim));
31989566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDualSpace(feC, &QC));
31999566063dSJacob Faibussowitsch       PetscCall(PetscDualSpaceGetDimension(QC, &cpdim));
320097c42addSMatthew G. Knepley     } else {
32019566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(prob, field, (PetscObject *) &fvC));
32029566063dSJacob Faibussowitsch       PetscCall(PetscFVGetNumComponents(fvC, &NcC));
32039566063dSJacob Faibussowitsch       PetscCall(PetscFVGetNumComponents(fvRef[field], &NcF));
32049566063dSJacob Faibussowitsch       PetscCall(PetscFVGetDualSpace(fvRef[field], &QF));
32059566063dSJacob Faibussowitsch       PetscCall(PetscDualSpaceGetDimension(QF, &fpdim));
32069566063dSJacob Faibussowitsch       PetscCall(PetscFVGetDualSpace(fvC, &QC));
32079566063dSJacob Faibussowitsch       PetscCall(PetscDualSpaceGetDimension(QC, &cpdim));
320897c42addSMatthew G. Knepley     }
320963a3b9bcSJacob Faibussowitsch     PetscCheck(NcF == NcC,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of components in fine space field %" PetscInt_FMT " does not match coarse field %" PetscInt_FMT, NcF, NcC);
32107c927364SMatthew G. Knepley     for (c = 0; c < cpdim; ++c) {
32117c927364SMatthew G. Knepley       PetscQuadrature  cfunc;
3212d172c84bSMatthew G. Knepley       const PetscReal *cqpoints, *cqweights;
3213d172c84bSMatthew G. Knepley       PetscInt         NqcC, NpC;
321497c42addSMatthew G. Knepley       PetscBool        found = PETSC_FALSE;
32157c927364SMatthew G. Knepley 
32169566063dSJacob Faibussowitsch       PetscCall(PetscDualSpaceGetFunctional(QC, c, &cfunc));
32179566063dSJacob Faibussowitsch       PetscCall(PetscQuadratureGetData(cfunc, NULL, &NqcC, &NpC, &cqpoints, &cqweights));
321863a3b9bcSJacob Faibussowitsch       PetscCheck(NqcC == NcC,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of quadrature components %" PetscInt_FMT " must match number of field components %" PetscInt_FMT, NqcC, NcC);
32191dca8a05SBarry Smith       PetscCheck(NpC == 1 || !feRef[field],PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Do not know how to do injection for moments");
32207c927364SMatthew G. Knepley       for (f = 0; f < fpdim; ++f) {
32217c927364SMatthew G. Knepley         PetscQuadrature  ffunc;
3222d172c84bSMatthew G. Knepley         const PetscReal *fqpoints, *fqweights;
32237c927364SMatthew G. Knepley         PetscReal        sum = 0.0;
3224d172c84bSMatthew G. Knepley         PetscInt         NqcF, NpF;
32257c927364SMatthew G. Knepley 
32269566063dSJacob Faibussowitsch         PetscCall(PetscDualSpaceGetFunctional(QF, f, &ffunc));
32279566063dSJacob Faibussowitsch         PetscCall(PetscQuadratureGetData(ffunc, NULL, &NqcF, &NpF, &fqpoints, &fqweights));
322863a3b9bcSJacob Faibussowitsch         PetscCheck(NqcF == NcF,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of quadrature components %" PetscInt_FMT " must match number of field components %" PetscInt_FMT, NqcF, NcF);
32297c927364SMatthew G. Knepley         if (NpC != NpF) continue;
32307c927364SMatthew G. Knepley         for (d = 0; d < dim; ++d) sum += PetscAbsReal(cqpoints[d] - fqpoints[d]);
32317c927364SMatthew G. Knepley         if (sum > 1.0e-9) continue;
3232d172c84bSMatthew G. Knepley         for (d = 0; d < NcC; ++d) sum += PetscAbsReal(cqweights[d]*fqweights[d]);
3233d172c84bSMatthew G. Knepley         if (sum < 1.0e-9) continue;
3234d172c84bSMatthew G. Knepley         cmap[offsetC+c] = offsetF+f;
323597c42addSMatthew G. Knepley         found = PETSC_TRUE;
32367c927364SMatthew G. Knepley         break;
32377c927364SMatthew G. Knepley       }
323897c42addSMatthew G. Knepley       if (!found) {
323997c42addSMatthew G. Knepley         /* TODO We really want the average here, but some asshole put VecScatter in the interface */
3240d172c84bSMatthew G. Knepley         if (fvRef[field] || (feRef[field] && order == 0)) {
3241d172c84bSMatthew G. Knepley           cmap[offsetC+c] = offsetF+0;
324297c42addSMatthew G. Knepley         } else SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Could not locate matching functional for injection");
324397c42addSMatthew G. Knepley       }
32447c927364SMatthew G. Knepley     }
3245d172c84bSMatthew G. Knepley     offsetC += cpdim;
3246d172c84bSMatthew G. Knepley     offsetF += fpdim;
32477c927364SMatthew G. Knepley   }
32489566063dSJacob Faibussowitsch   for (f = 0; f < Nf; ++f) {PetscCall(PetscFEDestroy(&feRef[f]));PetscCall(PetscFVDestroy(&fvRef[f]));}
32499566063dSJacob Faibussowitsch   PetscCall(PetscFree3(feRef,fvRef,needAvg));
32507c927364SMatthew G. Knepley 
32519566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalVector(dmf, &fv));
32529566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalVector(dmc, &cv));
32539566063dSJacob Faibussowitsch   PetscCall(VecGetOwnershipRange(cv, &startC, &endC));
32549566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetConstrainedStorageSize(cglobalSection, &m));
32559566063dSJacob Faibussowitsch   PetscCall(PetscMalloc2(cTotDim,&cellCIndices,fTotDim,&cellFIndices));
32569566063dSJacob Faibussowitsch   PetscCall(PetscMalloc1(m,&cindices));
32579566063dSJacob Faibussowitsch   PetscCall(PetscMalloc1(m,&findices));
32587c927364SMatthew G. Knepley   for (d = 0; d < m; ++d) cindices[d] = findices[d] = -1;
32597c927364SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
32609566063dSJacob Faibussowitsch     PetscCall(DMPlexMatGetClosureIndicesRefined(dmf, fsection, fglobalSection, dmc, csection, cglobalSection, c, cellCIndices, cellFIndices));
32617c927364SMatthew G. Knepley     for (d = 0; d < cTotDim; ++d) {
32620bd915a7SMatthew G. Knepley       if ((cellCIndices[d] < startC) || (cellCIndices[d] >= endC)) continue;
326363a3b9bcSJacob Faibussowitsch       PetscCheck(!(findices[cellCIndices[d]-startC] >= 0) || !(findices[cellCIndices[d]-startC] != cellFIndices[cmap[d]]),PETSC_COMM_SELF, PETSC_ERR_PLIB, "Coarse dof %" PetscInt_FMT " maps to both %" PetscInt_FMT " and %" PetscInt_FMT, cindices[cellCIndices[d]-startC], findices[cellCIndices[d]-startC], cellFIndices[cmap[d]]);
32647c927364SMatthew G. Knepley       cindices[cellCIndices[d]-startC] = cellCIndices[d];
32657c927364SMatthew G. Knepley       findices[cellCIndices[d]-startC] = cellFIndices[cmap[d]];
32667c927364SMatthew G. Knepley     }
32677c927364SMatthew G. Knepley   }
32689566063dSJacob Faibussowitsch   PetscCall(PetscFree(cmap));
32699566063dSJacob Faibussowitsch   PetscCall(PetscFree2(cellCIndices,cellFIndices));
32707c927364SMatthew G. Knepley 
32719566063dSJacob Faibussowitsch   PetscCall(ISCreateGeneral(PETSC_COMM_SELF, m, cindices, PETSC_OWN_POINTER, &cis));
32729566063dSJacob Faibussowitsch   PetscCall(ISCreateGeneral(PETSC_COMM_SELF, m, findices, PETSC_OWN_POINTER, &fis));
32739566063dSJacob Faibussowitsch   PetscCall(VecScatterCreate(cv, cis, fv, fis, sc));
32749566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&cis));
32759566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&fis));
32769566063dSJacob Faibussowitsch   PetscCall(DMRestoreGlobalVector(dmf, &fv));
32779566063dSJacob Faibussowitsch   PetscCall(DMRestoreGlobalVector(dmc, &cv));
32789566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_InjectorFEM,dmc,dmf,0,0));
3279cb1e1211SMatthew G Knepley   PetscFunctionReturn(0);
3280cb1e1211SMatthew G Knepley }
3281a1cf66bbSMatthew G. Knepley 
32822f856554SMatthew G. Knepley /*@C
32832f856554SMatthew G. Knepley   DMPlexGetCellFields - Retrieve the field values values for a chunk of cells
32842f856554SMatthew G. Knepley 
32852f856554SMatthew G. Knepley   Input Parameters:
32862f856554SMatthew G. Knepley + dm     - The DM
32872f856554SMatthew G. Knepley . cellIS - The cells to include
32882f856554SMatthew G. Knepley . locX   - A local vector with the solution fields
32892f856554SMatthew G. Knepley . locX_t - A local vector with solution field time derivatives, or NULL
32902f856554SMatthew G. Knepley - locA   - A local vector with auxiliary fields, or NULL
32912f856554SMatthew G. Knepley 
32922f856554SMatthew G. Knepley   Output Parameters:
32932f856554SMatthew G. Knepley + u   - The field coefficients
32942f856554SMatthew G. Knepley . u_t - The fields derivative coefficients
32952f856554SMatthew G. Knepley - a   - The auxiliary field coefficients
32962f856554SMatthew G. Knepley 
32972f856554SMatthew G. Knepley   Level: developer
32982f856554SMatthew G. Knepley 
3299db781477SPatrick Sanan .seealso: `DMPlexGetFaceFields()`
33002f856554SMatthew G. Knepley @*/
33012f856554SMatthew G. Knepley PetscErrorCode DMPlexGetCellFields(DM dm, IS cellIS, Vec locX, Vec locX_t, Vec locA, PetscScalar **u, PetscScalar **u_t, PetscScalar **a)
33022f856554SMatthew G. Knepley {
33032f856554SMatthew G. Knepley   DM              plex, plexA = NULL;
3304a6e0b375SMatthew G. Knepley   DMEnclosureType encAux;
33052f856554SMatthew G. Knepley   PetscSection    section, sectionAux;
33062f856554SMatthew G. Knepley   PetscDS         prob;
33072f856554SMatthew G. Knepley   const PetscInt *cells;
33082f856554SMatthew G. Knepley   PetscInt        cStart, cEnd, numCells, totDim, totDimAux, c;
33092f856554SMatthew G. Knepley 
33102f856554SMatthew G. Knepley   PetscFunctionBegin;
33112f856554SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
3312064a246eSJacob Faibussowitsch   PetscValidHeaderSpecific(locX, VEC_CLASSID, 3);
3313064a246eSJacob Faibussowitsch   if (locX_t) {PetscValidHeaderSpecific(locX_t, VEC_CLASSID, 4);}
3314064a246eSJacob Faibussowitsch   if (locA)   {PetscValidHeaderSpecific(locA, VEC_CLASSID, 5);}
3315064a246eSJacob Faibussowitsch   PetscValidPointer(u, 6);
3316064a246eSJacob Faibussowitsch   PetscValidPointer(u_t, 7);
3317064a246eSJacob Faibussowitsch   PetscValidPointer(a, 8);
33189566063dSJacob Faibussowitsch   PetscCall(DMPlexConvertPlex(dm, &plex, PETSC_FALSE));
33199566063dSJacob Faibussowitsch   PetscCall(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
33209566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
33219566063dSJacob Faibussowitsch   PetscCall(DMGetCellDS(dm, cells ? cells[cStart] : cStart, &prob));
33229566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(prob, &totDim));
33232f856554SMatthew G. Knepley   if (locA) {
33242f856554SMatthew G. Knepley     DM      dmAux;
33252f856554SMatthew G. Knepley     PetscDS probAux;
33262f856554SMatthew G. Knepley 
33279566063dSJacob Faibussowitsch     PetscCall(VecGetDM(locA, &dmAux));
33289566063dSJacob Faibussowitsch     PetscCall(DMGetEnclosureRelation(dmAux, dm, &encAux));
33299566063dSJacob Faibussowitsch     PetscCall(DMPlexConvertPlex(dmAux, &plexA, PETSC_FALSE));
33309566063dSJacob Faibussowitsch     PetscCall(DMGetLocalSection(dmAux, &sectionAux));
33319566063dSJacob Faibussowitsch     PetscCall(DMGetDS(dmAux, &probAux));
33329566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalDimension(probAux, &totDimAux));
33332f856554SMatthew G. Knepley   }
33342f856554SMatthew G. Knepley   numCells = cEnd - cStart;
33359566063dSJacob Faibussowitsch   PetscCall(DMGetWorkArray(dm, numCells*totDim, MPIU_SCALAR, u));
33369566063dSJacob Faibussowitsch   if (locX_t) PetscCall(DMGetWorkArray(dm, numCells*totDim, MPIU_SCALAR, u_t)); else {*u_t = NULL;}
33379566063dSJacob Faibussowitsch   if (locA)   PetscCall(DMGetWorkArray(dm, numCells*totDimAux, MPIU_SCALAR, a)); else {*a = NULL;}
33382f856554SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
33392f856554SMatthew G. Knepley     const PetscInt cell = cells ? cells[c] : c;
33402f856554SMatthew G. Knepley     const PetscInt cind = c - cStart;
33412f856554SMatthew G. Knepley     PetscScalar   *x = NULL, *x_t = NULL, *ul = *u, *ul_t = *u_t, *al = *a;
33422f856554SMatthew G. Knepley     PetscInt       i;
33432f856554SMatthew G. Knepley 
33449566063dSJacob Faibussowitsch     PetscCall(DMPlexVecGetClosure(plex, section, locX, cell, NULL, &x));
33452f856554SMatthew G. Knepley     for (i = 0; i < totDim; ++i) ul[cind*totDim+i] = x[i];
33469566063dSJacob Faibussowitsch     PetscCall(DMPlexVecRestoreClosure(plex, section, locX, cell, NULL, &x));
33472f856554SMatthew G. Knepley     if (locX_t) {
33489566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(plex, section, locX_t, cell, NULL, &x_t));
33492f856554SMatthew G. Knepley       for (i = 0; i < totDim; ++i) ul_t[cind*totDim+i] = x_t[i];
33509566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(plex, section, locX_t, cell, NULL, &x_t));
33512f856554SMatthew G. Knepley     }
33522f856554SMatthew G. Knepley     if (locA) {
33532f856554SMatthew G. Knepley       PetscInt subcell;
33549566063dSJacob Faibussowitsch       PetscCall(DMGetEnclosurePoint(plexA, dm, encAux, cell, &subcell));
33559566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(plexA, sectionAux, locA, subcell, NULL, &x));
33562f856554SMatthew G. Knepley       for (i = 0; i < totDimAux; ++i) al[cind*totDimAux+i] = x[i];
33579566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(plexA, sectionAux, locA, subcell, NULL, &x));
33582f856554SMatthew G. Knepley     }
33592f856554SMatthew G. Knepley   }
33609566063dSJacob Faibussowitsch   PetscCall(DMDestroy(&plex));
33619566063dSJacob Faibussowitsch   if (locA) PetscCall(DMDestroy(&plexA));
33629566063dSJacob Faibussowitsch   PetscCall(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
33632f856554SMatthew G. Knepley   PetscFunctionReturn(0);
33642f856554SMatthew G. Knepley }
33652f856554SMatthew G. Knepley 
33662f856554SMatthew G. Knepley /*@C
33672f856554SMatthew G. Knepley   DMPlexRestoreCellFields - Restore the field values values for a chunk of cells
33682f856554SMatthew G. Knepley 
33692f856554SMatthew G. Knepley   Input Parameters:
33702f856554SMatthew G. Knepley + dm     - The DM
33712f856554SMatthew G. Knepley . cellIS - The cells to include
33722f856554SMatthew G. Knepley . locX   - A local vector with the solution fields
33732f856554SMatthew G. Knepley . locX_t - A local vector with solution field time derivatives, or NULL
33742f856554SMatthew G. Knepley - locA   - A local vector with auxiliary fields, or NULL
33752f856554SMatthew G. Knepley 
33762f856554SMatthew G. Knepley   Output Parameters:
33772f856554SMatthew G. Knepley + u   - The field coefficients
33782f856554SMatthew G. Knepley . u_t - The fields derivative coefficients
33792f856554SMatthew G. Knepley - a   - The auxiliary field coefficients
33802f856554SMatthew G. Knepley 
33812f856554SMatthew G. Knepley   Level: developer
33822f856554SMatthew G. Knepley 
3383db781477SPatrick Sanan .seealso: `DMPlexGetFaceFields()`
33842f856554SMatthew G. Knepley @*/
33852f856554SMatthew G. Knepley PetscErrorCode DMPlexRestoreCellFields(DM dm, IS cellIS, Vec locX, Vec locX_t, Vec locA, PetscScalar **u, PetscScalar **u_t, PetscScalar **a)
33862f856554SMatthew G. Knepley {
33872f856554SMatthew G. Knepley   PetscFunctionBegin;
33889566063dSJacob Faibussowitsch   PetscCall(DMRestoreWorkArray(dm, 0, MPIU_SCALAR, u));
33899566063dSJacob Faibussowitsch   if (locX_t) PetscCall(DMRestoreWorkArray(dm, 0, MPIU_SCALAR, u_t));
33909566063dSJacob Faibussowitsch   if (locA)   PetscCall(DMRestoreWorkArray(dm, 0, MPIU_SCALAR, a));
33912f856554SMatthew G. Knepley   PetscFunctionReturn(0);
33922f856554SMatthew G. Knepley }
33932f856554SMatthew G. Knepley 
3394faff4f7fSMatthew G. Knepley /*
3395faff4f7fSMatthew G. Knepley   Get the auxiliary field vectors for the negative side (s = 0) and positive side (s = 1) of the interfaace
3396faff4f7fSMatthew G. Knepley */
3397148442b3SMatthew G. Knepley static PetscErrorCode DMPlexGetHybridAuxFields(DM dm, DM dmAux[], PetscDS dsAux[], IS cellIS, Vec locA[], PetscScalar *a[])
33986528b96dSMatthew G. Knepley {
339904c51a94SMatthew G. Knepley   DM              plexA[2];
3400148442b3SMatthew G. Knepley   DMEnclosureType encAux[2];
340104c51a94SMatthew G. Knepley   PetscSection    sectionAux[2];
34026528b96dSMatthew G. Knepley   const PetscInt *cells;
3403148442b3SMatthew G. Knepley   PetscInt        cStart, cEnd, numCells, c, s, totDimAux[2];
34046528b96dSMatthew G. Knepley 
34056528b96dSMatthew G. Knepley   PetscFunctionBegin;
3406148442b3SMatthew G. Knepley   PetscValidPointer(locA, 5);
340704c51a94SMatthew G. Knepley   if (!locA[0] || !locA[1]) PetscFunctionReturn(0);
3408148442b3SMatthew G. Knepley   PetscValidPointer(dmAux, 2);
3409148442b3SMatthew G. Knepley   PetscValidPointer(dsAux, 3);
3410148442b3SMatthew G. Knepley   PetscValidPointer(a, 6);
34119566063dSJacob Faibussowitsch   PetscCall(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
34126528b96dSMatthew G. Knepley   numCells = cEnd - cStart;
3413148442b3SMatthew G. Knepley   for (s = 0; s < 2; ++s) {
3414148442b3SMatthew G. Knepley     PetscValidHeaderSpecific(dmAux[s], DM_CLASSID, 2);
3415148442b3SMatthew G. Knepley     PetscValidHeaderSpecific(dsAux[s], PETSCDS_CLASSID, 3);
3416148442b3SMatthew G. Knepley     PetscValidHeaderSpecific(locA[s], VEC_CLASSID, 5);
34179566063dSJacob Faibussowitsch     PetscCall(DMPlexConvertPlex(dmAux[s], &plexA[s], PETSC_FALSE));
34189566063dSJacob Faibussowitsch     PetscCall(DMGetEnclosureRelation(dmAux[s], dm, &encAux[s]));
34199566063dSJacob Faibussowitsch     PetscCall(DMGetLocalSection(dmAux[s], &sectionAux[s]));
34209566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalDimension(dsAux[s], &totDimAux[s]));
34219566063dSJacob Faibussowitsch     PetscCall(DMGetWorkArray(dmAux[s], numCells*totDimAux[s], MPIU_SCALAR, &a[s]));
342204c51a94SMatthew G. Knepley   }
3423148442b3SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
34246528b96dSMatthew G. Knepley     const PetscInt  cell = cells ? cells[c] : c;
34256528b96dSMatthew G. Knepley     const PetscInt  cind = c - cStart;
34266528b96dSMatthew G. Knepley     const PetscInt *cone, *ornt;
34276528b96dSMatthew G. Knepley 
34289566063dSJacob Faibussowitsch     PetscCall(DMPlexGetCone(dm, cell, &cone));
34299566063dSJacob Faibussowitsch     PetscCall(DMPlexGetConeOrientation(dm, cell, &ornt));
3430148442b3SMatthew G. Knepley     for (s = 0; s < 2; ++s) {
34315fedec97SMatthew G. Knepley       const PetscInt *support;
3432148442b3SMatthew G. Knepley       PetscScalar    *x = NULL, *al = a[s];
3433148442b3SMatthew G. Knepley       const PetscInt  tdA = totDimAux[s];
34345fedec97SMatthew G. Knepley       PetscInt        ssize, scell;
3435148442b3SMatthew G. Knepley       PetscInt        subface, Na, i;
34366528b96dSMatthew G. Knepley 
34379566063dSJacob Faibussowitsch       PetscCall(DMPlexGetSupport(dm, cone[s], &support));
34389566063dSJacob Faibussowitsch       PetscCall(DMPlexGetSupportSize(dm, cone[s], &ssize));
343963a3b9bcSJacob Faibussowitsch       PetscCheck(ssize == 2,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Face %" PetscInt_FMT " from cell %" PetscInt_FMT " has support size %" PetscInt_FMT " != 2", cone[s], cell, ssize);
34405fedec97SMatthew G. Knepley       if      (support[0] == cell) scell = support[1];
34415fedec97SMatthew G. Knepley       else if (support[1] == cell) scell = support[0];
344263a3b9bcSJacob Faibussowitsch       else SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Face %" PetscInt_FMT " does not have cell %" PetscInt_FMT " in its support", cone[s], cell);
34435fedec97SMatthew G. Knepley 
34449566063dSJacob Faibussowitsch       PetscCall(DMGetEnclosurePoint(plexA[s], dm, encAux[s], scell, &subface));
34459566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(plexA[s], sectionAux[s], locA[s], subface, &Na, &x));
34466528b96dSMatthew G. Knepley       for (i = 0; i < Na; ++i) al[cind*tdA+i] = x[i];
34479566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(plexA[s], sectionAux[s], locA[s], subface, &Na, &x));
34486528b96dSMatthew G. Knepley     }
34496528b96dSMatthew G. Knepley   }
34509566063dSJacob Faibussowitsch   for (s = 0; s < 2; ++s) PetscCall(DMDestroy(&plexA[s]));
34519566063dSJacob Faibussowitsch   PetscCall(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
34526528b96dSMatthew G. Knepley   PetscFunctionReturn(0);
34536528b96dSMatthew G. Knepley }
34546528b96dSMatthew G. Knepley 
345504c51a94SMatthew G. Knepley static PetscErrorCode DMPlexRestoreHybridAuxFields(DM dmAux[], PetscDS dsAux[], IS cellIS, Vec locA[], PetscScalar *a[])
34566528b96dSMatthew G. Knepley {
34576528b96dSMatthew G. Knepley   PetscFunctionBegin;
345804c51a94SMatthew G. Knepley   if (!locA[0] || !locA[1]) PetscFunctionReturn(0);
34599566063dSJacob Faibussowitsch   PetscCall(DMRestoreWorkArray(dmAux[0], 0, MPIU_SCALAR, &a[0]));
34609566063dSJacob Faibussowitsch   PetscCall(DMRestoreWorkArray(dmAux[1], 0, MPIU_SCALAR, &a[1]));
34616528b96dSMatthew G. Knepley   PetscFunctionReturn(0);
34626528b96dSMatthew G. Knepley }
34636528b96dSMatthew G. Knepley 
34642f856554SMatthew G. Knepley /*@C
34652f856554SMatthew G. Knepley   DMPlexGetFaceFields - Retrieve the field values values for a chunk of faces
34662f856554SMatthew G. Knepley 
34672f856554SMatthew G. Knepley   Input Parameters:
34682f856554SMatthew G. Knepley + dm     - The DM
34692f856554SMatthew G. Knepley . fStart - The first face to include
34702f856554SMatthew G. Knepley . fEnd   - The first face to exclude
34712f856554SMatthew G. Knepley . locX   - A local vector with the solution fields
34722f856554SMatthew G. Knepley . locX_t - A local vector with solution field time derivatives, or NULL
34732f856554SMatthew G. Knepley . faceGeometry - A local vector with face geometry
34742f856554SMatthew G. Knepley . cellGeometry - A local vector with cell geometry
34752f856554SMatthew G. Knepley - locaGrad - A local vector with field gradients, or NULL
34762f856554SMatthew G. Knepley 
34772f856554SMatthew G. Knepley   Output Parameters:
34782f856554SMatthew G. Knepley + Nface - The number of faces with field values
34792f856554SMatthew G. Knepley . uL - The field values at the left side of the face
34802f856554SMatthew G. Knepley - uR - The field values at the right side of the face
34812f856554SMatthew G. Knepley 
34822f856554SMatthew G. Knepley   Level: developer
34832f856554SMatthew G. Knepley 
3484db781477SPatrick Sanan .seealso: `DMPlexGetCellFields()`
34852f856554SMatthew G. Knepley @*/
34862f856554SMatthew 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)
34872f856554SMatthew G. Knepley {
34882f856554SMatthew G. Knepley   DM                 dmFace, dmCell, dmGrad = NULL;
34892f856554SMatthew G. Knepley   PetscSection       section;
34902f856554SMatthew G. Knepley   PetscDS            prob;
34912f856554SMatthew G. Knepley   DMLabel            ghostLabel;
34922f856554SMatthew G. Knepley   const PetscScalar *facegeom, *cellgeom, *x, *lgrad;
34932f856554SMatthew G. Knepley   PetscBool         *isFE;
34942f856554SMatthew G. Knepley   PetscInt           dim, Nf, f, Nc, numFaces = fEnd - fStart, iface, face;
34952f856554SMatthew G. Knepley 
34962f856554SMatthew G. Knepley   PetscFunctionBegin;
34972f856554SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
34982f856554SMatthew G. Knepley   PetscValidHeaderSpecific(locX, VEC_CLASSID, 4);
34992f856554SMatthew G. Knepley   if (locX_t) {PetscValidHeaderSpecific(locX_t, VEC_CLASSID, 5);}
35002f856554SMatthew G. Knepley   PetscValidHeaderSpecific(faceGeometry, VEC_CLASSID, 6);
35012f856554SMatthew G. Knepley   PetscValidHeaderSpecific(cellGeometry, VEC_CLASSID, 7);
35022f856554SMatthew G. Knepley   if (locGrad) {PetscValidHeaderSpecific(locGrad, VEC_CLASSID, 8);}
3503064a246eSJacob Faibussowitsch   PetscValidPointer(uL, 10);
3504064a246eSJacob Faibussowitsch   PetscValidPointer(uR, 11);
35059566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
35069566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dm, &prob));
35079566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
35089566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumFields(prob, &Nf));
35099566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalComponents(prob, &Nc));
35109566063dSJacob Faibussowitsch   PetscCall(PetscMalloc1(Nf, &isFE));
35112f856554SMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
35122f856554SMatthew G. Knepley     PetscObject  obj;
35132f856554SMatthew G. Knepley     PetscClassId id;
35142f856554SMatthew G. Knepley 
35159566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, f, &obj));
35169566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
35172f856554SMatthew G. Knepley     if (id == PETSCFE_CLASSID)      {isFE[f] = PETSC_TRUE;}
35182f856554SMatthew G. Knepley     else if (id == PETSCFV_CLASSID) {isFE[f] = PETSC_FALSE;}
35192f856554SMatthew G. Knepley     else                            {isFE[f] = PETSC_FALSE;}
35202f856554SMatthew G. Knepley   }
35219566063dSJacob Faibussowitsch   PetscCall(DMGetLabel(dm, "ghost", &ghostLabel));
35229566063dSJacob Faibussowitsch   PetscCall(VecGetArrayRead(locX, &x));
35239566063dSJacob Faibussowitsch   PetscCall(VecGetDM(faceGeometry, &dmFace));
35249566063dSJacob Faibussowitsch   PetscCall(VecGetArrayRead(faceGeometry, &facegeom));
35259566063dSJacob Faibussowitsch   PetscCall(VecGetDM(cellGeometry, &dmCell));
35269566063dSJacob Faibussowitsch   PetscCall(VecGetArrayRead(cellGeometry, &cellgeom));
35272f856554SMatthew G. Knepley   if (locGrad) {
35289566063dSJacob Faibussowitsch     PetscCall(VecGetDM(locGrad, &dmGrad));
35299566063dSJacob Faibussowitsch     PetscCall(VecGetArrayRead(locGrad, &lgrad));
35302f856554SMatthew G. Knepley   }
35319566063dSJacob Faibussowitsch   PetscCall(DMGetWorkArray(dm, numFaces*Nc, MPIU_SCALAR, uL));
35329566063dSJacob Faibussowitsch   PetscCall(DMGetWorkArray(dm, numFaces*Nc, MPIU_SCALAR, uR));
35332f856554SMatthew G. Knepley   /* Right now just eat the extra work for FE (could make a cell loop) */
35342f856554SMatthew G. Knepley   for (face = fStart, iface = 0; face < fEnd; ++face) {
35352f856554SMatthew G. Knepley     const PetscInt        *cells;
35362f856554SMatthew G. Knepley     PetscFVFaceGeom       *fg;
35372f856554SMatthew G. Knepley     PetscFVCellGeom       *cgL, *cgR;
35382f856554SMatthew G. Knepley     PetscScalar           *xL, *xR, *gL, *gR;
35392f856554SMatthew G. Knepley     PetscScalar           *uLl = *uL, *uRl = *uR;
35402f856554SMatthew G. Knepley     PetscInt               ghost, nsupp, nchild;
35412f856554SMatthew G. Knepley 
35429566063dSJacob Faibussowitsch     PetscCall(DMLabelGetValue(ghostLabel, face, &ghost));
35439566063dSJacob Faibussowitsch     PetscCall(DMPlexGetSupportSize(dm, face, &nsupp));
35449566063dSJacob Faibussowitsch     PetscCall(DMPlexGetTreeChildren(dm, face, &nchild, NULL));
35452f856554SMatthew G. Knepley     if (ghost >= 0 || nsupp > 2 || nchild > 0) continue;
35469566063dSJacob Faibussowitsch     PetscCall(DMPlexPointLocalRead(dmFace, face, facegeom, &fg));
35479566063dSJacob Faibussowitsch     PetscCall(DMPlexGetSupport(dm, face, &cells));
35489566063dSJacob Faibussowitsch     PetscCall(DMPlexPointLocalRead(dmCell, cells[0], cellgeom, &cgL));
35499566063dSJacob Faibussowitsch     PetscCall(DMPlexPointLocalRead(dmCell, cells[1], cellgeom, &cgR));
35502f856554SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
35512f856554SMatthew G. Knepley       PetscInt off;
35522f856554SMatthew G. Knepley 
35539566063dSJacob Faibussowitsch       PetscCall(PetscDSGetComponentOffset(prob, f, &off));
35542f856554SMatthew G. Knepley       if (isFE[f]) {
35552f856554SMatthew G. Knepley         const PetscInt *cone;
35562f856554SMatthew G. Knepley         PetscInt        comp, coneSizeL, coneSizeR, faceLocL, faceLocR, ldof, rdof, d;
35572f856554SMatthew G. Knepley 
35582f856554SMatthew G. Knepley         xL = xR = NULL;
35599566063dSJacob Faibussowitsch         PetscCall(PetscSectionGetFieldComponents(section, f, &comp));
35609566063dSJacob Faibussowitsch         PetscCall(DMPlexVecGetClosure(dm, section, locX, cells[0], &ldof, (PetscScalar **) &xL));
35619566063dSJacob Faibussowitsch         PetscCall(DMPlexVecGetClosure(dm, section, locX, cells[1], &rdof, (PetscScalar **) &xR));
35629566063dSJacob Faibussowitsch         PetscCall(DMPlexGetCone(dm, cells[0], &cone));
35639566063dSJacob Faibussowitsch         PetscCall(DMPlexGetConeSize(dm, cells[0], &coneSizeL));
35642f856554SMatthew G. Knepley         for (faceLocL = 0; faceLocL < coneSizeL; ++faceLocL) if (cone[faceLocL] == face) break;
35659566063dSJacob Faibussowitsch         PetscCall(DMPlexGetCone(dm, cells[1], &cone));
35669566063dSJacob Faibussowitsch         PetscCall(DMPlexGetConeSize(dm, cells[1], &coneSizeR));
35672f856554SMatthew G. Knepley         for (faceLocR = 0; faceLocR < coneSizeR; ++faceLocR) if (cone[faceLocR] == face) break;
35681dca8a05SBarry Smith         PetscCheck(faceLocL != coneSizeL || faceLocR != coneSizeR,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Could not find face %" PetscInt_FMT " in cone of cell %" PetscInt_FMT " or cell %" PetscInt_FMT, face, cells[0], cells[1]);
35692f856554SMatthew G. Knepley         /* Check that FEM field has values in the right cell (sometimes its an FV ghost cell) */
35702f856554SMatthew G. Knepley         /* TODO: this is a hack that might not be right for nonconforming */
35712f856554SMatthew G. Knepley         if (faceLocL < coneSizeL) {
35729566063dSJacob Faibussowitsch           PetscCall(PetscFEEvaluateFaceFields_Internal(prob, f, faceLocL, xL, &uLl[iface*Nc+off]));
35739566063dSJacob Faibussowitsch           if (rdof == ldof && faceLocR < coneSizeR) PetscCall(PetscFEEvaluateFaceFields_Internal(prob, f, faceLocR, xR, &uRl[iface*Nc+off]));
35742f856554SMatthew G. Knepley           else              {for (d = 0; d < comp; ++d) uRl[iface*Nc+off+d] = uLl[iface*Nc+off+d];}
35752f856554SMatthew G. Knepley         }
35762f856554SMatthew G. Knepley         else {
35779566063dSJacob Faibussowitsch           PetscCall(PetscFEEvaluateFaceFields_Internal(prob, f, faceLocR, xR, &uRl[iface*Nc+off]));
35789566063dSJacob Faibussowitsch           PetscCall(PetscSectionGetFieldComponents(section, f, &comp));
35792f856554SMatthew G. Knepley           for (d = 0; d < comp; ++d) uLl[iface*Nc+off+d] = uRl[iface*Nc+off+d];
35802f856554SMatthew G. Knepley         }
35819566063dSJacob Faibussowitsch         PetscCall(DMPlexVecRestoreClosure(dm, section, locX, cells[0], &ldof, (PetscScalar **) &xL));
35829566063dSJacob Faibussowitsch         PetscCall(DMPlexVecRestoreClosure(dm, section, locX, cells[1], &rdof, (PetscScalar **) &xR));
35832f856554SMatthew G. Knepley       } else {
35842f856554SMatthew G. Knepley         PetscFV  fv;
35852f856554SMatthew G. Knepley         PetscInt numComp, c;
35862f856554SMatthew G. Knepley 
35879566063dSJacob Faibussowitsch         PetscCall(PetscDSGetDiscretization(prob, f, (PetscObject *) &fv));
35889566063dSJacob Faibussowitsch         PetscCall(PetscFVGetNumComponents(fv, &numComp));
35899566063dSJacob Faibussowitsch         PetscCall(DMPlexPointLocalFieldRead(dm, cells[0], f, x, &xL));
35909566063dSJacob Faibussowitsch         PetscCall(DMPlexPointLocalFieldRead(dm, cells[1], f, x, &xR));
35912f856554SMatthew G. Knepley         if (dmGrad) {
35922f856554SMatthew G. Knepley           PetscReal dxL[3], dxR[3];
35932f856554SMatthew G. Knepley 
35949566063dSJacob Faibussowitsch           PetscCall(DMPlexPointLocalRead(dmGrad, cells[0], lgrad, &gL));
35959566063dSJacob Faibussowitsch           PetscCall(DMPlexPointLocalRead(dmGrad, cells[1], lgrad, &gR));
35962f856554SMatthew G. Knepley           DMPlex_WaxpyD_Internal(dim, -1, cgL->centroid, fg->centroid, dxL);
35972f856554SMatthew G. Knepley           DMPlex_WaxpyD_Internal(dim, -1, cgR->centroid, fg->centroid, dxR);
35982f856554SMatthew G. Knepley           for (c = 0; c < numComp; ++c) {
35992f856554SMatthew G. Knepley             uLl[iface*Nc+off+c] = xL[c] + DMPlex_DotD_Internal(dim, &gL[c*dim], dxL);
36002f856554SMatthew G. Knepley             uRl[iface*Nc+off+c] = xR[c] + DMPlex_DotD_Internal(dim, &gR[c*dim], dxR);
36012f856554SMatthew G. Knepley           }
36022f856554SMatthew G. Knepley         } else {
36032f856554SMatthew G. Knepley           for (c = 0; c < numComp; ++c) {
36042f856554SMatthew G. Knepley             uLl[iface*Nc+off+c] = xL[c];
36052f856554SMatthew G. Knepley             uRl[iface*Nc+off+c] = xR[c];
36062f856554SMatthew G. Knepley           }
36072f856554SMatthew G. Knepley         }
36082f856554SMatthew G. Knepley       }
36092f856554SMatthew G. Knepley     }
36102f856554SMatthew G. Knepley     ++iface;
36112f856554SMatthew G. Knepley   }
36122f856554SMatthew G. Knepley   *Nface = iface;
36139566063dSJacob Faibussowitsch   PetscCall(VecRestoreArrayRead(locX, &x));
36149566063dSJacob Faibussowitsch   PetscCall(VecRestoreArrayRead(faceGeometry, &facegeom));
36159566063dSJacob Faibussowitsch   PetscCall(VecRestoreArrayRead(cellGeometry, &cellgeom));
36162f856554SMatthew G. Knepley   if (locGrad) {
36179566063dSJacob Faibussowitsch     PetscCall(VecRestoreArrayRead(locGrad, &lgrad));
36182f856554SMatthew G. Knepley   }
36199566063dSJacob Faibussowitsch   PetscCall(PetscFree(isFE));
36202f856554SMatthew G. Knepley   PetscFunctionReturn(0);
36212f856554SMatthew G. Knepley }
36222f856554SMatthew G. Knepley 
36232f856554SMatthew G. Knepley /*@C
36242f856554SMatthew G. Knepley   DMPlexRestoreFaceFields - Restore the field values values for a chunk of faces
36252f856554SMatthew G. Knepley 
36262f856554SMatthew G. Knepley   Input Parameters:
36272f856554SMatthew G. Knepley + dm     - The DM
36282f856554SMatthew G. Knepley . fStart - The first face to include
36292f856554SMatthew G. Knepley . fEnd   - The first face to exclude
36302f856554SMatthew G. Knepley . locX   - A local vector with the solution fields
36312f856554SMatthew G. Knepley . locX_t - A local vector with solution field time derivatives, or NULL
36322f856554SMatthew G. Knepley . faceGeometry - A local vector with face geometry
36332f856554SMatthew G. Knepley . cellGeometry - A local vector with cell geometry
36342f856554SMatthew G. Knepley - locaGrad - A local vector with field gradients, or NULL
36352f856554SMatthew G. Knepley 
36362f856554SMatthew G. Knepley   Output Parameters:
36372f856554SMatthew G. Knepley + Nface - The number of faces with field values
36382f856554SMatthew G. Knepley . uL - The field values at the left side of the face
36392f856554SMatthew G. Knepley - uR - The field values at the right side of the face
36402f856554SMatthew G. Knepley 
36412f856554SMatthew G. Knepley   Level: developer
36422f856554SMatthew G. Knepley 
3643db781477SPatrick Sanan .seealso: `DMPlexGetFaceFields()`
36442f856554SMatthew G. Knepley @*/
36452f856554SMatthew 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)
36462f856554SMatthew G. Knepley {
36472f856554SMatthew G. Knepley   PetscFunctionBegin;
36489566063dSJacob Faibussowitsch   PetscCall(DMRestoreWorkArray(dm, 0, MPIU_SCALAR, uL));
36499566063dSJacob Faibussowitsch   PetscCall(DMRestoreWorkArray(dm, 0, MPIU_SCALAR, uR));
36502f856554SMatthew G. Knepley   PetscFunctionReturn(0);
36512f856554SMatthew G. Knepley }
36522f856554SMatthew G. Knepley 
36532f856554SMatthew G. Knepley /*@C
36542f856554SMatthew G. Knepley   DMPlexGetFaceGeometry - Retrieve the geometric values for a chunk of faces
36552f856554SMatthew G. Knepley 
36562f856554SMatthew G. Knepley   Input Parameters:
36572f856554SMatthew G. Knepley + dm     - The DM
36582f856554SMatthew G. Knepley . fStart - The first face to include
36592f856554SMatthew G. Knepley . fEnd   - The first face to exclude
36602f856554SMatthew G. Knepley . faceGeometry - A local vector with face geometry
36612f856554SMatthew G. Knepley - cellGeometry - A local vector with cell geometry
36622f856554SMatthew G. Knepley 
36632f856554SMatthew G. Knepley   Output Parameters:
36642f856554SMatthew G. Knepley + Nface - The number of faces with field values
36652f856554SMatthew G. Knepley . fgeom - The extract the face centroid and normal
36662f856554SMatthew G. Knepley - vol   - The cell volume
36672f856554SMatthew G. Knepley 
36682f856554SMatthew G. Knepley   Level: developer
36692f856554SMatthew G. Knepley 
3670db781477SPatrick Sanan .seealso: `DMPlexGetCellFields()`
36712f856554SMatthew G. Knepley @*/
36722f856554SMatthew G. Knepley PetscErrorCode DMPlexGetFaceGeometry(DM dm, PetscInt fStart, PetscInt fEnd, Vec faceGeometry, Vec cellGeometry, PetscInt *Nface, PetscFVFaceGeom **fgeom, PetscReal **vol)
36732f856554SMatthew G. Knepley {
36742f856554SMatthew G. Knepley   DM                 dmFace, dmCell;
36752f856554SMatthew G. Knepley   DMLabel            ghostLabel;
36762f856554SMatthew G. Knepley   const PetscScalar *facegeom, *cellgeom;
36772f856554SMatthew G. Knepley   PetscInt           dim, numFaces = fEnd - fStart, iface, face;
36782f856554SMatthew G. Knepley 
36792f856554SMatthew G. Knepley   PetscFunctionBegin;
36802f856554SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
36812f856554SMatthew G. Knepley   PetscValidHeaderSpecific(faceGeometry, VEC_CLASSID, 4);
36822f856554SMatthew G. Knepley   PetscValidHeaderSpecific(cellGeometry, VEC_CLASSID, 5);
3683064a246eSJacob Faibussowitsch   PetscValidPointer(fgeom, 7);
3684064a246eSJacob Faibussowitsch   PetscValidPointer(vol, 8);
36859566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
36869566063dSJacob Faibussowitsch   PetscCall(DMGetLabel(dm, "ghost", &ghostLabel));
36879566063dSJacob Faibussowitsch   PetscCall(VecGetDM(faceGeometry, &dmFace));
36889566063dSJacob Faibussowitsch   PetscCall(VecGetArrayRead(faceGeometry, &facegeom));
36899566063dSJacob Faibussowitsch   PetscCall(VecGetDM(cellGeometry, &dmCell));
36909566063dSJacob Faibussowitsch   PetscCall(VecGetArrayRead(cellGeometry, &cellgeom));
36919566063dSJacob Faibussowitsch   PetscCall(PetscMalloc1(numFaces, fgeom));
36929566063dSJacob Faibussowitsch   PetscCall(DMGetWorkArray(dm, numFaces*2, MPIU_SCALAR, vol));
36932f856554SMatthew G. Knepley   for (face = fStart, iface = 0; face < fEnd; ++face) {
36942f856554SMatthew G. Knepley     const PetscInt        *cells;
36952f856554SMatthew G. Knepley     PetscFVFaceGeom       *fg;
36962f856554SMatthew G. Knepley     PetscFVCellGeom       *cgL, *cgR;
36972f856554SMatthew G. Knepley     PetscFVFaceGeom       *fgeoml = *fgeom;
36982f856554SMatthew G. Knepley     PetscReal             *voll   = *vol;
36992f856554SMatthew G. Knepley     PetscInt               ghost, d, nchild, nsupp;
37002f856554SMatthew G. Knepley 
37019566063dSJacob Faibussowitsch     PetscCall(DMLabelGetValue(ghostLabel, face, &ghost));
37029566063dSJacob Faibussowitsch     PetscCall(DMPlexGetSupportSize(dm, face, &nsupp));
37039566063dSJacob Faibussowitsch     PetscCall(DMPlexGetTreeChildren(dm, face, &nchild, NULL));
37042f856554SMatthew G. Knepley     if (ghost >= 0 || nsupp > 2 || nchild > 0) continue;
37059566063dSJacob Faibussowitsch     PetscCall(DMPlexPointLocalRead(dmFace, face, facegeom, &fg));
37069566063dSJacob Faibussowitsch     PetscCall(DMPlexGetSupport(dm, face, &cells));
37079566063dSJacob Faibussowitsch     PetscCall(DMPlexPointLocalRead(dmCell, cells[0], cellgeom, &cgL));
37089566063dSJacob Faibussowitsch     PetscCall(DMPlexPointLocalRead(dmCell, cells[1], cellgeom, &cgR));
37092f856554SMatthew G. Knepley     for (d = 0; d < dim; ++d) {
37102f856554SMatthew G. Knepley       fgeoml[iface].centroid[d] = fg->centroid[d];
37112f856554SMatthew G. Knepley       fgeoml[iface].normal[d]   = fg->normal[d];
37122f856554SMatthew G. Knepley     }
37132f856554SMatthew G. Knepley     voll[iface*2+0] = cgL->volume;
37142f856554SMatthew G. Knepley     voll[iface*2+1] = cgR->volume;
37152f856554SMatthew G. Knepley     ++iface;
37162f856554SMatthew G. Knepley   }
37172f856554SMatthew G. Knepley   *Nface = iface;
37189566063dSJacob Faibussowitsch   PetscCall(VecRestoreArrayRead(faceGeometry, &facegeom));
37199566063dSJacob Faibussowitsch   PetscCall(VecRestoreArrayRead(cellGeometry, &cellgeom));
37202f856554SMatthew G. Knepley   PetscFunctionReturn(0);
37212f856554SMatthew G. Knepley }
37222f856554SMatthew G. Knepley 
37232f856554SMatthew G. Knepley /*@C
37242f856554SMatthew G. Knepley   DMPlexRestoreFaceGeometry - Restore the field values values for a chunk of faces
37252f856554SMatthew G. Knepley 
37262f856554SMatthew G. Knepley   Input Parameters:
37272f856554SMatthew G. Knepley + dm     - The DM
37282f856554SMatthew G. Knepley . fStart - The first face to include
37292f856554SMatthew G. Knepley . fEnd   - The first face to exclude
37302f856554SMatthew G. Knepley . faceGeometry - A local vector with face geometry
37312f856554SMatthew G. Knepley - cellGeometry - A local vector with cell geometry
37322f856554SMatthew G. Knepley 
37332f856554SMatthew G. Knepley   Output Parameters:
37342f856554SMatthew G. Knepley + Nface - The number of faces with field values
37352f856554SMatthew G. Knepley . fgeom - The extract the face centroid and normal
37362f856554SMatthew G. Knepley - vol   - The cell volume
37372f856554SMatthew G. Knepley 
37382f856554SMatthew G. Knepley   Level: developer
37392f856554SMatthew G. Knepley 
3740db781477SPatrick Sanan .seealso: `DMPlexGetFaceFields()`
37412f856554SMatthew G. Knepley @*/
37422f856554SMatthew G. Knepley PetscErrorCode DMPlexRestoreFaceGeometry(DM dm, PetscInt fStart, PetscInt fEnd, Vec faceGeometry, Vec cellGeometry, PetscInt *Nface, PetscFVFaceGeom **fgeom, PetscReal **vol)
37432f856554SMatthew G. Knepley {
37442f856554SMatthew G. Knepley   PetscFunctionBegin;
37459566063dSJacob Faibussowitsch   PetscCall(PetscFree(*fgeom));
37469566063dSJacob Faibussowitsch   PetscCall(DMRestoreWorkArray(dm, 0, MPIU_REAL, vol));
37472f856554SMatthew G. Knepley   PetscFunctionReturn(0);
37482f856554SMatthew G. Knepley }
37492f856554SMatthew G. Knepley 
3750a1cf66bbSMatthew G. Knepley PetscErrorCode DMSNESGetFEGeom(DMField coordField, IS pointIS, PetscQuadrature quad, PetscBool faceData, PetscFEGeom **geom)
3751a1cf66bbSMatthew G. Knepley {
3752a1cf66bbSMatthew G. Knepley   char            composeStr[33] = {0};
3753a1cf66bbSMatthew G. Knepley   PetscObjectId   id;
3754a1cf66bbSMatthew G. Knepley   PetscContainer  container;
3755a1cf66bbSMatthew G. Knepley 
3756a1cf66bbSMatthew G. Knepley   PetscFunctionBegin;
37579566063dSJacob Faibussowitsch   PetscCall(PetscObjectGetId((PetscObject)quad,&id));
375863a3b9bcSJacob Faibussowitsch   PetscCall(PetscSNPrintf(composeStr, 32, "DMSNESGetFEGeom_%" PetscInt64_FMT "\n", id));
37599566063dSJacob Faibussowitsch   PetscCall(PetscObjectQuery((PetscObject) pointIS, composeStr, (PetscObject *) &container));
3760a1cf66bbSMatthew G. Knepley   if (container) {
37619566063dSJacob Faibussowitsch     PetscCall(PetscContainerGetPointer(container, (void **) geom));
3762a1cf66bbSMatthew G. Knepley   } else {
37639566063dSJacob Faibussowitsch     PetscCall(DMFieldCreateFEGeom(coordField, pointIS, quad, faceData, geom));
37649566063dSJacob Faibussowitsch     PetscCall(PetscContainerCreate(PETSC_COMM_SELF,&container));
37659566063dSJacob Faibussowitsch     PetscCall(PetscContainerSetPointer(container, (void *) *geom));
37669566063dSJacob Faibussowitsch     PetscCall(PetscContainerSetUserDestroy(container, PetscContainerUserDestroy_PetscFEGeom));
37679566063dSJacob Faibussowitsch     PetscCall(PetscObjectCompose((PetscObject) pointIS, composeStr, (PetscObject) container));
37689566063dSJacob Faibussowitsch     PetscCall(PetscContainerDestroy(&container));
3769a1cf66bbSMatthew G. Knepley   }
3770a1cf66bbSMatthew G. Knepley   PetscFunctionReturn(0);
3771a1cf66bbSMatthew G. Knepley }
3772a1cf66bbSMatthew G. Knepley 
3773a1cf66bbSMatthew G. Knepley PetscErrorCode DMSNESRestoreFEGeom(DMField coordField, IS pointIS, PetscQuadrature quad, PetscBool faceData, PetscFEGeom **geom)
3774a1cf66bbSMatthew G. Knepley {
3775a1cf66bbSMatthew G. Knepley   PetscFunctionBegin;
3776a1cf66bbSMatthew G. Knepley   *geom = NULL;
3777a1cf66bbSMatthew G. Knepley   PetscFunctionReturn(0);
3778a1cf66bbSMatthew G. Knepley }
3779a1cf66bbSMatthew G. Knepley 
378092d50984SMatthew G. Knepley PetscErrorCode DMPlexComputeResidual_Patch_Internal(DM dm, PetscSection section, IS cellIS, PetscReal t, Vec locX, Vec locX_t, Vec locF, void *user)
378192d50984SMatthew G. Knepley {
378292d50984SMatthew G. Knepley   DM_Plex         *mesh       = (DM_Plex *) dm->data;
378392d50984SMatthew G. Knepley   const char      *name       = "Residual";
378492d50984SMatthew G. Knepley   DM               dmAux      = NULL;
378592d50984SMatthew G. Knepley   DMLabel          ghostLabel = NULL;
378692d50984SMatthew G. Knepley   PetscDS          prob       = NULL;
378792d50984SMatthew G. Knepley   PetscDS          probAux    = NULL;
378892d50984SMatthew G. Knepley   PetscBool        useFEM     = PETSC_FALSE;
378992d50984SMatthew G. Knepley   PetscBool        isImplicit = (locX_t || t == PETSC_MIN_REAL) ? PETSC_TRUE : PETSC_FALSE;
379092d50984SMatthew G. Knepley   DMField          coordField = NULL;
3791c0006e53SPatrick Farrell   Vec              locA;
3792c0006e53SPatrick Farrell   PetscScalar     *u = NULL, *u_t, *a, *uL = NULL, *uR = NULL;
379392d50984SMatthew G. Knepley   IS               chunkIS;
379492d50984SMatthew G. Knepley   const PetscInt  *cells;
379592d50984SMatthew G. Knepley   PetscInt         cStart, cEnd, numCells;
3796364207b6SKarl Rupp   PetscInt         Nf, f, totDim, totDimAux, numChunks, cellChunkSize, chunk, fStart, fEnd;
379792d50984SMatthew G. Knepley   PetscInt         maxDegree = PETSC_MAX_INT;
379806ad1575SMatthew G. Knepley   PetscFormKey key;
379992d50984SMatthew G. Knepley   PetscQuadrature  affineQuad = NULL, *quads = NULL;
380092d50984SMatthew G. Knepley   PetscFEGeom     *affineGeom = NULL, **geoms = NULL;
380192d50984SMatthew G. Knepley 
380292d50984SMatthew G. Knepley   PetscFunctionBegin;
38039566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_ResidualFEM,dm,0,0,0));
380492d50984SMatthew G. Knepley   /* FEM+FVM */
380592d50984SMatthew G. Knepley   /* 1: Get sizes from dm and dmAux */
38069566063dSJacob Faibussowitsch   PetscCall(DMGetLabel(dm, "ghost", &ghostLabel));
38079566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dm, &prob));
38089566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumFields(prob, &Nf));
38099566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(prob, &totDim));
38109566063dSJacob Faibussowitsch   PetscCall(DMGetAuxiliaryVec(dm, NULL, 0, 0, &locA));
381192d50984SMatthew G. Knepley   if (locA) {
38129566063dSJacob Faibussowitsch     PetscCall(VecGetDM(locA, &dmAux));
38139566063dSJacob Faibussowitsch     PetscCall(DMGetDS(dmAux, &probAux));
38149566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalDimension(probAux, &totDimAux));
381592d50984SMatthew G. Knepley   }
381692d50984SMatthew G. Knepley   /* 2: Get geometric data */
381792d50984SMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
381892d50984SMatthew G. Knepley     PetscObject  obj;
381992d50984SMatthew G. Knepley     PetscClassId id;
382092d50984SMatthew G. Knepley     PetscBool    fimp;
382192d50984SMatthew G. Knepley 
38229566063dSJacob Faibussowitsch     PetscCall(PetscDSGetImplicit(prob, f, &fimp));
382392d50984SMatthew G. Knepley     if (isImplicit != fimp) continue;
38249566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, f, &obj));
38259566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
382692d50984SMatthew G. Knepley     if (id == PETSCFE_CLASSID) {useFEM = PETSC_TRUE;}
38275f80ce2aSJacob Faibussowitsch     PetscCheck(id != PETSCFV_CLASSID,PETSC_COMM_SELF,PETSC_ERR_ARG_WRONG,"Use of FVM with PCPATCH not yet implemented");
382892d50984SMatthew G. Knepley   }
382992d50984SMatthew G. Knepley   if (useFEM) {
38309566063dSJacob Faibussowitsch     PetscCall(DMGetCoordinateField(dm, &coordField));
38319566063dSJacob Faibussowitsch     PetscCall(DMFieldGetDegree(coordField,cellIS,NULL,&maxDegree));
383292d50984SMatthew G. Knepley     if (maxDegree <= 1) {
38339566063dSJacob Faibussowitsch       PetscCall(DMFieldCreateDefaultQuadrature(coordField,cellIS,&affineQuad));
383492d50984SMatthew G. Knepley       if (affineQuad) {
38359566063dSJacob Faibussowitsch         PetscCall(DMSNESGetFEGeom(coordField,cellIS,affineQuad,PETSC_FALSE,&affineGeom));
383692d50984SMatthew G. Knepley       }
383792d50984SMatthew G. Knepley     } else {
38389566063dSJacob Faibussowitsch       PetscCall(PetscCalloc2(Nf,&quads,Nf,&geoms));
383992d50984SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
384092d50984SMatthew G. Knepley         PetscObject  obj;
384192d50984SMatthew G. Knepley         PetscClassId id;
384292d50984SMatthew G. Knepley         PetscBool    fimp;
384392d50984SMatthew G. Knepley 
38449566063dSJacob Faibussowitsch         PetscCall(PetscDSGetImplicit(prob, f, &fimp));
384592d50984SMatthew G. Knepley         if (isImplicit != fimp) continue;
38469566063dSJacob Faibussowitsch         PetscCall(PetscDSGetDiscretization(prob, f, &obj));
38479566063dSJacob Faibussowitsch         PetscCall(PetscObjectGetClassId(obj, &id));
384892d50984SMatthew G. Knepley         if (id == PETSCFE_CLASSID) {
384992d50984SMatthew G. Knepley           PetscFE fe = (PetscFE) obj;
385092d50984SMatthew G. Knepley 
38519566063dSJacob Faibussowitsch           PetscCall(PetscFEGetQuadrature(fe, &quads[f]));
38529566063dSJacob Faibussowitsch           PetscCall(PetscObjectReference((PetscObject)quads[f]));
38539566063dSJacob Faibussowitsch           PetscCall(DMSNESGetFEGeom(coordField,cellIS,quads[f],PETSC_FALSE,&geoms[f]));
385492d50984SMatthew G. Knepley         }
385592d50984SMatthew G. Knepley       }
385692d50984SMatthew G. Knepley     }
385792d50984SMatthew G. Knepley   }
385892d50984SMatthew G. Knepley   /* Loop over chunks */
38599566063dSJacob Faibussowitsch   PetscCall(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
38609566063dSJacob Faibussowitsch   PetscCall(DMPlexGetHeightStratum(dm, 1, &fStart, &fEnd));
38619566063dSJacob Faibussowitsch   if (useFEM) PetscCall(ISCreate(PETSC_COMM_SELF, &chunkIS));
386292d50984SMatthew G. Knepley   numCells      = cEnd - cStart;
386392d50984SMatthew G. Knepley   numChunks     = 1;
386492d50984SMatthew G. Knepley   cellChunkSize = numCells/numChunks;
386592d50984SMatthew G. Knepley   numChunks     = PetscMin(1,numCells);
38666528b96dSMatthew G. Knepley   key.label     = NULL;
38676528b96dSMatthew G. Knepley   key.value     = 0;
386806ad1575SMatthew G. Knepley   key.part      = 0;
386992d50984SMatthew G. Knepley   for (chunk = 0; chunk < numChunks; ++chunk) {
3870c0006e53SPatrick Farrell     PetscScalar     *elemVec, *fluxL = NULL, *fluxR = NULL;
3871c0006e53SPatrick Farrell     PetscReal       *vol = NULL;
3872c0006e53SPatrick Farrell     PetscFVFaceGeom *fgeom = NULL;
387392d50984SMatthew G. Knepley     PetscInt         cS = cStart+chunk*cellChunkSize, cE = PetscMin(cS+cellChunkSize, cEnd), numCells = cE - cS, c;
3874c0006e53SPatrick Farrell     PetscInt         numFaces = 0;
387592d50984SMatthew G. Knepley 
387692d50984SMatthew G. Knepley     /* Extract field coefficients */
387792d50984SMatthew G. Knepley     if (useFEM) {
38789566063dSJacob Faibussowitsch       PetscCall(ISGetPointSubrange(chunkIS, cS, cE, cells));
38799566063dSJacob Faibussowitsch       PetscCall(DMPlexGetCellFields(dm, chunkIS, locX, locX_t, locA, &u, &u_t, &a));
38809566063dSJacob Faibussowitsch       PetscCall(DMGetWorkArray(dm, numCells*totDim, MPIU_SCALAR, &elemVec));
38819566063dSJacob Faibussowitsch       PetscCall(PetscArrayzero(elemVec, numCells*totDim));
388292d50984SMatthew G. Knepley     }
388392d50984SMatthew 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 */
388492d50984SMatthew G. Knepley     /* Loop over fields */
388592d50984SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
388692d50984SMatthew G. Knepley       PetscObject  obj;
388792d50984SMatthew G. Knepley       PetscClassId id;
388892d50984SMatthew G. Knepley       PetscBool    fimp;
388992d50984SMatthew G. Knepley       PetscInt     numChunks, numBatches, batchSize, numBlocks, blockSize, Ne, Nr, offset;
389092d50984SMatthew G. Knepley 
38916528b96dSMatthew G. Knepley       key.field = f;
38929566063dSJacob Faibussowitsch       PetscCall(PetscDSGetImplicit(prob, f, &fimp));
389392d50984SMatthew G. Knepley       if (isImplicit != fimp) continue;
38949566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(prob, f, &obj));
38959566063dSJacob Faibussowitsch       PetscCall(PetscObjectGetClassId(obj, &id));
389692d50984SMatthew G. Knepley       if (id == PETSCFE_CLASSID) {
389792d50984SMatthew G. Knepley         PetscFE         fe = (PetscFE) obj;
389892d50984SMatthew G. Knepley         PetscFEGeom    *geom = affineGeom ? affineGeom : geoms[f];
389992d50984SMatthew G. Knepley         PetscFEGeom    *chunkGeom = NULL;
390092d50984SMatthew G. Knepley         PetscQuadrature quad = affineQuad ? affineQuad : quads[f];
390192d50984SMatthew G. Knepley         PetscInt        Nq, Nb;
390292d50984SMatthew G. Knepley 
39039566063dSJacob Faibussowitsch         PetscCall(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
39049566063dSJacob Faibussowitsch         PetscCall(PetscQuadratureGetData(quad, NULL, NULL, &Nq, NULL, NULL));
39059566063dSJacob Faibussowitsch         PetscCall(PetscFEGetDimension(fe, &Nb));
390692d50984SMatthew G. Knepley         blockSize = Nb;
390792d50984SMatthew G. Knepley         batchSize = numBlocks * blockSize;
39089566063dSJacob Faibussowitsch         PetscCall(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
390992d50984SMatthew G. Knepley         numChunks = numCells / (numBatches*batchSize);
391092d50984SMatthew G. Knepley         Ne        = numChunks*numBatches*batchSize;
391192d50984SMatthew G. Knepley         Nr        = numCells % (numBatches*batchSize);
391292d50984SMatthew G. Knepley         offset    = numCells - Nr;
391392d50984SMatthew G. Knepley         /* Integrate FE residual to get elemVec (need fields at quadrature points) */
391492d50984SMatthew 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) */
39159566063dSJacob Faibussowitsch         PetscCall(PetscFEGeomGetChunk(geom,0,offset,&chunkGeom));
39169566063dSJacob Faibussowitsch         PetscCall(PetscFEIntegrateResidual(prob, key, Ne, chunkGeom, u, u_t, probAux, a, t, elemVec));
39179566063dSJacob Faibussowitsch         PetscCall(PetscFEGeomGetChunk(geom,offset,numCells,&chunkGeom));
39189566063dSJacob Faibussowitsch         PetscCall(PetscFEIntegrateResidual(prob, key, Nr, chunkGeom, &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, probAux, &a[offset*totDimAux], t, &elemVec[offset*totDim]));
39199566063dSJacob Faibussowitsch         PetscCall(PetscFEGeomRestoreChunk(geom,offset,numCells,&chunkGeom));
392092d50984SMatthew G. Knepley       } else if (id == PETSCFV_CLASSID) {
392192d50984SMatthew G. Knepley         PetscFV fv = (PetscFV) obj;
392292d50984SMatthew G. Knepley 
392392d50984SMatthew G. Knepley         Ne = numFaces;
392492d50984SMatthew G. Knepley         /* Riemann solve over faces (need fields at face centroids) */
392592d50984SMatthew G. Knepley         /*   We need to evaluate FE fields at those coordinates */
39269566063dSJacob Faibussowitsch         PetscCall(PetscFVIntegrateRHSFunction(fv, prob, f, Ne, fgeom, vol, uL, uR, fluxL, fluxR));
392763a3b9bcSJacob Faibussowitsch       } else SETERRQ(PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, f);
392892d50984SMatthew G. Knepley     }
392992d50984SMatthew G. Knepley     /* Loop over domain */
393092d50984SMatthew G. Knepley     if (useFEM) {
393192d50984SMatthew G. Knepley       /* Add elemVec to locX */
393292d50984SMatthew G. Knepley       for (c = cS; c < cE; ++c) {
393392d50984SMatthew G. Knepley         const PetscInt cell = cells ? cells[c] : c;
393492d50984SMatthew G. Knepley         const PetscInt cind = c - cStart;
393592d50984SMatthew G. Knepley 
39369566063dSJacob Faibussowitsch         if (mesh->printFEM > 1) PetscCall(DMPrintCellVector(cell, name, totDim, &elemVec[cind*totDim]));
393792d50984SMatthew G. Knepley         if (ghostLabel) {
393892d50984SMatthew G. Knepley           PetscInt ghostVal;
393992d50984SMatthew G. Knepley 
39409566063dSJacob Faibussowitsch           PetscCall(DMLabelGetValue(ghostLabel,cell,&ghostVal));
394192d50984SMatthew G. Knepley           if (ghostVal > 0) continue;
394292d50984SMatthew G. Knepley         }
39439566063dSJacob Faibussowitsch         PetscCall(DMPlexVecSetClosure(dm, section, locF, cell, &elemVec[cind*totDim], ADD_ALL_VALUES));
394492d50984SMatthew G. Knepley       }
394592d50984SMatthew G. Knepley     }
394692d50984SMatthew G. Knepley     /* Handle time derivative */
394792d50984SMatthew G. Knepley     if (locX_t) {
394892d50984SMatthew G. Knepley       PetscScalar *x_t, *fa;
394992d50984SMatthew G. Knepley 
39509566063dSJacob Faibussowitsch       PetscCall(VecGetArray(locF, &fa));
39519566063dSJacob Faibussowitsch       PetscCall(VecGetArray(locX_t, &x_t));
395292d50984SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
395392d50984SMatthew G. Knepley         PetscFV      fv;
395492d50984SMatthew G. Knepley         PetscObject  obj;
395592d50984SMatthew G. Knepley         PetscClassId id;
395692d50984SMatthew G. Knepley         PetscInt     pdim, d;
395792d50984SMatthew G. Knepley 
39589566063dSJacob Faibussowitsch         PetscCall(PetscDSGetDiscretization(prob, f, &obj));
39599566063dSJacob Faibussowitsch         PetscCall(PetscObjectGetClassId(obj, &id));
396092d50984SMatthew G. Knepley         if (id != PETSCFV_CLASSID) continue;
396192d50984SMatthew G. Knepley         fv   = (PetscFV) obj;
39629566063dSJacob Faibussowitsch         PetscCall(PetscFVGetNumComponents(fv, &pdim));
396392d50984SMatthew G. Knepley         for (c = cS; c < cE; ++c) {
396492d50984SMatthew G. Knepley           const PetscInt cell = cells ? cells[c] : c;
396592d50984SMatthew G. Knepley           PetscScalar   *u_t, *r;
396692d50984SMatthew G. Knepley 
396792d50984SMatthew G. Knepley           if (ghostLabel) {
396892d50984SMatthew G. Knepley             PetscInt ghostVal;
396992d50984SMatthew G. Knepley 
39709566063dSJacob Faibussowitsch             PetscCall(DMLabelGetValue(ghostLabel, cell, &ghostVal));
397192d50984SMatthew G. Knepley             if (ghostVal > 0) continue;
397292d50984SMatthew G. Knepley           }
39739566063dSJacob Faibussowitsch           PetscCall(DMPlexPointLocalFieldRead(dm, cell, f, x_t, &u_t));
39749566063dSJacob Faibussowitsch           PetscCall(DMPlexPointLocalFieldRef(dm, cell, f, fa, &r));
397592d50984SMatthew G. Knepley           for (d = 0; d < pdim; ++d) r[d] += u_t[d];
397692d50984SMatthew G. Knepley         }
397792d50984SMatthew G. Knepley       }
39789566063dSJacob Faibussowitsch       PetscCall(VecRestoreArray(locX_t, &x_t));
39799566063dSJacob Faibussowitsch       PetscCall(VecRestoreArray(locF, &fa));
398092d50984SMatthew G. Knepley     }
398192d50984SMatthew G. Knepley     if (useFEM) {
39829566063dSJacob Faibussowitsch       PetscCall(DMPlexRestoreCellFields(dm, chunkIS, locX, locX_t, locA, &u, &u_t, &a));
39839566063dSJacob Faibussowitsch       PetscCall(DMRestoreWorkArray(dm, numCells*totDim, MPIU_SCALAR, &elemVec));
398492d50984SMatthew G. Knepley     }
398592d50984SMatthew G. Knepley   }
39869566063dSJacob Faibussowitsch   if (useFEM) PetscCall(ISDestroy(&chunkIS));
39879566063dSJacob Faibussowitsch   PetscCall(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
398892d50984SMatthew G. Knepley   /* TODO Could include boundary residual here (see DMPlexComputeResidual_Internal) */
398992d50984SMatthew G. Knepley   if (useFEM) {
399092d50984SMatthew G. Knepley     if (maxDegree <= 1) {
39919566063dSJacob Faibussowitsch       PetscCall(DMSNESRestoreFEGeom(coordField,cellIS,affineQuad,PETSC_FALSE,&affineGeom));
39929566063dSJacob Faibussowitsch       PetscCall(PetscQuadratureDestroy(&affineQuad));
399392d50984SMatthew G. Knepley     } else {
399492d50984SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
39959566063dSJacob Faibussowitsch         PetscCall(DMSNESRestoreFEGeom(coordField,cellIS,quads[f],PETSC_FALSE,&geoms[f]));
39969566063dSJacob Faibussowitsch         PetscCall(PetscQuadratureDestroy(&quads[f]));
399792d50984SMatthew G. Knepley       }
39989566063dSJacob Faibussowitsch       PetscCall(PetscFree2(quads,geoms));
399992d50984SMatthew G. Knepley     }
400092d50984SMatthew G. Knepley   }
40019566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_ResidualFEM,dm,0,0,0));
400292d50984SMatthew G. Knepley   PetscFunctionReturn(0);
400392d50984SMatthew G. Knepley }
400492d50984SMatthew G. Knepley 
4005a1cf66bbSMatthew G. Knepley /*
4006a1cf66bbSMatthew 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
4007a1cf66bbSMatthew G. Knepley 
4008a1cf66bbSMatthew G. Knepley   X   - The local solution vector
4009a5b23f4aSJose E. Roman   X_t - The local solution time derivative vector, or NULL
4010a1cf66bbSMatthew G. Knepley */
4011a1cf66bbSMatthew G. Knepley PetscErrorCode DMPlexComputeJacobian_Patch_Internal(DM dm, PetscSection section, PetscSection globalSection, IS cellIS,
4012a1cf66bbSMatthew G. Knepley                                                     PetscReal t, PetscReal X_tShift, Vec X, Vec X_t, Mat Jac, Mat JacP, void *ctx)
4013a1cf66bbSMatthew G. Knepley {
4014a1cf66bbSMatthew G. Knepley   DM_Plex         *mesh  = (DM_Plex *) dm->data;
4015a1cf66bbSMatthew G. Knepley   const char      *name = "Jacobian", *nameP = "JacobianPre";
4016a1cf66bbSMatthew G. Knepley   DM               dmAux = NULL;
4017a1cf66bbSMatthew G. Knepley   PetscDS          prob,   probAux = NULL;
4018a1cf66bbSMatthew G. Knepley   PetscSection     sectionAux = NULL;
4019a1cf66bbSMatthew G. Knepley   Vec              A;
4020a1cf66bbSMatthew G. Knepley   DMField          coordField;
4021a1cf66bbSMatthew G. Knepley   PetscFEGeom     *cgeomFEM;
4022a1cf66bbSMatthew G. Knepley   PetscQuadrature  qGeom = NULL;
4023a1cf66bbSMatthew G. Knepley   Mat              J = Jac, JP = JacP;
4024a1cf66bbSMatthew G. Knepley   PetscScalar     *work, *u = NULL, *u_t = NULL, *a = NULL, *elemMat = NULL, *elemMatP = NULL, *elemMatD = NULL;
4025e432b41dSStefano Zampini   PetscBool        hasJac, hasPrec, hasDyn, assembleJac, *isFE, hasFV = PETSC_FALSE;
4026a1cf66bbSMatthew G. Knepley   const PetscInt  *cells;
402706ad1575SMatthew G. Knepley   PetscFormKey key;
40289b2fc754SMatthew G. Knepley   PetscInt         Nf, fieldI, fieldJ, maxDegree, numCells, cStart, cEnd, numChunks, chunkSize, chunk, totDim, totDimAux = 0, sz, wsz, off = 0, offCell = 0;
4029a1cf66bbSMatthew G. Knepley 
4030a1cf66bbSMatthew G. Knepley   PetscFunctionBegin;
40319566063dSJacob Faibussowitsch   PetscCall(ISGetLocalSize(cellIS, &numCells));
40329566063dSJacob Faibussowitsch   PetscCall(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
40339566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_JacobianFEM,dm,0,0,0));
40349566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dm, &prob));
40359566063dSJacob Faibussowitsch   PetscCall(DMGetAuxiliaryVec(dm, NULL, 0, 0, &A));
40369a2a23afSMatthew G. Knepley   if (A) {
40379566063dSJacob Faibussowitsch     PetscCall(VecGetDM(A, &dmAux));
40389566063dSJacob Faibussowitsch     PetscCall(DMGetLocalSection(dmAux, &sectionAux));
40399566063dSJacob Faibussowitsch     PetscCall(DMGetDS(dmAux, &probAux));
4040a1cf66bbSMatthew G. Knepley   }
4041a1cf66bbSMatthew G. Knepley   /* Get flags */
40429566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumFields(prob, &Nf));
40439566063dSJacob Faibussowitsch   PetscCall(DMGetWorkArray(dm, Nf, MPIU_BOOL, &isFE));
4044a1cf66bbSMatthew G. Knepley   for (fieldI = 0; fieldI < Nf; ++fieldI) {
4045a1cf66bbSMatthew G. Knepley     PetscObject  disc;
4046a1cf66bbSMatthew G. Knepley     PetscClassId id;
40479566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, fieldI, &disc));
40489566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(disc, &id));
4049a1cf66bbSMatthew G. Knepley     if (id == PETSCFE_CLASSID)      {isFE[fieldI] = PETSC_TRUE;}
4050a1cf66bbSMatthew G. Knepley     else if (id == PETSCFV_CLASSID) {hasFV = PETSC_TRUE; isFE[fieldI] = PETSC_FALSE;}
4051a1cf66bbSMatthew G. Knepley   }
40529566063dSJacob Faibussowitsch   PetscCall(PetscDSHasJacobian(prob, &hasJac));
40539566063dSJacob Faibussowitsch   PetscCall(PetscDSHasJacobianPreconditioner(prob, &hasPrec));
40549566063dSJacob Faibussowitsch   PetscCall(PetscDSHasDynamicJacobian(prob, &hasDyn));
4055a1cf66bbSMatthew G. Knepley   assembleJac = hasJac && hasPrec && (Jac != JacP) ? PETSC_TRUE : PETSC_FALSE;
4056a1cf66bbSMatthew G. Knepley   hasDyn      = hasDyn && (X_tShift != 0.0) ? PETSC_TRUE : PETSC_FALSE;
40579566063dSJacob Faibussowitsch   if (hasFV) PetscCall(MatSetOption(JP, MAT_IGNORE_ZERO_ENTRIES, PETSC_TRUE)); /* No allocated space for FV stuff, so ignore the zero entries */
40589566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(prob, &totDim));
40599566063dSJacob Faibussowitsch   if (probAux) PetscCall(PetscDSGetTotalDimension(probAux, &totDimAux));
4060a1cf66bbSMatthew G. Knepley   /* Compute batch sizes */
4061a1cf66bbSMatthew G. Knepley   if (isFE[0]) {
4062a1cf66bbSMatthew G. Knepley     PetscFE         fe;
4063a1cf66bbSMatthew G. Knepley     PetscQuadrature q;
4064a1cf66bbSMatthew G. Knepley     PetscInt        numQuadPoints, numBatches, batchSize, numBlocks, blockSize, Nb;
4065a1cf66bbSMatthew G. Knepley 
40669566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, 0, (PetscObject *) &fe));
40679566063dSJacob Faibussowitsch     PetscCall(PetscFEGetQuadrature(fe, &q));
40689566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureGetData(q, NULL, NULL, &numQuadPoints, NULL, NULL));
40699566063dSJacob Faibussowitsch     PetscCall(PetscFEGetDimension(fe, &Nb));
40709566063dSJacob Faibussowitsch     PetscCall(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
4071a1cf66bbSMatthew G. Knepley     blockSize = Nb*numQuadPoints;
4072a1cf66bbSMatthew G. Knepley     batchSize = numBlocks  * blockSize;
4073a1cf66bbSMatthew G. Knepley     chunkSize = numBatches * batchSize;
4074a1cf66bbSMatthew G. Knepley     numChunks = numCells / chunkSize + numCells % chunkSize;
40759566063dSJacob Faibussowitsch     PetscCall(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
4076a1cf66bbSMatthew G. Knepley   } else {
4077a1cf66bbSMatthew G. Knepley     chunkSize = numCells;
4078a1cf66bbSMatthew G. Knepley     numChunks = 1;
4079a1cf66bbSMatthew G. Knepley   }
4080a1cf66bbSMatthew G. Knepley   /* Get work space */
4081a1cf66bbSMatthew 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;
40829566063dSJacob Faibussowitsch   PetscCall(DMGetWorkArray(dm, wsz, MPIU_SCALAR, &work));
40839566063dSJacob Faibussowitsch   PetscCall(PetscArrayzero(work, wsz));
4084a1cf66bbSMatthew G. Knepley   off      = 0;
4085a1cf66bbSMatthew G. Knepley   u        = X       ? (sz = chunkSize*totDim,        off += sz, work+off-sz) : NULL;
4086a1cf66bbSMatthew G. Knepley   u_t      = X_t     ? (sz = chunkSize*totDim,        off += sz, work+off-sz) : NULL;
4087a1cf66bbSMatthew G. Knepley   a        = dmAux   ? (sz = chunkSize*totDimAux,     off += sz, work+off-sz) : NULL;
4088a1cf66bbSMatthew G. Knepley   elemMat  = hasJac  ? (sz = chunkSize*totDim*totDim, off += sz, work+off-sz) : NULL;
4089a1cf66bbSMatthew G. Knepley   elemMatP = hasPrec ? (sz = chunkSize*totDim*totDim, off += sz, work+off-sz) : NULL;
4090a1cf66bbSMatthew G. Knepley   elemMatD = hasDyn  ? (sz = chunkSize*totDim*totDim, off += sz, work+off-sz) : NULL;
409163a3b9bcSJacob Faibussowitsch   PetscCheck(off == wsz,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Error is workspace size %" PetscInt_FMT " should be %" PetscInt_FMT, off, wsz);
4092a1cf66bbSMatthew G. Knepley   /* Setup geometry */
40939566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateField(dm, &coordField));
40949566063dSJacob Faibussowitsch   PetscCall(DMFieldGetDegree(coordField, cellIS, NULL, &maxDegree));
40959566063dSJacob Faibussowitsch   if (maxDegree <= 1) PetscCall(DMFieldCreateDefaultQuadrature(coordField, cellIS, &qGeom));
4096a1cf66bbSMatthew G. Knepley   if (!qGeom) {
4097a1cf66bbSMatthew G. Knepley     PetscFE fe;
4098a1cf66bbSMatthew G. Knepley 
40999566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, 0, (PetscObject *) &fe));
41009566063dSJacob Faibussowitsch     PetscCall(PetscFEGetQuadrature(fe, &qGeom));
41019566063dSJacob Faibussowitsch     PetscCall(PetscObjectReference((PetscObject) qGeom));
4102a1cf66bbSMatthew G. Knepley   }
41039566063dSJacob Faibussowitsch   PetscCall(DMSNESGetFEGeom(coordField, cellIS, qGeom, PETSC_FALSE, &cgeomFEM));
4104a1cf66bbSMatthew G. Knepley   /* Compute volume integrals */
41059566063dSJacob Faibussowitsch   if (assembleJac) PetscCall(MatZeroEntries(J));
41069566063dSJacob Faibussowitsch   PetscCall(MatZeroEntries(JP));
41076528b96dSMatthew G. Knepley   key.label = NULL;
41086528b96dSMatthew G. Knepley   key.value = 0;
410906ad1575SMatthew G. Knepley   key.part  = 0;
4110a1cf66bbSMatthew G. Knepley   for (chunk = 0; chunk < numChunks; ++chunk, offCell += chunkSize) {
4111a1cf66bbSMatthew G. Knepley     const PetscInt   Ncell = PetscMin(chunkSize, numCells - offCell);
4112a1cf66bbSMatthew G. Knepley     PetscInt         c;
4113a1cf66bbSMatthew G. Knepley 
4114a1cf66bbSMatthew G. Knepley     /* Extract values */
4115a1cf66bbSMatthew G. Knepley     for (c = 0; c < Ncell; ++c) {
4116a1cf66bbSMatthew G. Knepley       const PetscInt cell = cells ? cells[c+offCell] : c+offCell;
4117a1cf66bbSMatthew G. Knepley       PetscScalar   *x = NULL,  *x_t = NULL;
4118a1cf66bbSMatthew G. Knepley       PetscInt       i;
4119a1cf66bbSMatthew G. Knepley 
4120a1cf66bbSMatthew G. Knepley       if (X) {
41219566063dSJacob Faibussowitsch         PetscCall(DMPlexVecGetClosure(dm, section, X, cell, NULL, &x));
4122a1cf66bbSMatthew G. Knepley         for (i = 0; i < totDim; ++i) u[c*totDim+i] = x[i];
41239566063dSJacob Faibussowitsch         PetscCall(DMPlexVecRestoreClosure(dm, section, X, cell, NULL, &x));
4124a1cf66bbSMatthew G. Knepley       }
4125a1cf66bbSMatthew G. Knepley       if (X_t) {
41269566063dSJacob Faibussowitsch         PetscCall(DMPlexVecGetClosure(dm, section, X_t, cell, NULL, &x_t));
4127a1cf66bbSMatthew G. Knepley         for (i = 0; i < totDim; ++i) u_t[c*totDim+i] = x_t[i];
41289566063dSJacob Faibussowitsch         PetscCall(DMPlexVecRestoreClosure(dm, section, X_t, cell, NULL, &x_t));
4129a1cf66bbSMatthew G. Knepley       }
4130a1cf66bbSMatthew G. Knepley       if (dmAux) {
41319566063dSJacob Faibussowitsch         PetscCall(DMPlexVecGetClosure(dmAux, sectionAux, A, cell, NULL, &x));
4132a1cf66bbSMatthew G. Knepley         for (i = 0; i < totDimAux; ++i) a[c*totDimAux+i] = x[i];
41339566063dSJacob Faibussowitsch         PetscCall(DMPlexVecRestoreClosure(dmAux, sectionAux, A, cell, NULL, &x));
4134a1cf66bbSMatthew G. Knepley       }
4135a1cf66bbSMatthew G. Knepley     }
4136a1cf66bbSMatthew G. Knepley     for (fieldI = 0; fieldI < Nf; ++fieldI) {
4137a1cf66bbSMatthew G. Knepley       PetscFE fe;
41389566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(prob, fieldI, (PetscObject *) &fe));
4139a1cf66bbSMatthew G. Knepley       for (fieldJ = 0; fieldJ < Nf; ++fieldJ) {
41406528b96dSMatthew G. Knepley         key.field = fieldI*Nf + fieldJ;
41419566063dSJacob Faibussowitsch         if (hasJac)  PetscCall(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN,     key, Ncell, cgeomFEM, u, u_t, probAux, a, t, X_tShift, elemMat));
41429566063dSJacob Faibussowitsch         if (hasPrec) PetscCall(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN_PRE, key, Ncell, cgeomFEM, u, u_t, probAux, a, t, X_tShift, elemMatP));
41439566063dSJacob Faibussowitsch         if (hasDyn)  PetscCall(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN_DYN, key, Ncell, cgeomFEM, u, u_t, probAux, a, t, X_tShift, elemMatD));
4144a1cf66bbSMatthew G. Knepley       }
4145a1cf66bbSMatthew G. Knepley       /* For finite volume, add the identity */
4146a1cf66bbSMatthew G. Knepley       if (!isFE[fieldI]) {
4147a1cf66bbSMatthew G. Knepley         PetscFV  fv;
4148a1cf66bbSMatthew G. Knepley         PetscInt eOffset = 0, Nc, fc, foff;
4149a1cf66bbSMatthew G. Knepley 
41509566063dSJacob Faibussowitsch         PetscCall(PetscDSGetFieldOffset(prob, fieldI, &foff));
41519566063dSJacob Faibussowitsch         PetscCall(PetscDSGetDiscretization(prob, fieldI, (PetscObject *) &fv));
41529566063dSJacob Faibussowitsch         PetscCall(PetscFVGetNumComponents(fv, &Nc));
4153a1cf66bbSMatthew G. Knepley         for (c = 0; c < chunkSize; ++c, eOffset += totDim*totDim) {
4154a1cf66bbSMatthew G. Knepley           for (fc = 0; fc < Nc; ++fc) {
4155a1cf66bbSMatthew G. Knepley             const PetscInt i = foff + fc;
4156a1cf66bbSMatthew G. Knepley             if (hasJac)  {elemMat [eOffset+i*totDim+i] = 1.0;}
4157a1cf66bbSMatthew G. Knepley             if (hasPrec) {elemMatP[eOffset+i*totDim+i] = 1.0;}
4158a1cf66bbSMatthew G. Knepley           }
4159a1cf66bbSMatthew G. Knepley         }
4160a1cf66bbSMatthew G. Knepley       }
4161a1cf66bbSMatthew G. Knepley     }
4162a1cf66bbSMatthew G. Knepley     /*   Add contribution from X_t */
4163a1cf66bbSMatthew G. Knepley     if (hasDyn) {for (c = 0; c < chunkSize*totDim*totDim; ++c) elemMat[c] += X_tShift*elemMatD[c];}
4164a1cf66bbSMatthew G. Knepley     /* Insert values into matrix */
4165a1cf66bbSMatthew G. Knepley     for (c = 0; c < Ncell; ++c) {
4166a1cf66bbSMatthew G. Knepley       const PetscInt cell = cells ? cells[c+offCell] : c+offCell;
4167a1cf66bbSMatthew G. Knepley       if (mesh->printFEM > 1) {
41689566063dSJacob Faibussowitsch         if (hasJac)  PetscCall(DMPrintCellMatrix(cell, name,  totDim, totDim, &elemMat[(c-cStart)*totDim*totDim]));
41699566063dSJacob Faibussowitsch         if (hasPrec) PetscCall(DMPrintCellMatrix(cell, nameP, totDim, totDim, &elemMatP[(c-cStart)*totDim*totDim]));
4170a1cf66bbSMatthew G. Knepley       }
41719566063dSJacob Faibussowitsch       if (assembleJac) PetscCall(DMPlexMatSetClosure(dm, section, globalSection, Jac, cell, &elemMat[(c-cStart)*totDim*totDim], ADD_VALUES));
41729566063dSJacob Faibussowitsch       PetscCall(DMPlexMatSetClosure(dm, section, globalSection, JP, cell, &elemMat[(c-cStart)*totDim*totDim], ADD_VALUES));
4173a1cf66bbSMatthew G. Knepley     }
4174a1cf66bbSMatthew G. Knepley   }
4175a1cf66bbSMatthew G. Knepley   /* Cleanup */
41769566063dSJacob Faibussowitsch   PetscCall(DMSNESRestoreFEGeom(coordField, cellIS, qGeom, PETSC_FALSE, &cgeomFEM));
41779566063dSJacob Faibussowitsch   PetscCall(PetscQuadratureDestroy(&qGeom));
41789566063dSJacob Faibussowitsch   if (hasFV) PetscCall(MatSetOption(JacP, MAT_IGNORE_ZERO_ENTRIES, PETSC_FALSE));
41799566063dSJacob Faibussowitsch   PetscCall(DMRestoreWorkArray(dm, Nf, MPIU_BOOL, &isFE));
41809566063dSJacob Faibussowitsch   PetscCall(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));
4181a1cf66bbSMatthew G. Knepley   /* Compute boundary integrals */
41829566063dSJacob Faibussowitsch   /* PetscCall(DMPlexComputeBdJacobian_Internal(dm, X, X_t, t, X_tShift, Jac, JacP, ctx)); */
4183a1cf66bbSMatthew G. Knepley   /* Assemble matrix */
41849566063dSJacob Faibussowitsch   if (assembleJac) {PetscCall(MatAssemblyBegin(Jac, MAT_FINAL_ASSEMBLY));PetscCall(MatAssemblyEnd(Jac, MAT_FINAL_ASSEMBLY));}
41859566063dSJacob Faibussowitsch   PetscCall(MatAssemblyBegin(JacP, MAT_FINAL_ASSEMBLY));PetscCall(MatAssemblyEnd(JacP, MAT_FINAL_ASSEMBLY));
41869566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_JacobianFEM,dm,0,0,0));
4187a1cf66bbSMatthew G. Knepley   PetscFunctionReturn(0);
4188a1cf66bbSMatthew G. Knepley }
41893e9753d6SMatthew G. Knepley 
41903e9753d6SMatthew G. Knepley /******** FEM Assembly Function ********/
41913e9753d6SMatthew G. Knepley 
41923e9753d6SMatthew G. Knepley static PetscErrorCode DMConvertPlex_Internal(DM dm, DM *plex, PetscBool copy)
41933e9753d6SMatthew G. Knepley {
41943e9753d6SMatthew G. Knepley   PetscBool      isPlex;
41953e9753d6SMatthew G. Knepley 
41963e9753d6SMatthew G. Knepley   PetscFunctionBegin;
41979566063dSJacob Faibussowitsch   PetscCall(PetscObjectTypeCompare((PetscObject) dm, DMPLEX, &isPlex));
41983e9753d6SMatthew G. Knepley   if (isPlex) {
41993e9753d6SMatthew G. Knepley     *plex = dm;
42009566063dSJacob Faibussowitsch     PetscCall(PetscObjectReference((PetscObject) dm));
42013e9753d6SMatthew G. Knepley   } else {
42029566063dSJacob Faibussowitsch     PetscCall(PetscObjectQuery((PetscObject) dm, "dm_plex", (PetscObject *) plex));
42033e9753d6SMatthew G. Knepley     if (!*plex) {
42049566063dSJacob Faibussowitsch       PetscCall(DMConvert(dm,DMPLEX,plex));
42059566063dSJacob Faibussowitsch       PetscCall(PetscObjectCompose((PetscObject) dm, "dm_plex", (PetscObject) *plex));
42061baa6e33SBarry Smith       if (copy) PetscCall(DMCopyAuxiliaryVec(dm, *plex));
42073e9753d6SMatthew G. Knepley     } else {
42089566063dSJacob Faibussowitsch       PetscCall(PetscObjectReference((PetscObject) *plex));
42093e9753d6SMatthew G. Knepley     }
42103e9753d6SMatthew G. Knepley   }
42113e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
42123e9753d6SMatthew G. Knepley }
42133e9753d6SMatthew G. Knepley 
42143e9753d6SMatthew G. Knepley /*@
42153e9753d6SMatthew G. Knepley   DMPlexGetGeometryFVM - Return precomputed geometric data
42163e9753d6SMatthew G. Knepley 
42173e9753d6SMatthew G. Knepley   Collective on DM
42183e9753d6SMatthew G. Knepley 
42193e9753d6SMatthew G. Knepley   Input Parameter:
42203e9753d6SMatthew G. Knepley . dm - The DM
42213e9753d6SMatthew G. Knepley 
42223e9753d6SMatthew G. Knepley   Output Parameters:
42233e9753d6SMatthew G. Knepley + facegeom - The values precomputed from face geometry
42243e9753d6SMatthew G. Knepley . cellgeom - The values precomputed from cell geometry
42253e9753d6SMatthew G. Knepley - minRadius - The minimum radius over the mesh of an inscribed sphere in a cell
42263e9753d6SMatthew G. Knepley 
42273e9753d6SMatthew G. Knepley   Level: developer
42283e9753d6SMatthew G. Knepley 
4229db781477SPatrick Sanan .seealso: `DMTSSetRHSFunctionLocal()`
42303e9753d6SMatthew G. Knepley @*/
42313e9753d6SMatthew G. Knepley PetscErrorCode DMPlexGetGeometryFVM(DM dm, Vec *facegeom, Vec *cellgeom, PetscReal *minRadius)
42323e9753d6SMatthew G. Knepley {
42333e9753d6SMatthew G. Knepley   DM             plex;
42343e9753d6SMatthew G. Knepley 
42353e9753d6SMatthew G. Knepley   PetscFunctionBegin;
42363e9753d6SMatthew G. Knepley   PetscValidHeaderSpecific(dm,DM_CLASSID,1);
42379566063dSJacob Faibussowitsch   PetscCall(DMConvertPlex_Internal(dm,&plex,PETSC_TRUE));
42389566063dSJacob Faibussowitsch   PetscCall(DMPlexGetDataFVM(plex, NULL, cellgeom, facegeom, NULL));
42399566063dSJacob Faibussowitsch   if (minRadius) PetscCall(DMPlexGetMinRadius(plex, minRadius));
42409566063dSJacob Faibussowitsch   PetscCall(DMDestroy(&plex));
42413e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
42423e9753d6SMatthew G. Knepley }
42433e9753d6SMatthew G. Knepley 
42443e9753d6SMatthew G. Knepley /*@
42453e9753d6SMatthew G. Knepley   DMPlexGetGradientDM - Return gradient data layout
42463e9753d6SMatthew G. Knepley 
42473e9753d6SMatthew G. Knepley   Collective on DM
42483e9753d6SMatthew G. Knepley 
42493e9753d6SMatthew G. Knepley   Input Parameters:
42503e9753d6SMatthew G. Knepley + dm - The DM
42513e9753d6SMatthew G. Knepley - fv - The PetscFV
42523e9753d6SMatthew G. Knepley 
42533e9753d6SMatthew G. Knepley   Output Parameter:
42543e9753d6SMatthew G. Knepley . dmGrad - The layout for gradient values
42553e9753d6SMatthew G. Knepley 
42563e9753d6SMatthew G. Knepley   Level: developer
42573e9753d6SMatthew G. Knepley 
4258db781477SPatrick Sanan .seealso: `DMPlexGetGeometryFVM()`
42593e9753d6SMatthew G. Knepley @*/
42603e9753d6SMatthew G. Knepley PetscErrorCode DMPlexGetGradientDM(DM dm, PetscFV fv, DM *dmGrad)
42613e9753d6SMatthew G. Knepley {
42623e9753d6SMatthew G. Knepley   DM             plex;
42633e9753d6SMatthew G. Knepley   PetscBool      computeGradients;
42643e9753d6SMatthew G. Knepley 
42653e9753d6SMatthew G. Knepley   PetscFunctionBegin;
42663e9753d6SMatthew G. Knepley   PetscValidHeaderSpecific(dm,DM_CLASSID,1);
42673e9753d6SMatthew G. Knepley   PetscValidHeaderSpecific(fv,PETSCFV_CLASSID,2);
42683e9753d6SMatthew G. Knepley   PetscValidPointer(dmGrad,3);
42699566063dSJacob Faibussowitsch   PetscCall(PetscFVGetComputeGradients(fv, &computeGradients));
42703e9753d6SMatthew G. Knepley   if (!computeGradients) {*dmGrad = NULL; PetscFunctionReturn(0);}
42719566063dSJacob Faibussowitsch   PetscCall(DMConvertPlex_Internal(dm,&plex,PETSC_TRUE));
42729566063dSJacob Faibussowitsch   PetscCall(DMPlexGetDataFVM(plex, fv, NULL, NULL, dmGrad));
42739566063dSJacob Faibussowitsch   PetscCall(DMDestroy(&plex));
42743e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
42753e9753d6SMatthew G. Knepley }
42763e9753d6SMatthew G. Knepley 
42770c290148SMatthew 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)
42783e9753d6SMatthew G. Knepley {
42793e9753d6SMatthew G. Knepley   DM_Plex         *mesh = (DM_Plex *) dm->data;
42803e9753d6SMatthew G. Knepley   DM               plex = NULL, plexA = NULL;
42813e9753d6SMatthew G. Knepley   DMEnclosureType  encAux;
42823e9753d6SMatthew G. Knepley   PetscDS          prob, probAux = NULL;
42833e9753d6SMatthew G. Knepley   PetscSection     section, sectionAux = NULL;
42843e9753d6SMatthew G. Knepley   Vec              locA = NULL;
42853e9753d6SMatthew G. Knepley   PetscScalar     *u = NULL, *u_t = NULL, *a = NULL, *elemVec = NULL;
42863e9753d6SMatthew G. Knepley   PetscInt         totDim, totDimAux = 0;
42873e9753d6SMatthew G. Knepley 
42883e9753d6SMatthew G. Knepley   PetscFunctionBegin;
42899566063dSJacob Faibussowitsch   PetscCall(DMConvert(dm, DMPLEX, &plex));
42909566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
42919566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dm, &prob));
42929566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(prob, &totDim));
42939566063dSJacob Faibussowitsch   PetscCall(DMGetAuxiliaryVec(dm, key.label, key.value, key.part, &locA));
42943e9753d6SMatthew G. Knepley   if (locA) {
42953e9753d6SMatthew G. Knepley     DM dmAux;
42963e9753d6SMatthew G. Knepley 
42979566063dSJacob Faibussowitsch     PetscCall(VecGetDM(locA, &dmAux));
42989566063dSJacob Faibussowitsch     PetscCall(DMGetEnclosureRelation(dmAux, dm, &encAux));
42999566063dSJacob Faibussowitsch     PetscCall(DMConvert(dmAux, DMPLEX, &plexA));
43009566063dSJacob Faibussowitsch     PetscCall(DMGetDS(plexA, &probAux));
43019566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalDimension(probAux, &totDimAux));
43029566063dSJacob Faibussowitsch     PetscCall(DMGetLocalSection(plexA, &sectionAux));
43033e9753d6SMatthew G. Knepley   }
43040c290148SMatthew G. Knepley   {
43053e9753d6SMatthew G. Knepley     PetscFEGeom     *fgeom;
43063e9753d6SMatthew G. Knepley     PetscInt         maxDegree;
43073e9753d6SMatthew G. Knepley     PetscQuadrature  qGeom = NULL;
43083e9753d6SMatthew G. Knepley     IS               pointIS;
43093e9753d6SMatthew G. Knepley     const PetscInt  *points;
43103e9753d6SMatthew G. Knepley     PetscInt         numFaces, face, Nq;
43113e9753d6SMatthew G. Knepley 
43129566063dSJacob Faibussowitsch     PetscCall(DMLabelGetStratumIS(key.label, key.value, &pointIS));
43130c290148SMatthew G. Knepley     if (!pointIS) goto end; /* No points with that id on this process */
43143e9753d6SMatthew G. Knepley     {
43153e9753d6SMatthew G. Knepley       IS isectIS;
43163e9753d6SMatthew G. Knepley 
43173e9753d6SMatthew G. Knepley       /* TODO: Special cases of ISIntersect where it is quick to check a priori if one is a superset of the other */
43189566063dSJacob Faibussowitsch       PetscCall(ISIntersect_Caching_Internal(facetIS,pointIS,&isectIS));
43199566063dSJacob Faibussowitsch       PetscCall(ISDestroy(&pointIS));
43203e9753d6SMatthew G. Knepley       pointIS = isectIS;
43213e9753d6SMatthew G. Knepley     }
43229566063dSJacob Faibussowitsch     PetscCall(ISGetLocalSize(pointIS,&numFaces));
43239566063dSJacob Faibussowitsch     PetscCall(ISGetIndices(pointIS,&points));
43249566063dSJacob Faibussowitsch     PetscCall(PetscMalloc4(numFaces*totDim, &u, locX_t ? numFaces*totDim : 0, &u_t, numFaces*totDim, &elemVec, locA ? numFaces*totDimAux : 0, &a));
43259566063dSJacob Faibussowitsch     PetscCall(DMFieldGetDegree(coordField,pointIS,NULL,&maxDegree));
43263e9753d6SMatthew G. Knepley     if (maxDegree <= 1) {
43279566063dSJacob Faibussowitsch       PetscCall(DMFieldCreateDefaultQuadrature(coordField,pointIS,&qGeom));
43283e9753d6SMatthew G. Knepley     }
43293e9753d6SMatthew G. Knepley     if (!qGeom) {
43303e9753d6SMatthew G. Knepley       PetscFE fe;
43313e9753d6SMatthew G. Knepley 
43329566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(prob, key.field, (PetscObject *) &fe));
43339566063dSJacob Faibussowitsch       PetscCall(PetscFEGetFaceQuadrature(fe, &qGeom));
43349566063dSJacob Faibussowitsch       PetscCall(PetscObjectReference((PetscObject)qGeom));
43353e9753d6SMatthew G. Knepley     }
43369566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureGetData(qGeom, NULL, NULL, &Nq, NULL, NULL));
43379566063dSJacob Faibussowitsch     PetscCall(DMSNESGetFEGeom(coordField,pointIS,qGeom,PETSC_TRUE,&fgeom));
43383e9753d6SMatthew G. Knepley     for (face = 0; face < numFaces; ++face) {
4339f15274beSMatthew Knepley       const PetscInt point = points[face], *support;
43403e9753d6SMatthew G. Knepley       PetscScalar   *x     = NULL;
4341f15274beSMatthew Knepley       PetscInt       i;
43423e9753d6SMatthew G. Knepley 
43439566063dSJacob Faibussowitsch       PetscCall(DMPlexGetSupport(dm, point, &support));
43449566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(plex, section, locX, support[0], NULL, &x));
43453e9753d6SMatthew G. Knepley       for (i = 0; i < totDim; ++i) u[face*totDim+i] = x[i];
43469566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(plex, section, locX, support[0], NULL, &x));
43473e9753d6SMatthew G. Knepley       if (locX_t) {
43489566063dSJacob Faibussowitsch         PetscCall(DMPlexVecGetClosure(plex, section, locX_t, support[0], NULL, &x));
43493e9753d6SMatthew G. Knepley         for (i = 0; i < totDim; ++i) u_t[face*totDim+i] = x[i];
43509566063dSJacob Faibussowitsch         PetscCall(DMPlexVecRestoreClosure(plex, section, locX_t, support[0], NULL, &x));
43513e9753d6SMatthew G. Knepley       }
43523e9753d6SMatthew G. Knepley       if (locA) {
43533e9753d6SMatthew G. Knepley         PetscInt subp;
43543e9753d6SMatthew G. Knepley 
43559566063dSJacob Faibussowitsch         PetscCall(DMGetEnclosurePoint(plexA, dm, encAux, support[0], &subp));
43569566063dSJacob Faibussowitsch         PetscCall(DMPlexVecGetClosure(plexA, sectionAux, locA, subp, NULL, &x));
43573e9753d6SMatthew G. Knepley         for (i = 0; i < totDimAux; ++i) a[face*totDimAux+i] = x[i];
43589566063dSJacob Faibussowitsch         PetscCall(DMPlexVecRestoreClosure(plexA, sectionAux, locA, subp, NULL, &x));
43593e9753d6SMatthew G. Knepley       }
43603e9753d6SMatthew G. Knepley     }
43619566063dSJacob Faibussowitsch     PetscCall(PetscArrayzero(elemVec, numFaces*totDim));
43623e9753d6SMatthew G. Knepley     {
43633e9753d6SMatthew G. Knepley       PetscFE         fe;
43643e9753d6SMatthew G. Knepley       PetscInt        Nb;
43653e9753d6SMatthew G. Knepley       PetscFEGeom     *chunkGeom = NULL;
43663e9753d6SMatthew G. Knepley       /* Conforming batches */
43673e9753d6SMatthew G. Knepley       PetscInt        numChunks, numBatches, numBlocks, Ne, blockSize, batchSize;
43683e9753d6SMatthew G. Knepley       /* Remainder */
43693e9753d6SMatthew G. Knepley       PetscInt        Nr, offset;
43703e9753d6SMatthew G. Knepley 
43719566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(prob, key.field, (PetscObject *) &fe));
43729566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDimension(fe, &Nb));
43739566063dSJacob Faibussowitsch       PetscCall(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
43743e9753d6SMatthew G. Knepley       /* TODO: documentation is unclear about what is going on with these numbers: how should Nb / Nq factor in ? */
43753e9753d6SMatthew G. Knepley       blockSize = Nb;
43763e9753d6SMatthew G. Knepley       batchSize = numBlocks * blockSize;
43779566063dSJacob Faibussowitsch       PetscCall(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
43783e9753d6SMatthew G. Knepley       numChunks = numFaces / (numBatches*batchSize);
43793e9753d6SMatthew G. Knepley       Ne        = numChunks*numBatches*batchSize;
43803e9753d6SMatthew G. Knepley       Nr        = numFaces % (numBatches*batchSize);
43813e9753d6SMatthew G. Knepley       offset    = numFaces - Nr;
43829566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomGetChunk(fgeom,0,offset,&chunkGeom));
43839566063dSJacob Faibussowitsch       PetscCall(PetscFEIntegrateBdResidual(prob, wf, key, Ne, chunkGeom, u, u_t, probAux, a, t, elemVec));
43849566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomRestoreChunk(fgeom, 0, offset, &chunkGeom));
43859566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomGetChunk(fgeom,offset,numFaces,&chunkGeom));
43869566063dSJacob Faibussowitsch       PetscCall(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]));
43879566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomRestoreChunk(fgeom,offset,numFaces,&chunkGeom));
43883e9753d6SMatthew G. Knepley     }
43893e9753d6SMatthew G. Knepley     for (face = 0; face < numFaces; ++face) {
43903e9753d6SMatthew G. Knepley       const PetscInt point = points[face], *support;
43913e9753d6SMatthew G. Knepley 
43929566063dSJacob Faibussowitsch       if (mesh->printFEM > 1) PetscCall(DMPrintCellVector(point, "BdResidual", totDim, &elemVec[face*totDim]));
43939566063dSJacob Faibussowitsch       PetscCall(DMPlexGetSupport(plex, point, &support));
43949566063dSJacob Faibussowitsch       PetscCall(DMPlexVecSetClosure(plex, NULL, locF, support[0], &elemVec[face*totDim], ADD_ALL_VALUES));
43953e9753d6SMatthew G. Knepley     }
43969566063dSJacob Faibussowitsch     PetscCall(DMSNESRestoreFEGeom(coordField,pointIS,qGeom,PETSC_TRUE,&fgeom));
43979566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureDestroy(&qGeom));
43989566063dSJacob Faibussowitsch     PetscCall(ISRestoreIndices(pointIS, &points));
43999566063dSJacob Faibussowitsch     PetscCall(ISDestroy(&pointIS));
44009566063dSJacob Faibussowitsch     PetscCall(PetscFree4(u, u_t, elemVec, a));
44013e9753d6SMatthew G. Knepley   }
44020c290148SMatthew G. Knepley   end:
44039566063dSJacob Faibussowitsch   PetscCall(DMDestroy(&plex));
44049566063dSJacob Faibussowitsch   PetscCall(DMDestroy(&plexA));
44053e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
44063e9753d6SMatthew G. Knepley }
44073e9753d6SMatthew G. Knepley 
44080c290148SMatthew G. Knepley PetscErrorCode DMPlexComputeBdResidualSingle(DM dm, PetscReal t, PetscWeakForm wf, PetscFormKey key, Vec locX, Vec locX_t, Vec locF)
44093e9753d6SMatthew G. Knepley {
44103e9753d6SMatthew G. Knepley   DMField        coordField;
44113e9753d6SMatthew G. Knepley   DMLabel        depthLabel;
44123e9753d6SMatthew G. Knepley   IS             facetIS;
44133e9753d6SMatthew G. Knepley   PetscInt       dim;
44143e9753d6SMatthew G. Knepley 
44153e9753d6SMatthew G. Knepley   PetscFunctionBegin;
44169566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
44179566063dSJacob Faibussowitsch   PetscCall(DMPlexGetDepthLabel(dm, &depthLabel));
44189566063dSJacob Faibussowitsch   PetscCall(DMLabelGetStratumIS(depthLabel, dim-1, &facetIS));
44199566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateField(dm, &coordField));
44209566063dSJacob Faibussowitsch   PetscCall(DMPlexComputeBdResidual_Single_Internal(dm, t, wf, key, locX, locX_t, locF, coordField, facetIS));
44219566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&facetIS));
44223e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
44233e9753d6SMatthew G. Knepley }
44243e9753d6SMatthew G. Knepley 
44253e9753d6SMatthew G. Knepley PetscErrorCode DMPlexComputeBdResidual_Internal(DM dm, Vec locX, Vec locX_t, PetscReal t, Vec locF, void *user)
44263e9753d6SMatthew G. Knepley {
44273e9753d6SMatthew G. Knepley   PetscDS        prob;
44283e9753d6SMatthew G. Knepley   PetscInt       numBd, bd;
44293e9753d6SMatthew G. Knepley   DMField        coordField = NULL;
44303e9753d6SMatthew G. Knepley   IS             facetIS    = NULL;
44313e9753d6SMatthew G. Knepley   DMLabel        depthLabel;
44323e9753d6SMatthew G. Knepley   PetscInt       dim;
44333e9753d6SMatthew G. Knepley 
44343e9753d6SMatthew G. Knepley   PetscFunctionBegin;
44359566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dm, &prob));
44369566063dSJacob Faibussowitsch   PetscCall(DMPlexGetDepthLabel(dm, &depthLabel));
44379566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
44389566063dSJacob Faibussowitsch   PetscCall(DMLabelGetStratumIS(depthLabel,dim - 1,&facetIS));
44399566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumBoundary(prob, &numBd));
44403e9753d6SMatthew G. Knepley   for (bd = 0; bd < numBd; ++bd) {
444145480ffeSMatthew G. Knepley     PetscWeakForm           wf;
44423e9753d6SMatthew G. Knepley     DMBoundaryConditionType type;
44433e9753d6SMatthew G. Knepley     DMLabel                 label;
44443e9753d6SMatthew G. Knepley     const PetscInt         *values;
44450c290148SMatthew G. Knepley     PetscInt                field, numValues, v;
44463e9753d6SMatthew G. Knepley     PetscObject             obj;
44473e9753d6SMatthew G. Knepley     PetscClassId            id;
44480c290148SMatthew G. Knepley     PetscFormKey            key;
44493e9753d6SMatthew G. Knepley 
44509566063dSJacob Faibussowitsch     PetscCall(PetscDSGetBoundary(prob, bd, &wf, &type, NULL, &label, &numValues, &values, &field, NULL, NULL, NULL, NULL, NULL));
44519566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, field, &obj));
44529566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
44533e9753d6SMatthew G. Knepley     if ((id != PETSCFE_CLASSID) || (type & DM_BC_ESSENTIAL)) continue;
44543e9753d6SMatthew G. Knepley     if (!facetIS) {
44553e9753d6SMatthew G. Knepley       DMLabel  depthLabel;
44563e9753d6SMatthew G. Knepley       PetscInt dim;
44573e9753d6SMatthew G. Knepley 
44589566063dSJacob Faibussowitsch       PetscCall(DMPlexGetDepthLabel(dm, &depthLabel));
44599566063dSJacob Faibussowitsch       PetscCall(DMGetDimension(dm, &dim));
44609566063dSJacob Faibussowitsch       PetscCall(DMLabelGetStratumIS(depthLabel, dim - 1, &facetIS));
44613e9753d6SMatthew G. Knepley     }
44629566063dSJacob Faibussowitsch     PetscCall(DMGetCoordinateField(dm, &coordField));
44630c290148SMatthew G. Knepley     for (v = 0; v < numValues; ++v) {
44640c290148SMatthew G. Knepley       key.label = label;
44650c290148SMatthew G. Knepley       key.value = values[v];
44660c290148SMatthew G. Knepley       key.field = field;
44670c290148SMatthew G. Knepley       key.part  = 0;
44689566063dSJacob Faibussowitsch       PetscCall(DMPlexComputeBdResidual_Single_Internal(dm, t, wf, key, locX, locX_t, locF, coordField, facetIS));
44690c290148SMatthew G. Knepley     }
44703e9753d6SMatthew G. Knepley   }
44719566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&facetIS));
44723e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
44733e9753d6SMatthew G. Knepley }
44743e9753d6SMatthew G. Knepley 
447506ad1575SMatthew G. Knepley PetscErrorCode DMPlexComputeResidual_Internal(DM dm, PetscFormKey key, IS cellIS, PetscReal time, Vec locX, Vec locX_t, PetscReal t, Vec locF, void *user)
44763e9753d6SMatthew G. Knepley {
44773e9753d6SMatthew G. Knepley   DM_Plex         *mesh       = (DM_Plex *) dm->data;
44783e9753d6SMatthew G. Knepley   const char      *name       = "Residual";
44793e9753d6SMatthew G. Knepley   DM               dmAux      = NULL;
44803e9753d6SMatthew G. Knepley   DM               dmGrad     = NULL;
44813e9753d6SMatthew G. Knepley   DMLabel          ghostLabel = NULL;
44826528b96dSMatthew G. Knepley   PetscDS          ds         = NULL;
44836528b96dSMatthew G. Knepley   PetscDS          dsAux      = NULL;
44843e9753d6SMatthew G. Knepley   PetscSection     section    = NULL;
44853e9753d6SMatthew G. Knepley   PetscBool        useFEM     = PETSC_FALSE;
44863e9753d6SMatthew G. Knepley   PetscBool        useFVM     = PETSC_FALSE;
44873e9753d6SMatthew G. Knepley   PetscBool        isImplicit = (locX_t || time == PETSC_MIN_REAL) ? PETSC_TRUE : PETSC_FALSE;
44883e9753d6SMatthew G. Knepley   PetscFV          fvm        = NULL;
44893e9753d6SMatthew G. Knepley   PetscFVCellGeom *cgeomFVM   = NULL;
44903e9753d6SMatthew G. Knepley   PetscFVFaceGeom *fgeomFVM   = NULL;
44913e9753d6SMatthew G. Knepley   DMField          coordField = NULL;
44923e9753d6SMatthew G. Knepley   Vec              locA, cellGeometryFVM = NULL, faceGeometryFVM = NULL, grad, locGrad = NULL;
44933e9753d6SMatthew G. Knepley   PetscScalar     *u = NULL, *u_t, *a, *uL, *uR;
44943e9753d6SMatthew G. Knepley   IS               chunkIS;
44953e9753d6SMatthew G. Knepley   const PetscInt  *cells;
44963e9753d6SMatthew G. Knepley   PetscInt         cStart, cEnd, numCells;
44973e9753d6SMatthew G. Knepley   PetscInt         Nf, f, totDim, totDimAux, numChunks, cellChunkSize, faceChunkSize, chunk, fStart, fEnd;
44983e9753d6SMatthew G. Knepley   PetscInt         maxDegree = PETSC_MAX_INT;
44993e9753d6SMatthew G. Knepley   PetscQuadrature  affineQuad = NULL, *quads = NULL;
45003e9753d6SMatthew G. Knepley   PetscFEGeom     *affineGeom = NULL, **geoms = NULL;
45013e9753d6SMatthew G. Knepley 
45023e9753d6SMatthew G. Knepley   PetscFunctionBegin;
4503e04ae0b4SMatthew G. Knepley   if (!cellIS) PetscFunctionReturn(0);
45049566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_ResidualFEM,dm,0,0,0));
45053e9753d6SMatthew G. Knepley   /* TODO The places where we have to use isFE are probably the member functions for the PetscDisc class */
45063e9753d6SMatthew G. Knepley   /* TODO The FVM geometry is over-manipulated. Make the precalc functions return exactly what we need */
45073e9753d6SMatthew G. Knepley   /* FEM+FVM */
45089566063dSJacob Faibussowitsch   PetscCall(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
45099566063dSJacob Faibussowitsch   PetscCall(DMPlexGetHeightStratum(dm, 1, &fStart, &fEnd));
45103e9753d6SMatthew G. Knepley   /* 1: Get sizes from dm and dmAux */
45119566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
45129566063dSJacob Faibussowitsch   PetscCall(DMGetLabel(dm, "ghost", &ghostLabel));
45139566063dSJacob Faibussowitsch   PetscCall(DMGetCellDS(dm, cells ? cells[cStart] : cStart, &ds));
45149566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumFields(ds, &Nf));
45159566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(ds, &totDim));
45169566063dSJacob Faibussowitsch   PetscCall(DMGetAuxiliaryVec(dm, key.label, key.value, key.part, &locA));
45173e9753d6SMatthew G. Knepley   if (locA) {
45183e9753d6SMatthew G. Knepley     PetscInt subcell;
45199566063dSJacob Faibussowitsch     PetscCall(VecGetDM(locA, &dmAux));
45201059d808SMatthew G. Knepley     PetscCall(DMGetEnclosurePoint(dmAux, dm, DM_ENC_UNKNOWN, cells ? cells[cStart] : cStart, &subcell));
45219566063dSJacob Faibussowitsch     PetscCall(DMGetCellDS(dmAux, subcell, &dsAux));
45229566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalDimension(dsAux, &totDimAux));
45233e9753d6SMatthew G. Knepley   }
45243e9753d6SMatthew G. Knepley   /* 2: Get geometric data */
45253e9753d6SMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
45263e9753d6SMatthew G. Knepley     PetscObject  obj;
45273e9753d6SMatthew G. Knepley     PetscClassId id;
45283e9753d6SMatthew G. Knepley     PetscBool    fimp;
45293e9753d6SMatthew G. Knepley 
45309566063dSJacob Faibussowitsch     PetscCall(PetscDSGetImplicit(ds, f, &fimp));
45313e9753d6SMatthew G. Knepley     if (isImplicit != fimp) continue;
45329566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(ds, f, &obj));
45339566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
45343e9753d6SMatthew G. Knepley     if (id == PETSCFE_CLASSID) {useFEM = PETSC_TRUE;}
45353e9753d6SMatthew G. Knepley     if (id == PETSCFV_CLASSID) {useFVM = PETSC_TRUE; fvm = (PetscFV) obj;}
45363e9753d6SMatthew G. Knepley   }
45373e9753d6SMatthew G. Knepley   if (useFEM) {
45389566063dSJacob Faibussowitsch     PetscCall(DMGetCoordinateField(dm, &coordField));
45399566063dSJacob Faibussowitsch     PetscCall(DMFieldGetDegree(coordField,cellIS,NULL,&maxDegree));
45403e9753d6SMatthew G. Knepley     if (maxDegree <= 1) {
45419566063dSJacob Faibussowitsch       PetscCall(DMFieldCreateDefaultQuadrature(coordField,cellIS,&affineQuad));
45423e9753d6SMatthew G. Knepley       if (affineQuad) {
45439566063dSJacob Faibussowitsch         PetscCall(DMSNESGetFEGeom(coordField,cellIS,affineQuad,PETSC_FALSE,&affineGeom));
45443e9753d6SMatthew G. Knepley       }
45453e9753d6SMatthew G. Knepley     } else {
45469566063dSJacob Faibussowitsch       PetscCall(PetscCalloc2(Nf,&quads,Nf,&geoms));
45473e9753d6SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
45483e9753d6SMatthew G. Knepley         PetscObject  obj;
45493e9753d6SMatthew G. Knepley         PetscClassId id;
45503e9753d6SMatthew G. Knepley         PetscBool    fimp;
45513e9753d6SMatthew G. Knepley 
45529566063dSJacob Faibussowitsch         PetscCall(PetscDSGetImplicit(ds, f, &fimp));
45533e9753d6SMatthew G. Knepley         if (isImplicit != fimp) continue;
45549566063dSJacob Faibussowitsch         PetscCall(PetscDSGetDiscretization(ds, f, &obj));
45559566063dSJacob Faibussowitsch         PetscCall(PetscObjectGetClassId(obj, &id));
45563e9753d6SMatthew G. Knepley         if (id == PETSCFE_CLASSID) {
45573e9753d6SMatthew G. Knepley           PetscFE fe = (PetscFE) obj;
45583e9753d6SMatthew G. Knepley 
45599566063dSJacob Faibussowitsch           PetscCall(PetscFEGetQuadrature(fe, &quads[f]));
45609566063dSJacob Faibussowitsch           PetscCall(PetscObjectReference((PetscObject)quads[f]));
45619566063dSJacob Faibussowitsch           PetscCall(DMSNESGetFEGeom(coordField,cellIS,quads[f],PETSC_FALSE,&geoms[f]));
45623e9753d6SMatthew G. Knepley         }
45633e9753d6SMatthew G. Knepley       }
45643e9753d6SMatthew G. Knepley     }
45653e9753d6SMatthew G. Knepley   }
45663e9753d6SMatthew G. Knepley   if (useFVM) {
45679566063dSJacob Faibussowitsch     PetscCall(DMPlexGetGeometryFVM(dm, &faceGeometryFVM, &cellGeometryFVM, NULL));
45689566063dSJacob Faibussowitsch     PetscCall(VecGetArrayRead(faceGeometryFVM, (const PetscScalar **) &fgeomFVM));
45699566063dSJacob Faibussowitsch     PetscCall(VecGetArrayRead(cellGeometryFVM, (const PetscScalar **) &cgeomFVM));
45703e9753d6SMatthew G. Knepley     /* Reconstruct and limit cell gradients */
45719566063dSJacob Faibussowitsch     PetscCall(DMPlexGetGradientDM(dm, fvm, &dmGrad));
45723e9753d6SMatthew G. Knepley     if (dmGrad) {
45739566063dSJacob Faibussowitsch       PetscCall(DMPlexGetHeightStratum(dm, 1, &fStart, &fEnd));
45749566063dSJacob Faibussowitsch       PetscCall(DMGetGlobalVector(dmGrad, &grad));
45759566063dSJacob Faibussowitsch       PetscCall(DMPlexReconstructGradients_Internal(dm, fvm, fStart, fEnd, faceGeometryFVM, cellGeometryFVM, locX, grad));
45763e9753d6SMatthew G. Knepley       /* Communicate gradient values */
45779566063dSJacob Faibussowitsch       PetscCall(DMGetLocalVector(dmGrad, &locGrad));
45789566063dSJacob Faibussowitsch       PetscCall(DMGlobalToLocalBegin(dmGrad, grad, INSERT_VALUES, locGrad));
45799566063dSJacob Faibussowitsch       PetscCall(DMGlobalToLocalEnd(dmGrad, grad, INSERT_VALUES, locGrad));
45809566063dSJacob Faibussowitsch       PetscCall(DMRestoreGlobalVector(dmGrad, &grad));
45813e9753d6SMatthew G. Knepley     }
45823e9753d6SMatthew G. Knepley     /* Handle non-essential (e.g. outflow) boundary values */
45839566063dSJacob Faibussowitsch     PetscCall(DMPlexInsertBoundaryValues(dm, PETSC_FALSE, locX, time, faceGeometryFVM, cellGeometryFVM, locGrad));
45843e9753d6SMatthew G. Knepley   }
45853e9753d6SMatthew G. Knepley   /* Loop over chunks */
45869566063dSJacob Faibussowitsch   if (useFEM) PetscCall(ISCreate(PETSC_COMM_SELF, &chunkIS));
45873e9753d6SMatthew G. Knepley   numCells      = cEnd - cStart;
45883e9753d6SMatthew G. Knepley   numChunks     = 1;
45893e9753d6SMatthew G. Knepley   cellChunkSize = numCells/numChunks;
45903e9753d6SMatthew G. Knepley   faceChunkSize = (fEnd - fStart)/numChunks;
45913e9753d6SMatthew G. Knepley   numChunks     = PetscMin(1,numCells);
45923e9753d6SMatthew G. Knepley   for (chunk = 0; chunk < numChunks; ++chunk) {
45933e9753d6SMatthew G. Knepley     PetscScalar     *elemVec, *fluxL, *fluxR;
45943e9753d6SMatthew G. Knepley     PetscReal       *vol;
45953e9753d6SMatthew G. Knepley     PetscFVFaceGeom *fgeom;
45963e9753d6SMatthew G. Knepley     PetscInt         cS = cStart+chunk*cellChunkSize, cE = PetscMin(cS+cellChunkSize, cEnd), numCells = cE - cS, c;
45973e9753d6SMatthew G. Knepley     PetscInt         fS = fStart+chunk*faceChunkSize, fE = PetscMin(fS+faceChunkSize, fEnd), numFaces = 0, face;
45983e9753d6SMatthew G. Knepley 
45993e9753d6SMatthew G. Knepley     /* Extract field coefficients */
46003e9753d6SMatthew G. Knepley     if (useFEM) {
46019566063dSJacob Faibussowitsch       PetscCall(ISGetPointSubrange(chunkIS, cS, cE, cells));
46029566063dSJacob Faibussowitsch       PetscCall(DMPlexGetCellFields(dm, chunkIS, locX, locX_t, locA, &u, &u_t, &a));
46039566063dSJacob Faibussowitsch       PetscCall(DMGetWorkArray(dm, numCells*totDim, MPIU_SCALAR, &elemVec));
46049566063dSJacob Faibussowitsch       PetscCall(PetscArrayzero(elemVec, numCells*totDim));
46053e9753d6SMatthew G. Knepley     }
46063e9753d6SMatthew G. Knepley     if (useFVM) {
46079566063dSJacob Faibussowitsch       PetscCall(DMPlexGetFaceFields(dm, fS, fE, locX, locX_t, faceGeometryFVM, cellGeometryFVM, locGrad, &numFaces, &uL, &uR));
46089566063dSJacob Faibussowitsch       PetscCall(DMPlexGetFaceGeometry(dm, fS, fE, faceGeometryFVM, cellGeometryFVM, &numFaces, &fgeom, &vol));
46099566063dSJacob Faibussowitsch       PetscCall(DMGetWorkArray(dm, numFaces*totDim, MPIU_SCALAR, &fluxL));
46109566063dSJacob Faibussowitsch       PetscCall(DMGetWorkArray(dm, numFaces*totDim, MPIU_SCALAR, &fluxR));
46119566063dSJacob Faibussowitsch       PetscCall(PetscArrayzero(fluxL, numFaces*totDim));
46129566063dSJacob Faibussowitsch       PetscCall(PetscArrayzero(fluxR, numFaces*totDim));
46133e9753d6SMatthew G. Knepley     }
46143e9753d6SMatthew 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 */
46153e9753d6SMatthew G. Knepley     /* Loop over fields */
46163e9753d6SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
46173e9753d6SMatthew G. Knepley       PetscObject  obj;
46183e9753d6SMatthew G. Knepley       PetscClassId id;
46193e9753d6SMatthew G. Knepley       PetscBool    fimp;
46203e9753d6SMatthew G. Knepley       PetscInt     numChunks, numBatches, batchSize, numBlocks, blockSize, Ne, Nr, offset;
46213e9753d6SMatthew G. Knepley 
46226528b96dSMatthew G. Knepley       key.field = f;
46239566063dSJacob Faibussowitsch       PetscCall(PetscDSGetImplicit(ds, f, &fimp));
46243e9753d6SMatthew G. Knepley       if (isImplicit != fimp) continue;
46259566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(ds, f, &obj));
46269566063dSJacob Faibussowitsch       PetscCall(PetscObjectGetClassId(obj, &id));
46273e9753d6SMatthew G. Knepley       if (id == PETSCFE_CLASSID) {
46283e9753d6SMatthew G. Knepley         PetscFE         fe = (PetscFE) obj;
46293e9753d6SMatthew G. Knepley         PetscFEGeom    *geom = affineGeom ? affineGeom : geoms[f];
46303e9753d6SMatthew G. Knepley         PetscFEGeom    *chunkGeom = NULL;
46313e9753d6SMatthew G. Knepley         PetscQuadrature quad = affineQuad ? affineQuad : quads[f];
46323e9753d6SMatthew G. Knepley         PetscInt        Nq, Nb;
46333e9753d6SMatthew G. Knepley 
46349566063dSJacob Faibussowitsch         PetscCall(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
46359566063dSJacob Faibussowitsch         PetscCall(PetscQuadratureGetData(quad, NULL, NULL, &Nq, NULL, NULL));
46369566063dSJacob Faibussowitsch         PetscCall(PetscFEGetDimension(fe, &Nb));
46373e9753d6SMatthew G. Knepley         blockSize = Nb;
46383e9753d6SMatthew G. Knepley         batchSize = numBlocks * blockSize;
46399566063dSJacob Faibussowitsch         PetscCall(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
46403e9753d6SMatthew G. Knepley         numChunks = numCells / (numBatches*batchSize);
46413e9753d6SMatthew G. Knepley         Ne        = numChunks*numBatches*batchSize;
46423e9753d6SMatthew G. Knepley         Nr        = numCells % (numBatches*batchSize);
46433e9753d6SMatthew G. Knepley         offset    = numCells - Nr;
46443e9753d6SMatthew G. Knepley         /* Integrate FE residual to get elemVec (need fields at quadrature points) */
46453e9753d6SMatthew 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) */
46469566063dSJacob Faibussowitsch         PetscCall(PetscFEGeomGetChunk(geom,0,offset,&chunkGeom));
46479566063dSJacob Faibussowitsch         PetscCall(PetscFEIntegrateResidual(ds, key, Ne, chunkGeom, u, u_t, dsAux, a, t, elemVec));
46489566063dSJacob Faibussowitsch         PetscCall(PetscFEGeomGetChunk(geom,offset,numCells,&chunkGeom));
46499566063dSJacob Faibussowitsch         PetscCall(PetscFEIntegrateResidual(ds, key, Nr, chunkGeom, &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, dsAux, &a[offset*totDimAux], t, &elemVec[offset*totDim]));
46509566063dSJacob Faibussowitsch         PetscCall(PetscFEGeomRestoreChunk(geom,offset,numCells,&chunkGeom));
46513e9753d6SMatthew G. Knepley       } else if (id == PETSCFV_CLASSID) {
46523e9753d6SMatthew G. Knepley         PetscFV fv = (PetscFV) obj;
46533e9753d6SMatthew G. Knepley 
46543e9753d6SMatthew G. Knepley         Ne = numFaces;
46553e9753d6SMatthew G. Knepley         /* Riemann solve over faces (need fields at face centroids) */
46563e9753d6SMatthew G. Knepley         /*   We need to evaluate FE fields at those coordinates */
46579566063dSJacob Faibussowitsch         PetscCall(PetscFVIntegrateRHSFunction(fv, ds, f, Ne, fgeom, vol, uL, uR, fluxL, fluxR));
465863a3b9bcSJacob Faibussowitsch       } else SETERRQ(PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, f);
46593e9753d6SMatthew G. Knepley     }
46603e9753d6SMatthew G. Knepley     /* Loop over domain */
46613e9753d6SMatthew G. Knepley     if (useFEM) {
46623e9753d6SMatthew G. Knepley       /* Add elemVec to locX */
46633e9753d6SMatthew G. Knepley       for (c = cS; c < cE; ++c) {
46643e9753d6SMatthew G. Knepley         const PetscInt cell = cells ? cells[c] : c;
46653e9753d6SMatthew G. Knepley         const PetscInt cind = c - cStart;
46663e9753d6SMatthew G. Knepley 
46679566063dSJacob Faibussowitsch         if (mesh->printFEM > 1) PetscCall(DMPrintCellVector(cell, name, totDim, &elemVec[cind*totDim]));
46683e9753d6SMatthew G. Knepley         if (ghostLabel) {
46693e9753d6SMatthew G. Knepley           PetscInt ghostVal;
46703e9753d6SMatthew G. Knepley 
46719566063dSJacob Faibussowitsch           PetscCall(DMLabelGetValue(ghostLabel,cell,&ghostVal));
46723e9753d6SMatthew G. Knepley           if (ghostVal > 0) continue;
46733e9753d6SMatthew G. Knepley         }
46749566063dSJacob Faibussowitsch         PetscCall(DMPlexVecSetClosure(dm, section, locF, cell, &elemVec[cind*totDim], ADD_ALL_VALUES));
46753e9753d6SMatthew G. Knepley       }
46763e9753d6SMatthew G. Knepley     }
46773e9753d6SMatthew G. Knepley     if (useFVM) {
46783e9753d6SMatthew G. Knepley       PetscScalar *fa;
46793e9753d6SMatthew G. Knepley       PetscInt     iface;
46803e9753d6SMatthew G. Knepley 
46819566063dSJacob Faibussowitsch       PetscCall(VecGetArray(locF, &fa));
46823e9753d6SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
46833e9753d6SMatthew G. Knepley         PetscFV      fv;
46843e9753d6SMatthew G. Knepley         PetscObject  obj;
46853e9753d6SMatthew G. Knepley         PetscClassId id;
46863e9753d6SMatthew G. Knepley         PetscInt     foff, pdim;
46873e9753d6SMatthew G. Knepley 
46889566063dSJacob Faibussowitsch         PetscCall(PetscDSGetDiscretization(ds, f, &obj));
46899566063dSJacob Faibussowitsch         PetscCall(PetscDSGetFieldOffset(ds, f, &foff));
46909566063dSJacob Faibussowitsch         PetscCall(PetscObjectGetClassId(obj, &id));
46913e9753d6SMatthew G. Knepley         if (id != PETSCFV_CLASSID) continue;
46923e9753d6SMatthew G. Knepley         fv   = (PetscFV) obj;
46939566063dSJacob Faibussowitsch         PetscCall(PetscFVGetNumComponents(fv, &pdim));
46943e9753d6SMatthew G. Knepley         /* Accumulate fluxes to cells */
46953e9753d6SMatthew G. Knepley         for (face = fS, iface = 0; face < fE; ++face) {
46963e9753d6SMatthew G. Knepley           const PetscInt *scells;
46973e9753d6SMatthew G. Knepley           PetscScalar    *fL = NULL, *fR = NULL;
46983e9753d6SMatthew G. Knepley           PetscInt        ghost, d, nsupp, nchild;
46993e9753d6SMatthew G. Knepley 
47009566063dSJacob Faibussowitsch           PetscCall(DMLabelGetValue(ghostLabel, face, &ghost));
47019566063dSJacob Faibussowitsch           PetscCall(DMPlexGetSupportSize(dm, face, &nsupp));
47029566063dSJacob Faibussowitsch           PetscCall(DMPlexGetTreeChildren(dm, face, &nchild, NULL));
47033e9753d6SMatthew G. Knepley           if (ghost >= 0 || nsupp > 2 || nchild > 0) continue;
47049566063dSJacob Faibussowitsch           PetscCall(DMPlexGetSupport(dm, face, &scells));
47059566063dSJacob Faibussowitsch           PetscCall(DMLabelGetValue(ghostLabel,scells[0],&ghost));
47069566063dSJacob Faibussowitsch           if (ghost <= 0) PetscCall(DMPlexPointLocalFieldRef(dm, scells[0], f, fa, &fL));
47079566063dSJacob Faibussowitsch           PetscCall(DMLabelGetValue(ghostLabel,scells[1],&ghost));
47089566063dSJacob Faibussowitsch           if (ghost <= 0) PetscCall(DMPlexPointLocalFieldRef(dm, scells[1], f, fa, &fR));
47093e9753d6SMatthew G. Knepley           for (d = 0; d < pdim; ++d) {
47103e9753d6SMatthew G. Knepley             if (fL) fL[d] -= fluxL[iface*totDim+foff+d];
47113e9753d6SMatthew G. Knepley             if (fR) fR[d] += fluxR[iface*totDim+foff+d];
47123e9753d6SMatthew G. Knepley           }
47133e9753d6SMatthew G. Knepley           ++iface;
47143e9753d6SMatthew G. Knepley         }
47153e9753d6SMatthew G. Knepley       }
47169566063dSJacob Faibussowitsch       PetscCall(VecRestoreArray(locF, &fa));
47173e9753d6SMatthew G. Knepley     }
47183e9753d6SMatthew G. Knepley     /* Handle time derivative */
47193e9753d6SMatthew G. Knepley     if (locX_t) {
47203e9753d6SMatthew G. Knepley       PetscScalar *x_t, *fa;
47213e9753d6SMatthew G. Knepley 
47229566063dSJacob Faibussowitsch       PetscCall(VecGetArray(locF, &fa));
47239566063dSJacob Faibussowitsch       PetscCall(VecGetArray(locX_t, &x_t));
47243e9753d6SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
47253e9753d6SMatthew G. Knepley         PetscFV      fv;
47263e9753d6SMatthew G. Knepley         PetscObject  obj;
47273e9753d6SMatthew G. Knepley         PetscClassId id;
47283e9753d6SMatthew G. Knepley         PetscInt     pdim, d;
47293e9753d6SMatthew G. Knepley 
47309566063dSJacob Faibussowitsch         PetscCall(PetscDSGetDiscretization(ds, f, &obj));
47319566063dSJacob Faibussowitsch         PetscCall(PetscObjectGetClassId(obj, &id));
47323e9753d6SMatthew G. Knepley         if (id != PETSCFV_CLASSID) continue;
47333e9753d6SMatthew G. Knepley         fv   = (PetscFV) obj;
47349566063dSJacob Faibussowitsch         PetscCall(PetscFVGetNumComponents(fv, &pdim));
47353e9753d6SMatthew G. Knepley         for (c = cS; c < cE; ++c) {
47363e9753d6SMatthew G. Knepley           const PetscInt cell = cells ? cells[c] : c;
47373e9753d6SMatthew G. Knepley           PetscScalar   *u_t, *r;
47383e9753d6SMatthew G. Knepley 
47393e9753d6SMatthew G. Knepley           if (ghostLabel) {
47403e9753d6SMatthew G. Knepley             PetscInt ghostVal;
47413e9753d6SMatthew G. Knepley 
47429566063dSJacob Faibussowitsch             PetscCall(DMLabelGetValue(ghostLabel, cell, &ghostVal));
47433e9753d6SMatthew G. Knepley             if (ghostVal > 0) continue;
47443e9753d6SMatthew G. Knepley           }
47459566063dSJacob Faibussowitsch           PetscCall(DMPlexPointLocalFieldRead(dm, cell, f, x_t, &u_t));
47469566063dSJacob Faibussowitsch           PetscCall(DMPlexPointLocalFieldRef(dm, cell, f, fa, &r));
47473e9753d6SMatthew G. Knepley           for (d = 0; d < pdim; ++d) r[d] += u_t[d];
47483e9753d6SMatthew G. Knepley         }
47493e9753d6SMatthew G. Knepley       }
47509566063dSJacob Faibussowitsch       PetscCall(VecRestoreArray(locX_t, &x_t));
47519566063dSJacob Faibussowitsch       PetscCall(VecRestoreArray(locF, &fa));
47523e9753d6SMatthew G. Knepley     }
47533e9753d6SMatthew G. Knepley     if (useFEM) {
47549566063dSJacob Faibussowitsch       PetscCall(DMPlexRestoreCellFields(dm, chunkIS, locX, locX_t, locA, &u, &u_t, &a));
47559566063dSJacob Faibussowitsch       PetscCall(DMRestoreWorkArray(dm, numCells*totDim, MPIU_SCALAR, &elemVec));
47563e9753d6SMatthew G. Knepley     }
47573e9753d6SMatthew G. Knepley     if (useFVM) {
47589566063dSJacob Faibussowitsch       PetscCall(DMPlexRestoreFaceFields(dm, fS, fE, locX, locX_t, faceGeometryFVM, cellGeometryFVM, locGrad, &numFaces, &uL, &uR));
47599566063dSJacob Faibussowitsch       PetscCall(DMPlexRestoreFaceGeometry(dm, fS, fE, faceGeometryFVM, cellGeometryFVM, &numFaces, &fgeom, &vol));
47609566063dSJacob Faibussowitsch       PetscCall(DMRestoreWorkArray(dm, numFaces*totDim, MPIU_SCALAR, &fluxL));
47619566063dSJacob Faibussowitsch       PetscCall(DMRestoreWorkArray(dm, numFaces*totDim, MPIU_SCALAR, &fluxR));
47629566063dSJacob Faibussowitsch       if (dmGrad) PetscCall(DMRestoreLocalVector(dmGrad, &locGrad));
47633e9753d6SMatthew G. Knepley     }
47643e9753d6SMatthew G. Knepley   }
47659566063dSJacob Faibussowitsch   if (useFEM) PetscCall(ISDestroy(&chunkIS));
47669566063dSJacob Faibussowitsch   PetscCall(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
47673e9753d6SMatthew G. Knepley 
47683e9753d6SMatthew G. Knepley   if (useFEM) {
47699566063dSJacob Faibussowitsch     PetscCall(DMPlexComputeBdResidual_Internal(dm, locX, locX_t, t, locF, user));
47703e9753d6SMatthew G. Knepley 
47713e9753d6SMatthew G. Knepley     if (maxDegree <= 1) {
47729566063dSJacob Faibussowitsch       PetscCall(DMSNESRestoreFEGeom(coordField,cellIS,affineQuad,PETSC_FALSE,&affineGeom));
47739566063dSJacob Faibussowitsch       PetscCall(PetscQuadratureDestroy(&affineQuad));
47743e9753d6SMatthew G. Knepley     } else {
47753e9753d6SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
47769566063dSJacob Faibussowitsch         PetscCall(DMSNESRestoreFEGeom(coordField,cellIS,quads[f],PETSC_FALSE,&geoms[f]));
47779566063dSJacob Faibussowitsch         PetscCall(PetscQuadratureDestroy(&quads[f]));
47783e9753d6SMatthew G. Knepley       }
47799566063dSJacob Faibussowitsch       PetscCall(PetscFree2(quads,geoms));
47803e9753d6SMatthew G. Knepley     }
47813e9753d6SMatthew G. Knepley   }
47823e9753d6SMatthew G. Knepley 
47833e9753d6SMatthew G. Knepley   /* FEM */
47843e9753d6SMatthew G. Knepley   /* 1: Get sizes from dm and dmAux */
47853e9753d6SMatthew G. Knepley   /* 2: Get geometric data */
47863e9753d6SMatthew G. Knepley   /* 3: Handle boundary values */
47873e9753d6SMatthew G. Knepley   /* 4: Loop over domain */
47883e9753d6SMatthew G. Knepley   /*   Extract coefficients */
47893e9753d6SMatthew G. Knepley   /* Loop over fields */
47903e9753d6SMatthew G. Knepley   /*   Set tiling for FE*/
47913e9753d6SMatthew G. Knepley   /*   Integrate FE residual to get elemVec */
47923e9753d6SMatthew G. Knepley   /*     Loop over subdomain */
47933e9753d6SMatthew G. Knepley   /*       Loop over quad points */
47943e9753d6SMatthew G. Knepley   /*         Transform coords to real space */
47953e9753d6SMatthew G. Knepley   /*         Evaluate field and aux fields at point */
47963e9753d6SMatthew G. Knepley   /*         Evaluate residual at point */
47973e9753d6SMatthew G. Knepley   /*         Transform residual to real space */
47983e9753d6SMatthew G. Knepley   /*       Add residual to elemVec */
47993e9753d6SMatthew G. Knepley   /* Loop over domain */
48003e9753d6SMatthew G. Knepley   /*   Add elemVec to locX */
48013e9753d6SMatthew G. Knepley 
48023e9753d6SMatthew G. Knepley   /* FVM */
48033e9753d6SMatthew G. Knepley   /* Get geometric data */
48043e9753d6SMatthew G. Knepley   /* If using gradients */
48053e9753d6SMatthew G. Knepley   /*   Compute gradient data */
48063e9753d6SMatthew G. Knepley   /*   Loop over domain faces */
48073e9753d6SMatthew G. Knepley   /*     Count computational faces */
48083e9753d6SMatthew G. Knepley   /*     Reconstruct cell gradient */
48093e9753d6SMatthew G. Knepley   /*   Loop over domain cells */
48103e9753d6SMatthew G. Knepley   /*     Limit cell gradients */
48113e9753d6SMatthew G. Knepley   /* Handle boundary values */
48123e9753d6SMatthew G. Knepley   /* Loop over domain faces */
48133e9753d6SMatthew G. Knepley   /*   Read out field, centroid, normal, volume for each side of face */
48143e9753d6SMatthew G. Knepley   /* Riemann solve over faces */
48153e9753d6SMatthew G. Knepley   /* Loop over domain faces */
48163e9753d6SMatthew G. Knepley   /*   Accumulate fluxes to cells */
48173e9753d6SMatthew G. Knepley   /* TODO Change printFEM to printDisc here */
48183e9753d6SMatthew G. Knepley   if (mesh->printFEM) {
48193e9753d6SMatthew G. Knepley     Vec         locFbc;
48203e9753d6SMatthew G. Knepley     PetscInt    pStart, pEnd, p, maxDof;
48213e9753d6SMatthew G. Knepley     PetscScalar *zeroes;
48223e9753d6SMatthew G. Knepley 
48239566063dSJacob Faibussowitsch     PetscCall(VecDuplicate(locF,&locFbc));
48249566063dSJacob Faibussowitsch     PetscCall(VecCopy(locF,locFbc));
48259566063dSJacob Faibussowitsch     PetscCall(PetscSectionGetChart(section,&pStart,&pEnd));
48269566063dSJacob Faibussowitsch     PetscCall(PetscSectionGetMaxDof(section,&maxDof));
48279566063dSJacob Faibussowitsch     PetscCall(PetscCalloc1(maxDof,&zeroes));
48283e9753d6SMatthew G. Knepley     for (p = pStart; p < pEnd; p++) {
48299566063dSJacob Faibussowitsch       PetscCall(VecSetValuesSection(locFbc,section,p,zeroes,INSERT_BC_VALUES));
48303e9753d6SMatthew G. Knepley     }
48319566063dSJacob Faibussowitsch     PetscCall(PetscFree(zeroes));
48329566063dSJacob Faibussowitsch     PetscCall(DMPrintLocalVec(dm, name, mesh->printTol, locFbc));
48339566063dSJacob Faibussowitsch     PetscCall(VecDestroy(&locFbc));
48343e9753d6SMatthew G. Knepley   }
48359566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_ResidualFEM,dm,0,0,0));
48363e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
48373e9753d6SMatthew G. Knepley }
48383e9753d6SMatthew G. Knepley 
48396528b96dSMatthew G. Knepley /*
48406528b96dSMatthew G. Knepley   1) Allow multiple kernels for BdResidual for hybrid DS
48416528b96dSMatthew G. Knepley 
48426528b96dSMatthew G. Knepley   DONE 2) Get out dsAux for either side at the same time as cohesive cell dsAux
48436528b96dSMatthew G. Knepley 
48446528b96dSMatthew G. Knepley   DONE 3) Change DMGetCellFields() to get different aux data a[] for each side
48456528b96dSMatthew G. Knepley      - I think I just need to replace a[] with the closure from each face
48466528b96dSMatthew G. Knepley 
48476528b96dSMatthew G. Knepley   4) Run both kernels for each non-hybrid field with correct dsAux, and then hybrid field as before
48486528b96dSMatthew G. Knepley */
484906ad1575SMatthew 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)
48503e9753d6SMatthew G. Knepley {
48513e9753d6SMatthew G. Knepley   DM_Plex         *mesh       = (DM_Plex *) dm->data;
48523e9753d6SMatthew G. Knepley   const char      *name       = "Hybrid Residual";
485304c51a94SMatthew G. Knepley   DM               dmAux[3]   = {NULL, NULL, NULL};
48543e9753d6SMatthew G. Knepley   DMLabel          ghostLabel = NULL;
48556528b96dSMatthew G. Knepley   PetscDS          ds         = NULL;
48566528b96dSMatthew G. Knepley   PetscDS          dsAux[3]   = {NULL, NULL, NULL};
485704c51a94SMatthew G. Knepley   Vec              locA[3]    = {NULL, NULL, NULL};
48583e9753d6SMatthew G. Knepley   PetscSection     section    = NULL;
48593e9753d6SMatthew G. Knepley   DMField          coordField = NULL;
48606528b96dSMatthew G. Knepley   PetscScalar     *u = NULL, *u_t, *a[3];
48613e9753d6SMatthew G. Knepley   PetscScalar     *elemVec;
48623e9753d6SMatthew G. Knepley   IS               chunkIS;
48633e9753d6SMatthew G. Knepley   const PetscInt  *cells;
48643e9753d6SMatthew G. Knepley   PetscInt        *faces;
48653e9753d6SMatthew G. Knepley   PetscInt         cStart, cEnd, numCells;
48666528b96dSMatthew G. Knepley   PetscInt         Nf, f, totDim, totDimAux[3], numChunks, cellChunkSize, chunk;
48673e9753d6SMatthew G. Knepley   PetscInt         maxDegree = PETSC_MAX_INT;
48683e9753d6SMatthew G. Knepley   PetscQuadrature  affineQuad = NULL, *quads = NULL;
48693e9753d6SMatthew G. Knepley   PetscFEGeom     *affineGeom = NULL, **geoms = NULL;
48703e9753d6SMatthew G. Knepley 
48713e9753d6SMatthew G. Knepley   PetscFunctionBegin;
48725fedec97SMatthew G. Knepley   if ((key[0].label == key[1].label) && (key[0].value == key[1].value) && (key[0].part == key[1].part)) {
48735fedec97SMatthew G. Knepley     const char *name;
48749566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetName((PetscObject) key[0].label, &name));
487563a3b9bcSJacob Faibussowitsch     SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Form keys for each side of a cohesive surface must be different (%s, %" PetscInt_FMT ", %" PetscInt_FMT ")", name, key[0].value, key[0].part);
48765fedec97SMatthew G. Knepley   }
48779566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_ResidualFEM,dm,0,0,0));
48783e9753d6SMatthew G. Knepley   /* TODO The places where we have to use isFE are probably the member functions for the PetscDisc class */
48793e9753d6SMatthew G. Knepley   /* FEM */
48809566063dSJacob Faibussowitsch   PetscCall(ISGetLocalSize(cellIS, &numCells));
48819566063dSJacob Faibussowitsch   PetscCall(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
48823e9753d6SMatthew G. Knepley   /* 1: Get sizes from dm and dmAux */
48839566063dSJacob Faibussowitsch   PetscCall(DMGetSection(dm, &section));
48849566063dSJacob Faibussowitsch   PetscCall(DMGetLabel(dm, "ghost", &ghostLabel));
48851059d808SMatthew G. Knepley   PetscCall(DMGetCellDS(dm, cells ? cells[cStart] : cStart, &ds));
48869566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumFields(ds, &Nf));
48879566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(ds, &totDim));
48889566063dSJacob Faibussowitsch   PetscCall(DMGetAuxiliaryVec(dm, key[2].label, key[2].value, key[2].part, &locA[2]));
488904c51a94SMatthew G. Knepley   if (locA[2]) {
48901059d808SMatthew G. Knepley     const PetscInt cellStart = cells ? cells[cStart] : cStart;
48911059d808SMatthew G. Knepley 
48929566063dSJacob Faibussowitsch     PetscCall(VecGetDM(locA[2], &dmAux[2]));
48931059d808SMatthew G. Knepley     PetscCall(DMGetCellDS(dmAux[2], cellStart, &dsAux[2]));
48949566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalDimension(dsAux[2], &totDimAux[2]));
48956528b96dSMatthew G. Knepley     {
48966528b96dSMatthew G. Knepley       const PetscInt *cone;
48976528b96dSMatthew G. Knepley       PetscInt        c;
48986528b96dSMatthew G. Knepley 
48991059d808SMatthew G. Knepley       PetscCall(DMPlexGetCone(dm, cellStart, &cone));
49006528b96dSMatthew G. Knepley       for (c = 0; c < 2; ++c) {
49016528b96dSMatthew G. Knepley         const PetscInt *support;
49026528b96dSMatthew G. Knepley         PetscInt ssize, s;
49036528b96dSMatthew G. Knepley 
49049566063dSJacob Faibussowitsch         PetscCall(DMPlexGetSupport(dm, cone[c], &support));
49059566063dSJacob Faibussowitsch         PetscCall(DMPlexGetSupportSize(dm, cone[c], &ssize));
49061059d808SMatthew G. Knepley         PetscCheck(ssize == 2,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Face %" PetscInt_FMT " from cell %" PetscInt_FMT " has support size %" PetscInt_FMT " != 2", cone[c], cellStart, ssize);
49071059d808SMatthew G. Knepley         if      (support[0] == cellStart) s = 1;
49081059d808SMatthew G. Knepley         else if (support[1] == cellStart) s = 0;
49091059d808SMatthew G. Knepley         else SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Face %" PetscInt_FMT " does not have cell %" PetscInt_FMT " in its support", cone[c], cellStart);
49109566063dSJacob Faibussowitsch         PetscCall(DMGetAuxiliaryVec(dm, key[c].label, key[c].value, key[c].part, &locA[c]));
49119566063dSJacob Faibussowitsch         if (locA[c]) PetscCall(VecGetDM(locA[c], &dmAux[c]));
491204c51a94SMatthew G. Knepley         else         {dmAux[c] = dmAux[2];}
49139566063dSJacob Faibussowitsch         PetscCall(DMGetCellDS(dmAux[c], support[s], &dsAux[c]));
49149566063dSJacob Faibussowitsch         PetscCall(PetscDSGetTotalDimension(dsAux[c], &totDimAux[c]));
49156528b96dSMatthew G. Knepley       }
49166528b96dSMatthew G. Knepley     }
49173e9753d6SMatthew G. Knepley   }
49183e9753d6SMatthew G. Knepley   /* 2: Setup geometric data */
49199566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateField(dm, &coordField));
49209566063dSJacob Faibussowitsch   PetscCall(DMFieldGetDegree(coordField, cellIS, NULL, &maxDegree));
49213e9753d6SMatthew G. Knepley   if (maxDegree > 1) {
49229566063dSJacob Faibussowitsch     PetscCall(PetscCalloc2(Nf, &quads, Nf, &geoms));
49233e9753d6SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
49243e9753d6SMatthew G. Knepley       PetscFE fe;
49253e9753d6SMatthew G. Knepley 
49269566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(ds, f, (PetscObject *) &fe));
49273e9753d6SMatthew G. Knepley       if (fe) {
49289566063dSJacob Faibussowitsch         PetscCall(PetscFEGetQuadrature(fe, &quads[f]));
49299566063dSJacob Faibussowitsch         PetscCall(PetscObjectReference((PetscObject) quads[f]));
49303e9753d6SMatthew G. Knepley       }
49313e9753d6SMatthew G. Knepley     }
49323e9753d6SMatthew G. Knepley   }
49333e9753d6SMatthew G. Knepley   /* Loop over chunks */
49343e9753d6SMatthew G. Knepley   cellChunkSize = numCells;
49353e9753d6SMatthew G. Knepley   numChunks     = !numCells ? 0 : PetscCeilReal(((PetscReal) numCells)/cellChunkSize);
4936a4158a15SMatthew G. Knepley   PetscCall(PetscCalloc1(1*cellChunkSize, &faces));
4937a4158a15SMatthew G. Knepley   PetscCall(ISCreateGeneral(PETSC_COMM_SELF, 1*cellChunkSize, faces, PETSC_USE_POINTER, &chunkIS));
49383e9753d6SMatthew G. Knepley   /* Extract field coefficients */
49393e9753d6SMatthew G. Knepley   /* NOTE This needs the end cap faces to have identical orientations */
49409566063dSJacob Faibussowitsch   PetscCall(DMPlexGetCellFields(dm, cellIS, locX, locX_t, locA[2], &u, &u_t, &a[2]));
49419566063dSJacob Faibussowitsch   PetscCall(DMPlexGetHybridAuxFields(dm, dmAux, dsAux, cellIS, locA, a));
49429566063dSJacob Faibussowitsch   PetscCall(DMGetWorkArray(dm, cellChunkSize*totDim, MPIU_SCALAR, &elemVec));
49433e9753d6SMatthew G. Knepley   for (chunk = 0; chunk < numChunks; ++chunk) {
49443e9753d6SMatthew G. Knepley     PetscInt cS = cStart+chunk*cellChunkSize, cE = PetscMin(cS+cellChunkSize, cEnd), numCells = cE - cS, c;
49453e9753d6SMatthew G. Knepley 
49469566063dSJacob Faibussowitsch     PetscCall(PetscMemzero(elemVec, cellChunkSize*totDim * sizeof(PetscScalar)));
49473e9753d6SMatthew G. Knepley     /* Get faces */
49483e9753d6SMatthew G. Knepley     for (c = cS; c < cE; ++c) {
49493e9753d6SMatthew G. Knepley       const PetscInt  cell = cells ? cells[c] : c;
49503e9753d6SMatthew G. Knepley       const PetscInt *cone;
49519566063dSJacob Faibussowitsch       PetscCall(DMPlexGetCone(dm, cell, &cone));
4952a4158a15SMatthew G. Knepley       faces[0*cellChunkSize+(c-cS)] = cone[0];
4953a4158a15SMatthew G. Knepley       /*faces[1*cellChunkSize+(c-cS)] = cone[1];*/
49543e9753d6SMatthew G. Knepley     }
4955a4158a15SMatthew G. Knepley     PetscCall(ISGeneralSetIndices(chunkIS, 1*cellChunkSize, faces, PETSC_USE_POINTER));
49563e9753d6SMatthew G. Knepley     /* Get geometric data */
49573e9753d6SMatthew G. Knepley     if (maxDegree <= 1) {
49589566063dSJacob Faibussowitsch       if (!affineQuad) PetscCall(DMFieldCreateDefaultQuadrature(coordField, chunkIS, &affineQuad));
49599566063dSJacob Faibussowitsch       if (affineQuad)  PetscCall(DMSNESGetFEGeom(coordField, chunkIS, affineQuad, PETSC_TRUE, &affineGeom));
49603e9753d6SMatthew G. Knepley     } else {
49613e9753d6SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
49629566063dSJacob Faibussowitsch         if (quads[f]) PetscCall(DMSNESGetFEGeom(coordField, chunkIS, quads[f], PETSC_TRUE, &geoms[f]));
49633e9753d6SMatthew G. Knepley       }
49643e9753d6SMatthew G. Knepley     }
49653e9753d6SMatthew G. Knepley     /* Loop over fields */
49663e9753d6SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
49673e9753d6SMatthew G. Knepley       PetscFE         fe;
49683e9753d6SMatthew G. Knepley       PetscFEGeom    *geom = affineGeom ? affineGeom : geoms[f];
4969148442b3SMatthew G. Knepley       PetscFEGeom    *chunkGeom = NULL, *remGeom = NULL;
49703e9753d6SMatthew G. Knepley       PetscQuadrature quad = affineQuad ? affineQuad : quads[f];
49713e9753d6SMatthew G. Knepley       PetscInt        numChunks, numBatches, batchSize, numBlocks, blockSize, Ne, Nr, offset, Nq, Nb;
49725fedec97SMatthew G. Knepley       PetscBool       isCohesiveField;
49733e9753d6SMatthew G. Knepley 
49749566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(ds, f, (PetscObject *) &fe));
49753e9753d6SMatthew G. Knepley       if (!fe) continue;
49769566063dSJacob Faibussowitsch       PetscCall(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
49779566063dSJacob Faibussowitsch       PetscCall(PetscQuadratureGetData(quad, NULL, NULL, &Nq, NULL, NULL));
49789566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDimension(fe, &Nb));
49793e9753d6SMatthew G. Knepley       blockSize = Nb;
49803e9753d6SMatthew G. Knepley       batchSize = numBlocks * blockSize;
49819566063dSJacob Faibussowitsch       PetscCall(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
49823e9753d6SMatthew G. Knepley       numChunks = numCells / (numBatches*batchSize);
49833e9753d6SMatthew G. Knepley       Ne        = numChunks*numBatches*batchSize;
49843e9753d6SMatthew G. Knepley       Nr        = numCells % (numBatches*batchSize);
49853e9753d6SMatthew G. Knepley       offset    = numCells - Nr;
49869566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomGetChunk(geom,0,offset,&chunkGeom));
49879566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomGetChunk(geom,offset,numCells,&remGeom));
49889566063dSJacob Faibussowitsch       PetscCall(PetscDSGetCohesive(ds, f, &isCohesiveField));
49895fedec97SMatthew G. Knepley       chunkGeom->isCohesive = remGeom->isCohesive = PETSC_TRUE;
49906528b96dSMatthew G. Knepley       key[0].field = f;
49916528b96dSMatthew G. Knepley       key[1].field = f;
49925fedec97SMatthew G. Knepley       key[2].field = f;
49939566063dSJacob Faibussowitsch       PetscCall(PetscFEIntegrateHybridResidual(ds, key[0], 0, Ne, chunkGeom, u, u_t, dsAux[0], a[0], t, elemVec));
49949566063dSJacob Faibussowitsch       PetscCall(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]));
49959566063dSJacob Faibussowitsch       PetscCall(PetscFEIntegrateHybridResidual(ds, key[1], 1, Ne, chunkGeom, u, u_t, dsAux[1], a[1], t, elemVec));
49969566063dSJacob Faibussowitsch       PetscCall(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]));
49979566063dSJacob Faibussowitsch       PetscCall(PetscFEIntegrateHybridResidual(ds, key[2], 2, Ne, chunkGeom, u, u_t, dsAux[2], a[2], t, elemVec));
49989566063dSJacob Faibussowitsch       PetscCall(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]));
49999566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomRestoreChunk(geom,offset,numCells,&remGeom));
50009566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomRestoreChunk(geom,0,offset,&chunkGeom));
50013e9753d6SMatthew G. Knepley     }
50023e9753d6SMatthew G. Knepley     /* Add elemVec to locX */
50033e9753d6SMatthew G. Knepley     for (c = cS; c < cE; ++c) {
50043e9753d6SMatthew G. Knepley       const PetscInt cell = cells ? cells[c] : c;
50053e9753d6SMatthew G. Knepley       const PetscInt cind = c - cStart;
50063e9753d6SMatthew G. Knepley 
50079566063dSJacob Faibussowitsch       if (mesh->printFEM > 1) PetscCall(DMPrintCellVector(cell, name, totDim, &elemVec[cind*totDim]));
50083e9753d6SMatthew G. Knepley       if (ghostLabel) {
50093e9753d6SMatthew G. Knepley         PetscInt ghostVal;
50103e9753d6SMatthew G. Knepley 
50119566063dSJacob Faibussowitsch         PetscCall(DMLabelGetValue(ghostLabel,cell,&ghostVal));
50123e9753d6SMatthew G. Knepley         if (ghostVal > 0) continue;
50133e9753d6SMatthew G. Knepley       }
50149566063dSJacob Faibussowitsch       PetscCall(DMPlexVecSetClosure(dm, section, locF, cell, &elemVec[cind*totDim], ADD_ALL_VALUES));
50153e9753d6SMatthew G. Knepley     }
50163e9753d6SMatthew G. Knepley   }
50179566063dSJacob Faibussowitsch   PetscCall(DMPlexRestoreCellFields(dm, cellIS, locX, locX_t, locA[2], &u, &u_t, &a[2]));
50189566063dSJacob Faibussowitsch   PetscCall(DMPlexRestoreHybridAuxFields(dmAux, dsAux, cellIS, locA, a));
50199566063dSJacob Faibussowitsch   PetscCall(DMRestoreWorkArray(dm, numCells*totDim, MPIU_SCALAR, &elemVec));
50209566063dSJacob Faibussowitsch   PetscCall(PetscFree(faces));
50219566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&chunkIS));
50229566063dSJacob Faibussowitsch   PetscCall(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
50233e9753d6SMatthew G. Knepley   if (maxDegree <= 1) {
50249566063dSJacob Faibussowitsch     PetscCall(DMSNESRestoreFEGeom(coordField,cellIS,affineQuad,PETSC_FALSE,&affineGeom));
50259566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureDestroy(&affineQuad));
50263e9753d6SMatthew G. Knepley   } else {
50273e9753d6SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
50289566063dSJacob Faibussowitsch       if (geoms) PetscCall(DMSNESRestoreFEGeom(coordField,cellIS,quads[f],PETSC_FALSE,&geoms[f]));
50299566063dSJacob Faibussowitsch       if (quads) PetscCall(PetscQuadratureDestroy(&quads[f]));
50303e9753d6SMatthew G. Knepley     }
50319566063dSJacob Faibussowitsch     PetscCall(PetscFree2(quads,geoms));
50323e9753d6SMatthew G. Knepley   }
50339566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_ResidualFEM,dm,0,0,0));
50343e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
50353e9753d6SMatthew G. Knepley }
50363e9753d6SMatthew G. Knepley 
503745480ffeSMatthew 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)
50383e9753d6SMatthew G. Knepley {
50393e9753d6SMatthew G. Knepley   DM_Plex        *mesh = (DM_Plex *) dm->data;
50403e9753d6SMatthew G. Knepley   DM              plex = NULL, plexA = NULL, tdm;
50413e9753d6SMatthew G. Knepley   DMEnclosureType encAux;
50423e9753d6SMatthew G. Knepley   PetscDS         prob, probAux = NULL;
50433e9753d6SMatthew G. Knepley   PetscSection    section, sectionAux = NULL;
5044e432b41dSStefano Zampini   PetscSection    globalSection;
50453e9753d6SMatthew G. Knepley   Vec             locA = NULL, tv;
50463e9753d6SMatthew G. Knepley   PetscScalar    *u = NULL, *u_t = NULL, *a = NULL, *elemMat = NULL;
50473e9753d6SMatthew G. Knepley   PetscInt        v;
50483e9753d6SMatthew G. Knepley   PetscInt        Nf, totDim, totDimAux = 0;
5049e432b41dSStefano Zampini   PetscBool       transform;
50503e9753d6SMatthew G. Knepley 
50513e9753d6SMatthew G. Knepley   PetscFunctionBegin;
50529566063dSJacob Faibussowitsch   PetscCall(DMConvert(dm, DMPLEX, &plex));
50539566063dSJacob Faibussowitsch   PetscCall(DMHasBasisTransform(dm, &transform));
50549566063dSJacob Faibussowitsch   PetscCall(DMGetBasisTransformDM_Internal(dm, &tdm));
50559566063dSJacob Faibussowitsch   PetscCall(DMGetBasisTransformVec_Internal(dm, &tv));
50569566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
50579566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dm, &prob));
50589566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumFields(prob, &Nf));
50599566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(prob, &totDim));
50609566063dSJacob Faibussowitsch   PetscCall(DMGetAuxiliaryVec(dm, label, values[0], 0, &locA));
50613e9753d6SMatthew G. Knepley   if (locA) {
50623e9753d6SMatthew G. Knepley     DM dmAux;
50633e9753d6SMatthew G. Knepley 
50649566063dSJacob Faibussowitsch     PetscCall(VecGetDM(locA, &dmAux));
50659566063dSJacob Faibussowitsch     PetscCall(DMGetEnclosureRelation(dmAux, dm, &encAux));
50669566063dSJacob Faibussowitsch     PetscCall(DMConvert(dmAux, DMPLEX, &plexA));
50679566063dSJacob Faibussowitsch     PetscCall(DMGetDS(plexA, &probAux));
50689566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalDimension(probAux, &totDimAux));
50699566063dSJacob Faibussowitsch     PetscCall(DMGetLocalSection(plexA, &sectionAux));
50703e9753d6SMatthew G. Knepley   }
50713e9753d6SMatthew G. Knepley 
50729566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dm, &globalSection));
50733e9753d6SMatthew G. Knepley   for (v = 0; v < numValues; ++v) {
50743e9753d6SMatthew G. Knepley     PetscFEGeom     *fgeom;
50753e9753d6SMatthew G. Knepley     PetscInt         maxDegree;
50763e9753d6SMatthew G. Knepley     PetscQuadrature  qGeom = NULL;
50773e9753d6SMatthew G. Knepley     IS               pointIS;
50783e9753d6SMatthew G. Knepley     const PetscInt  *points;
507906ad1575SMatthew G. Knepley     PetscFormKey key;
50803e9753d6SMatthew G. Knepley     PetscInt         numFaces, face, Nq;
50813e9753d6SMatthew G. Knepley 
508245480ffeSMatthew G. Knepley     key.label = label;
508345480ffeSMatthew G. Knepley     key.value = values[v];
508406ad1575SMatthew G. Knepley     key.part  = 0;
50859566063dSJacob Faibussowitsch     PetscCall(DMLabelGetStratumIS(label, values[v], &pointIS));
50863e9753d6SMatthew G. Knepley     if (!pointIS) continue; /* No points with that id on this process */
50873e9753d6SMatthew G. Knepley     {
50883e9753d6SMatthew G. Knepley       IS isectIS;
50893e9753d6SMatthew G. Knepley 
50903e9753d6SMatthew G. Knepley       /* TODO: Special cases of ISIntersect where it is quick to check a prior if one is a superset of the other */
50919566063dSJacob Faibussowitsch       PetscCall(ISIntersect_Caching_Internal(facetIS,pointIS,&isectIS));
50929566063dSJacob Faibussowitsch       PetscCall(ISDestroy(&pointIS));
50933e9753d6SMatthew G. Knepley       pointIS = isectIS;
50943e9753d6SMatthew G. Knepley     }
50959566063dSJacob Faibussowitsch     PetscCall(ISGetLocalSize(pointIS, &numFaces));
50969566063dSJacob Faibussowitsch     PetscCall(ISGetIndices(pointIS, &points));
50979566063dSJacob Faibussowitsch     PetscCall(PetscMalloc4(numFaces*totDim, &u, locX_t ? numFaces*totDim : 0, &u_t, numFaces*totDim*totDim, &elemMat, locA ? numFaces*totDimAux : 0, &a));
50989566063dSJacob Faibussowitsch     PetscCall(DMFieldGetDegree(coordField,pointIS,NULL,&maxDegree));
50993e9753d6SMatthew G. Knepley     if (maxDegree <= 1) {
51009566063dSJacob Faibussowitsch       PetscCall(DMFieldCreateDefaultQuadrature(coordField,pointIS,&qGeom));
51013e9753d6SMatthew G. Knepley     }
51023e9753d6SMatthew G. Knepley     if (!qGeom) {
51033e9753d6SMatthew G. Knepley       PetscFE fe;
51043e9753d6SMatthew G. Knepley 
51059566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(prob, fieldI, (PetscObject *) &fe));
51069566063dSJacob Faibussowitsch       PetscCall(PetscFEGetFaceQuadrature(fe, &qGeom));
51079566063dSJacob Faibussowitsch       PetscCall(PetscObjectReference((PetscObject)qGeom));
51083e9753d6SMatthew G. Knepley     }
51099566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureGetData(qGeom, NULL, NULL, &Nq, NULL, NULL));
51109566063dSJacob Faibussowitsch     PetscCall(DMSNESGetFEGeom(coordField,pointIS,qGeom,PETSC_TRUE,&fgeom));
51113e9753d6SMatthew G. Knepley     for (face = 0; face < numFaces; ++face) {
5112f15274beSMatthew Knepley       const PetscInt point = points[face], *support;
51133e9753d6SMatthew G. Knepley       PetscScalar   *x     = NULL;
5114f15274beSMatthew Knepley       PetscInt       i;
51153e9753d6SMatthew G. Knepley 
51169566063dSJacob Faibussowitsch       PetscCall(DMPlexGetSupport(dm, point, &support));
51179566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(plex, section, locX, support[0], NULL, &x));
51183e9753d6SMatthew G. Knepley       for (i = 0; i < totDim; ++i) u[face*totDim+i] = x[i];
51199566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(plex, section, locX, support[0], NULL, &x));
51203e9753d6SMatthew G. Knepley       if (locX_t) {
51219566063dSJacob Faibussowitsch         PetscCall(DMPlexVecGetClosure(plex, section, locX_t, support[0], NULL, &x));
51223e9753d6SMatthew G. Knepley         for (i = 0; i < totDim; ++i) u_t[face*totDim+i] = x[i];
51239566063dSJacob Faibussowitsch         PetscCall(DMPlexVecRestoreClosure(plex, section, locX_t, support[0], NULL, &x));
51243e9753d6SMatthew G. Knepley       }
51253e9753d6SMatthew G. Knepley       if (locA) {
51263e9753d6SMatthew G. Knepley         PetscInt subp;
51279566063dSJacob Faibussowitsch         PetscCall(DMGetEnclosurePoint(plexA, dm, encAux, support[0], &subp));
51289566063dSJacob Faibussowitsch         PetscCall(DMPlexVecGetClosure(plexA, sectionAux, locA, subp, NULL, &x));
51293e9753d6SMatthew G. Knepley         for (i = 0; i < totDimAux; ++i) a[face*totDimAux+i] = x[i];
51309566063dSJacob Faibussowitsch         PetscCall(DMPlexVecRestoreClosure(plexA, sectionAux, locA, subp, NULL, &x));
51313e9753d6SMatthew G. Knepley       }
51323e9753d6SMatthew G. Knepley     }
51339566063dSJacob Faibussowitsch     PetscCall(PetscArrayzero(elemMat, numFaces*totDim*totDim));
51343e9753d6SMatthew G. Knepley     {
51353e9753d6SMatthew G. Knepley       PetscFE         fe;
51363e9753d6SMatthew G. Knepley       PetscInt        Nb;
51373e9753d6SMatthew G. Knepley       /* Conforming batches */
51383e9753d6SMatthew G. Knepley       PetscInt        numChunks, numBatches, numBlocks, Ne, blockSize, batchSize;
51393e9753d6SMatthew G. Knepley       /* Remainder */
51403e9753d6SMatthew G. Knepley       PetscFEGeom    *chunkGeom = NULL;
51413e9753d6SMatthew G. Knepley       PetscInt        fieldJ, Nr, offset;
51423e9753d6SMatthew G. Knepley 
51439566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(prob, fieldI, (PetscObject *) &fe));
51449566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDimension(fe, &Nb));
51459566063dSJacob Faibussowitsch       PetscCall(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
51463e9753d6SMatthew G. Knepley       blockSize = Nb;
51473e9753d6SMatthew G. Knepley       batchSize = numBlocks * blockSize;
51489566063dSJacob Faibussowitsch       PetscCall(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
51493e9753d6SMatthew G. Knepley       numChunks = numFaces / (numBatches*batchSize);
51503e9753d6SMatthew G. Knepley       Ne        = numChunks*numBatches*batchSize;
51513e9753d6SMatthew G. Knepley       Nr        = numFaces % (numBatches*batchSize);
51523e9753d6SMatthew G. Knepley       offset    = numFaces - Nr;
51539566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomGetChunk(fgeom,0,offset,&chunkGeom));
51543e9753d6SMatthew G. Knepley       for (fieldJ = 0; fieldJ < Nf; ++fieldJ) {
515545480ffeSMatthew G. Knepley         key.field = fieldI*Nf+fieldJ;
51569566063dSJacob Faibussowitsch         PetscCall(PetscFEIntegrateBdJacobian(prob, wf, key, Ne, chunkGeom, u, u_t, probAux, a, t, X_tShift, elemMat));
51573e9753d6SMatthew G. Knepley       }
51589566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomGetChunk(fgeom,offset,numFaces,&chunkGeom));
51593e9753d6SMatthew G. Knepley       for (fieldJ = 0; fieldJ < Nf; ++fieldJ) {
516045480ffeSMatthew G. Knepley         key.field = fieldI*Nf+fieldJ;
51619566063dSJacob Faibussowitsch         PetscCall(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]));
51623e9753d6SMatthew G. Knepley       }
51639566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomRestoreChunk(fgeom,offset,numFaces,&chunkGeom));
51643e9753d6SMatthew G. Knepley     }
51653e9753d6SMatthew G. Knepley     for (face = 0; face < numFaces; ++face) {
51663e9753d6SMatthew G. Knepley       const PetscInt point = points[face], *support;
51673e9753d6SMatthew G. Knepley 
51683e9753d6SMatthew G. Knepley       /* Transform to global basis before insertion in Jacobian */
51699566063dSJacob Faibussowitsch       PetscCall(DMPlexGetSupport(plex, point, &support));
51709566063dSJacob Faibussowitsch       if (transform) PetscCall(DMPlexBasisTransformPointTensor_Internal(dm, tdm, tv, support[0], PETSC_TRUE, totDim, &elemMat[face*totDim*totDim]));
51719566063dSJacob Faibussowitsch       if (mesh->printFEM > 1) PetscCall(DMPrintCellMatrix(point, "BdJacobian", totDim, totDim, &elemMat[face*totDim*totDim]));
51729566063dSJacob Faibussowitsch       PetscCall(DMPlexMatSetClosure(plex, section, globalSection, JacP, support[0], &elemMat[face*totDim*totDim], ADD_VALUES));
51733e9753d6SMatthew G. Knepley     }
51749566063dSJacob Faibussowitsch     PetscCall(DMSNESRestoreFEGeom(coordField,pointIS,qGeom,PETSC_TRUE,&fgeom));
51759566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureDestroy(&qGeom));
51769566063dSJacob Faibussowitsch     PetscCall(ISRestoreIndices(pointIS, &points));
51779566063dSJacob Faibussowitsch     PetscCall(ISDestroy(&pointIS));
51789566063dSJacob Faibussowitsch     PetscCall(PetscFree4(u, u_t, elemMat, a));
51793e9753d6SMatthew G. Knepley   }
51809566063dSJacob Faibussowitsch   if (plex)  PetscCall(DMDestroy(&plex));
51819566063dSJacob Faibussowitsch   if (plexA) PetscCall(DMDestroy(&plexA));
51823e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
51833e9753d6SMatthew G. Knepley }
51843e9753d6SMatthew G. Knepley 
518545480ffeSMatthew 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)
51863e9753d6SMatthew G. Knepley {
51873e9753d6SMatthew G. Knepley   DMField        coordField;
51883e9753d6SMatthew G. Knepley   DMLabel        depthLabel;
51893e9753d6SMatthew G. Knepley   IS             facetIS;
51903e9753d6SMatthew G. Knepley   PetscInt       dim;
51913e9753d6SMatthew G. Knepley 
51923e9753d6SMatthew G. Knepley   PetscFunctionBegin;
51939566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
51949566063dSJacob Faibussowitsch   PetscCall(DMPlexGetDepthLabel(dm, &depthLabel));
51959566063dSJacob Faibussowitsch   PetscCall(DMLabelGetStratumIS(depthLabel, dim-1, &facetIS));
51969566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateField(dm, &coordField));
51979566063dSJacob Faibussowitsch   PetscCall(DMPlexComputeBdJacobian_Single_Internal(dm, t, wf, label, numValues, values, field, locX, locX_t, X_tShift, Jac, JacP, coordField, facetIS));
51989566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&facetIS));
51993e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
52003e9753d6SMatthew G. Knepley }
52013e9753d6SMatthew G. Knepley 
52023e9753d6SMatthew G. Knepley PetscErrorCode DMPlexComputeBdJacobian_Internal(DM dm, Vec locX, Vec locX_t, PetscReal t, PetscReal X_tShift, Mat Jac, Mat JacP, void *user)
52033e9753d6SMatthew G. Knepley {
52043e9753d6SMatthew G. Knepley   PetscDS          prob;
52053e9753d6SMatthew G. Knepley   PetscInt         dim, numBd, bd;
52063e9753d6SMatthew G. Knepley   DMLabel          depthLabel;
52073e9753d6SMatthew G. Knepley   DMField          coordField = NULL;
52083e9753d6SMatthew G. Knepley   IS               facetIS;
52093e9753d6SMatthew G. Knepley 
52103e9753d6SMatthew G. Knepley   PetscFunctionBegin;
52119566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dm, &prob));
52129566063dSJacob Faibussowitsch   PetscCall(DMPlexGetDepthLabel(dm, &depthLabel));
52139566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
52149566063dSJacob Faibussowitsch   PetscCall(DMLabelGetStratumIS(depthLabel, dim-1, &facetIS));
52159566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumBoundary(prob, &numBd));
52169566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateField(dm, &coordField));
52173e9753d6SMatthew G. Knepley   for (bd = 0; bd < numBd; ++bd) {
521845480ffeSMatthew G. Knepley     PetscWeakForm           wf;
52193e9753d6SMatthew G. Knepley     DMBoundaryConditionType type;
52203e9753d6SMatthew G. Knepley     DMLabel                 label;
52213e9753d6SMatthew G. Knepley     const PetscInt         *values;
52223e9753d6SMatthew G. Knepley     PetscInt                fieldI, numValues;
52233e9753d6SMatthew G. Knepley     PetscObject             obj;
52243e9753d6SMatthew G. Knepley     PetscClassId            id;
52253e9753d6SMatthew G. Knepley 
52269566063dSJacob Faibussowitsch     PetscCall(PetscDSGetBoundary(prob, bd, &wf, &type, NULL, &label, &numValues, &values, &fieldI, NULL, NULL, NULL, NULL, NULL));
52279566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, fieldI, &obj));
52289566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
52293e9753d6SMatthew G. Knepley     if ((id != PETSCFE_CLASSID) || (type & DM_BC_ESSENTIAL)) continue;
52309566063dSJacob Faibussowitsch     PetscCall(DMPlexComputeBdJacobian_Single_Internal(dm, t, wf, label, numValues, values, fieldI, locX, locX_t, X_tShift, Jac, JacP, coordField, facetIS));
52313e9753d6SMatthew G. Knepley   }
52329566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&facetIS));
52333e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
52343e9753d6SMatthew G. Knepley }
52353e9753d6SMatthew G. Knepley 
523606ad1575SMatthew 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)
52373e9753d6SMatthew G. Knepley {
52383e9753d6SMatthew G. Knepley   DM_Plex        *mesh  = (DM_Plex *) dm->data;
52393e9753d6SMatthew G. Knepley   const char     *name  = "Jacobian";
52409a2a23afSMatthew G. Knepley   DM              dmAux = NULL, plex, tdm;
52413e9753d6SMatthew G. Knepley   DMEnclosureType encAux;
52423e9753d6SMatthew G. Knepley   Vec             A, tv;
52433e9753d6SMatthew G. Knepley   DMField         coordField;
52443e9753d6SMatthew G. Knepley   PetscDS         prob, probAux = NULL;
5245e432b41dSStefano Zampini   PetscSection    section, globalSection, sectionAux;
52463e9753d6SMatthew G. Knepley   PetscScalar    *elemMat, *elemMatP, *elemMatD, *u, *u_t, *a = NULL;
52473e9753d6SMatthew G. Knepley   const PetscInt *cells;
52483e9753d6SMatthew G. Knepley   PetscInt        Nf, fieldI, fieldJ;
524928351e22SJed Brown   PetscInt        totDim, totDimAux = 0, cStart, cEnd, numCells, c;
5250e04ae0b4SMatthew G. Knepley   PetscBool       hasJac = PETSC_FALSE, hasPrec = PETSC_FALSE, hasDyn, hasFV = PETSC_FALSE, transform;
52513e9753d6SMatthew G. Knepley 
52523e9753d6SMatthew G. Knepley   PetscFunctionBegin;
5253e04ae0b4SMatthew G. Knepley   if (!cellIS) goto end;
52549566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_JacobianFEM,dm,0,0,0));
52559566063dSJacob Faibussowitsch   PetscCall(ISGetLocalSize(cellIS, &numCells));
52569566063dSJacob Faibussowitsch   PetscCall(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
52579566063dSJacob Faibussowitsch   PetscCall(DMHasBasisTransform(dm, &transform));
52589566063dSJacob Faibussowitsch   PetscCall(DMGetBasisTransformDM_Internal(dm, &tdm));
52599566063dSJacob Faibussowitsch   PetscCall(DMGetBasisTransformVec_Internal(dm, &tv));
52609566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
52619566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dm, &globalSection));
52629566063dSJacob Faibussowitsch   PetscCall(DMGetCellDS(dm, cells ? cells[cStart] : cStart, &prob));
52639566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumFields(prob, &Nf));
52649566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(prob, &totDim));
52659566063dSJacob Faibussowitsch   PetscCall(PetscDSHasJacobian(prob, &hasJac));
52669566063dSJacob Faibussowitsch   PetscCall(PetscDSHasJacobianPreconditioner(prob, &hasPrec));
52673e9753d6SMatthew G. Knepley   /* user passed in the same matrix, avoid double contributions and
52683e9753d6SMatthew G. Knepley      only assemble the Jacobian */
52693e9753d6SMatthew G. Knepley   if (hasJac && Jac == JacP) hasPrec = PETSC_FALSE;
52709566063dSJacob Faibussowitsch   PetscCall(PetscDSHasDynamicJacobian(prob, &hasDyn));
52713e9753d6SMatthew G. Knepley   hasDyn = hasDyn && (X_tShift != 0.0) ? PETSC_TRUE : PETSC_FALSE;
52729566063dSJacob Faibussowitsch   PetscCall(DMGetAuxiliaryVec(dm, key.label, key.value, key.part, &A));
52739a2a23afSMatthew G. Knepley   if (A) {
52749566063dSJacob Faibussowitsch     PetscCall(VecGetDM(A, &dmAux));
52759566063dSJacob Faibussowitsch     PetscCall(DMGetEnclosureRelation(dmAux, dm, &encAux));
52769566063dSJacob Faibussowitsch     PetscCall(DMConvert(dmAux, DMPLEX, &plex));
52779566063dSJacob Faibussowitsch     PetscCall(DMGetLocalSection(plex, &sectionAux));
52789566063dSJacob Faibussowitsch     PetscCall(DMGetDS(dmAux, &probAux));
52799566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalDimension(probAux, &totDimAux));
52803e9753d6SMatthew G. Knepley   }
52819566063dSJacob Faibussowitsch   PetscCall(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));
52829566063dSJacob Faibussowitsch   if (dmAux) PetscCall(PetscMalloc1(numCells*totDimAux, &a));
52839566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateField(dm, &coordField));
52843e9753d6SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
52853e9753d6SMatthew G. Knepley     const PetscInt cell = cells ? cells[c] : c;
52863e9753d6SMatthew G. Knepley     const PetscInt cind = c - cStart;
52873e9753d6SMatthew G. Knepley     PetscScalar   *x = NULL,  *x_t = NULL;
52883e9753d6SMatthew G. Knepley     PetscInt       i;
52893e9753d6SMatthew G. Knepley 
52909566063dSJacob Faibussowitsch     PetscCall(DMPlexVecGetClosure(dm, section, X, cell, NULL, &x));
52913e9753d6SMatthew G. Knepley     for (i = 0; i < totDim; ++i) u[cind*totDim+i] = x[i];
52929566063dSJacob Faibussowitsch     PetscCall(DMPlexVecRestoreClosure(dm, section, X, cell, NULL, &x));
52933e9753d6SMatthew G. Knepley     if (X_t) {
52949566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(dm, section, X_t, cell, NULL, &x_t));
52953e9753d6SMatthew G. Knepley       for (i = 0; i < totDim; ++i) u_t[cind*totDim+i] = x_t[i];
52969566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(dm, section, X_t, cell, NULL, &x_t));
52973e9753d6SMatthew G. Knepley     }
52983e9753d6SMatthew G. Knepley     if (dmAux) {
52993e9753d6SMatthew G. Knepley       PetscInt subcell;
53009566063dSJacob Faibussowitsch       PetscCall(DMGetEnclosurePoint(dmAux, dm, encAux, cell, &subcell));
53019566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(plex, sectionAux, A, subcell, NULL, &x));
53023e9753d6SMatthew G. Knepley       for (i = 0; i < totDimAux; ++i) a[cind*totDimAux+i] = x[i];
53039566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(plex, sectionAux, A, subcell, NULL, &x));
53043e9753d6SMatthew G. Knepley     }
53053e9753d6SMatthew G. Knepley   }
53069566063dSJacob Faibussowitsch   if (hasJac)  PetscCall(PetscArrayzero(elemMat,  numCells*totDim*totDim));
53079566063dSJacob Faibussowitsch   if (hasPrec) PetscCall(PetscArrayzero(elemMatP, numCells*totDim*totDim));
53089566063dSJacob Faibussowitsch   if (hasDyn)  PetscCall(PetscArrayzero(elemMatD, numCells*totDim*totDim));
53093e9753d6SMatthew G. Knepley   for (fieldI = 0; fieldI < Nf; ++fieldI) {
53103e9753d6SMatthew G. Knepley     PetscClassId    id;
53113e9753d6SMatthew G. Knepley     PetscFE         fe;
53123e9753d6SMatthew G. Knepley     PetscQuadrature qGeom = NULL;
53133e9753d6SMatthew G. Knepley     PetscInt        Nb;
53143e9753d6SMatthew G. Knepley     /* Conforming batches */
53153e9753d6SMatthew G. Knepley     PetscInt        numChunks, numBatches, numBlocks, Ne, blockSize, batchSize;
53163e9753d6SMatthew G. Knepley     /* Remainder */
53173e9753d6SMatthew G. Knepley     PetscInt        Nr, offset, Nq;
53183e9753d6SMatthew G. Knepley     PetscInt        maxDegree;
53193e9753d6SMatthew G. Knepley     PetscFEGeom     *cgeomFEM, *chunkGeom = NULL, *remGeom = NULL;
53203e9753d6SMatthew G. Knepley 
53219566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, fieldI, (PetscObject *) &fe));
53229566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId((PetscObject) fe, &id));
53233e9753d6SMatthew G. Knepley     if (id == PETSCFV_CLASSID) {hasFV = PETSC_TRUE; continue;}
53249566063dSJacob Faibussowitsch     PetscCall(PetscFEGetDimension(fe, &Nb));
53259566063dSJacob Faibussowitsch     PetscCall(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
53269566063dSJacob Faibussowitsch     PetscCall(DMFieldGetDegree(coordField,cellIS,NULL,&maxDegree));
53273e9753d6SMatthew G. Knepley     if (maxDegree <= 1) {
53289566063dSJacob Faibussowitsch       PetscCall(DMFieldCreateDefaultQuadrature(coordField,cellIS,&qGeom));
53293e9753d6SMatthew G. Knepley     }
53303e9753d6SMatthew G. Knepley     if (!qGeom) {
53319566063dSJacob Faibussowitsch       PetscCall(PetscFEGetQuadrature(fe,&qGeom));
53329566063dSJacob Faibussowitsch       PetscCall(PetscObjectReference((PetscObject)qGeom));
53333e9753d6SMatthew G. Knepley     }
53349566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureGetData(qGeom, NULL, NULL, &Nq, NULL, NULL));
53359566063dSJacob Faibussowitsch     PetscCall(DMSNESGetFEGeom(coordField,cellIS,qGeom,PETSC_FALSE,&cgeomFEM));
53363e9753d6SMatthew G. Knepley     blockSize = Nb;
53373e9753d6SMatthew G. Knepley     batchSize = numBlocks * blockSize;
53389566063dSJacob Faibussowitsch     PetscCall(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
53393e9753d6SMatthew G. Knepley     numChunks = numCells / (numBatches*batchSize);
53403e9753d6SMatthew G. Knepley     Ne        = numChunks*numBatches*batchSize;
53413e9753d6SMatthew G. Knepley     Nr        = numCells % (numBatches*batchSize);
53423e9753d6SMatthew G. Knepley     offset    = numCells - Nr;
53439566063dSJacob Faibussowitsch     PetscCall(PetscFEGeomGetChunk(cgeomFEM,0,offset,&chunkGeom));
53449566063dSJacob Faibussowitsch     PetscCall(PetscFEGeomGetChunk(cgeomFEM,offset,numCells,&remGeom));
53453e9753d6SMatthew G. Knepley     for (fieldJ = 0; fieldJ < Nf; ++fieldJ) {
53466528b96dSMatthew G. Knepley       key.field = fieldI*Nf+fieldJ;
53473e9753d6SMatthew G. Knepley       if (hasJac) {
53489566063dSJacob Faibussowitsch         PetscCall(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN, key, Ne, chunkGeom, u, u_t, probAux, a, t, X_tShift, elemMat));
53499566063dSJacob Faibussowitsch         PetscCall(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]));
53503e9753d6SMatthew G. Knepley       }
53513e9753d6SMatthew G. Knepley       if (hasPrec) {
53529566063dSJacob Faibussowitsch         PetscCall(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN_PRE, key, Ne, chunkGeom, u, u_t, probAux, a, t, X_tShift, elemMatP));
53539566063dSJacob Faibussowitsch         PetscCall(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]));
53543e9753d6SMatthew G. Knepley       }
53553e9753d6SMatthew G. Knepley       if (hasDyn) {
53569566063dSJacob Faibussowitsch         PetscCall(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN_DYN, key, Ne, chunkGeom, u, u_t, probAux, a, t, X_tShift, elemMatD));
53579566063dSJacob Faibussowitsch         PetscCall(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]));
53583e9753d6SMatthew G. Knepley       }
53593e9753d6SMatthew G. Knepley     }
53609566063dSJacob Faibussowitsch     PetscCall(PetscFEGeomRestoreChunk(cgeomFEM,offset,numCells,&remGeom));
53619566063dSJacob Faibussowitsch     PetscCall(PetscFEGeomRestoreChunk(cgeomFEM,0,offset,&chunkGeom));
53629566063dSJacob Faibussowitsch     PetscCall(DMSNESRestoreFEGeom(coordField,cellIS,qGeom,PETSC_FALSE,&cgeomFEM));
53639566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureDestroy(&qGeom));
53643e9753d6SMatthew G. Knepley   }
53653e9753d6SMatthew G. Knepley   /*   Add contribution from X_t */
53663e9753d6SMatthew G. Knepley   if (hasDyn) {for (c = 0; c < numCells*totDim*totDim; ++c) elemMat[c] += X_tShift*elemMatD[c];}
53673e9753d6SMatthew G. Knepley   if (hasFV) {
53683e9753d6SMatthew G. Knepley     PetscClassId id;
53693e9753d6SMatthew G. Knepley     PetscFV      fv;
53703e9753d6SMatthew G. Knepley     PetscInt     offsetI, NcI, NbI = 1, fc, f;
53713e9753d6SMatthew G. Knepley 
53723e9753d6SMatthew G. Knepley     for (fieldI = 0; fieldI < Nf; ++fieldI) {
53739566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(prob, fieldI, (PetscObject *) &fv));
53749566063dSJacob Faibussowitsch       PetscCall(PetscDSGetFieldOffset(prob, fieldI, &offsetI));
53759566063dSJacob Faibussowitsch       PetscCall(PetscObjectGetClassId((PetscObject) fv, &id));
53763e9753d6SMatthew G. Knepley       if (id != PETSCFV_CLASSID) continue;
53773e9753d6SMatthew G. Knepley       /* Put in the identity */
53789566063dSJacob Faibussowitsch       PetscCall(PetscFVGetNumComponents(fv, &NcI));
53793e9753d6SMatthew G. Knepley       for (c = cStart; c < cEnd; ++c) {
53803e9753d6SMatthew G. Knepley         const PetscInt cind    = c - cStart;
53813e9753d6SMatthew G. Knepley         const PetscInt eOffset = cind*totDim*totDim;
53823e9753d6SMatthew G. Knepley         for (fc = 0; fc < NcI; ++fc) {
53833e9753d6SMatthew G. Knepley           for (f = 0; f < NbI; ++f) {
53843e9753d6SMatthew G. Knepley             const PetscInt i = offsetI + f*NcI+fc;
53853e9753d6SMatthew G. Knepley             if (hasPrec) {
53863e9753d6SMatthew G. Knepley               if (hasJac) {elemMat[eOffset+i*totDim+i] = 1.0;}
53873e9753d6SMatthew G. Knepley               elemMatP[eOffset+i*totDim+i] = 1.0;
53883e9753d6SMatthew G. Knepley             } else {elemMat[eOffset+i*totDim+i] = 1.0;}
53893e9753d6SMatthew G. Knepley           }
53903e9753d6SMatthew G. Knepley         }
53913e9753d6SMatthew G. Knepley       }
53923e9753d6SMatthew G. Knepley     }
53933e9753d6SMatthew G. Knepley     /* No allocated space for FV stuff, so ignore the zero entries */
53949566063dSJacob Faibussowitsch     PetscCall(MatSetOption(JacP, MAT_IGNORE_ZERO_ENTRIES, PETSC_TRUE));
53953e9753d6SMatthew G. Knepley   }
53963e9753d6SMatthew G. Knepley   /* Insert values into matrix */
53973e9753d6SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
53983e9753d6SMatthew G. Knepley     const PetscInt cell = cells ? cells[c] : c;
53993e9753d6SMatthew G. Knepley     const PetscInt cind = c - cStart;
54003e9753d6SMatthew G. Knepley 
54013e9753d6SMatthew G. Knepley     /* Transform to global basis before insertion in Jacobian */
54029566063dSJacob Faibussowitsch     if (transform) PetscCall(DMPlexBasisTransformPointTensor_Internal(dm, tdm, tv, cell, PETSC_TRUE, totDim, &elemMat[cind*totDim*totDim]));
54033e9753d6SMatthew G. Knepley     if (hasPrec) {
54043e9753d6SMatthew G. Knepley       if (hasJac) {
54059566063dSJacob Faibussowitsch         if (mesh->printFEM > 1) PetscCall(DMPrintCellMatrix(cell, name, totDim, totDim, &elemMat[cind*totDim*totDim]));
54069566063dSJacob Faibussowitsch         PetscCall(DMPlexMatSetClosure(dm, section, globalSection, Jac, cell, &elemMat[cind*totDim*totDim], ADD_VALUES));
54073e9753d6SMatthew G. Knepley       }
54089566063dSJacob Faibussowitsch       if (mesh->printFEM > 1) PetscCall(DMPrintCellMatrix(cell, name, totDim, totDim, &elemMatP[cind*totDim*totDim]));
54099566063dSJacob Faibussowitsch       PetscCall(DMPlexMatSetClosure(dm, section, globalSection, JacP, cell, &elemMatP[cind*totDim*totDim], ADD_VALUES));
54103e9753d6SMatthew G. Knepley     } else {
54113e9753d6SMatthew G. Knepley       if (hasJac) {
54129566063dSJacob Faibussowitsch         if (mesh->printFEM > 1) PetscCall(DMPrintCellMatrix(cell, name, totDim, totDim, &elemMat[cind*totDim*totDim]));
54139566063dSJacob Faibussowitsch         PetscCall(DMPlexMatSetClosure(dm, section, globalSection, JacP, cell, &elemMat[cind*totDim*totDim], ADD_VALUES));
54143e9753d6SMatthew G. Knepley       }
54153e9753d6SMatthew G. Knepley     }
54163e9753d6SMatthew G. Knepley   }
54179566063dSJacob Faibussowitsch   PetscCall(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
54189566063dSJacob Faibussowitsch   if (hasFV) PetscCall(MatSetOption(JacP, MAT_IGNORE_ZERO_ENTRIES, PETSC_FALSE));
54199566063dSJacob Faibussowitsch   PetscCall(PetscFree5(u,u_t,elemMat,elemMatP,elemMatD));
54203e9753d6SMatthew G. Knepley   if (dmAux) {
54219566063dSJacob Faibussowitsch     PetscCall(PetscFree(a));
54229566063dSJacob Faibussowitsch     PetscCall(DMDestroy(&plex));
54233e9753d6SMatthew G. Knepley   }
54243e9753d6SMatthew G. Knepley   /* Compute boundary integrals */
54259566063dSJacob Faibussowitsch   PetscCall(DMPlexComputeBdJacobian_Internal(dm, X, X_t, t, X_tShift, Jac, JacP, user));
54263e9753d6SMatthew G. Knepley   /* Assemble matrix */
5427e04ae0b4SMatthew G. Knepley end:
5428e04ae0b4SMatthew G. Knepley   {
5429e04ae0b4SMatthew G. Knepley     PetscBool assOp = hasJac && hasPrec ? PETSC_TRUE : PETSC_FALSE, gassOp;
5430e04ae0b4SMatthew G. Knepley 
5431e04ae0b4SMatthew G. Knepley     PetscCallMPI(MPI_Allreduce(&assOp, &gassOp, 1, MPIU_BOOL, MPI_LOR, PetscObjectComm((PetscObject) dm)));
54323e9753d6SMatthew G. Knepley     if (hasJac && hasPrec) {
54339566063dSJacob Faibussowitsch       PetscCall(MatAssemblyBegin(Jac, MAT_FINAL_ASSEMBLY));
54349566063dSJacob Faibussowitsch       PetscCall(MatAssemblyEnd(Jac, MAT_FINAL_ASSEMBLY));
54353e9753d6SMatthew G. Knepley     }
5436e04ae0b4SMatthew G. Knepley   }
54379566063dSJacob Faibussowitsch   PetscCall(MatAssemblyBegin(JacP, MAT_FINAL_ASSEMBLY));
54389566063dSJacob Faibussowitsch   PetscCall(MatAssemblyEnd(JacP, MAT_FINAL_ASSEMBLY));
54399566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_JacobianFEM,dm,0,0,0));
54403e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
54413e9753d6SMatthew G. Knepley }
54423e9753d6SMatthew G. Knepley 
544306ad1575SMatthew 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)
54443e9753d6SMatthew G. Knepley {
54453e9753d6SMatthew G. Knepley   DM_Plex         *mesh          = (DM_Plex *) dm->data;
54463e9753d6SMatthew G. Knepley   const char      *name          = "Hybrid Jacobian";
5447148442b3SMatthew G. Knepley   DM               dmAux[3]      = {NULL, NULL, NULL};
5448148442b3SMatthew G. Knepley   DMLabel          ghostLabel    = NULL;
54493e9753d6SMatthew G. Knepley   DM               plex          = NULL;
54503e9753d6SMatthew G. Knepley   DM               plexA         = NULL;
5451148442b3SMatthew G. Knepley   PetscDS          ds            = NULL;
5452148442b3SMatthew G. Knepley   PetscDS          dsAux[3]      = {NULL, NULL, NULL};
5453148442b3SMatthew G. Knepley   Vec              locA[3]       = {NULL, NULL, NULL};
54543e9753d6SMatthew G. Knepley   PetscSection     section       = NULL;
5455148442b3SMatthew G. Knepley   PetscSection     sectionAux[3] = {NULL, NULL, NULL};
54563e9753d6SMatthew G. Knepley   DMField          coordField    = NULL;
5457148442b3SMatthew G. Knepley   PetscScalar     *u = NULL, *u_t, *a[3];
54583e9753d6SMatthew G. Knepley   PetscScalar     *elemMat, *elemMatP;
5459e432b41dSStefano Zampini   PetscSection     globalSection;
54603e9753d6SMatthew G. Knepley   IS               chunkIS;
54613e9753d6SMatthew G. Knepley   const PetscInt  *cells;
54623e9753d6SMatthew G. Knepley   PetscInt        *faces;
54633e9753d6SMatthew G. Knepley   PetscInt         cStart, cEnd, numCells;
5464148442b3SMatthew G. Knepley   PetscInt         Nf, fieldI, fieldJ, totDim, totDimAux[3], numChunks, cellChunkSize, chunk;
54653e9753d6SMatthew G. Knepley   PetscInt         maxDegree = PETSC_MAX_INT;
54663e9753d6SMatthew G. Knepley   PetscQuadrature  affineQuad = NULL, *quads = NULL;
54673e9753d6SMatthew G. Knepley   PetscFEGeom     *affineGeom = NULL, **geoms = NULL;
5468e432b41dSStefano Zampini   PetscBool        hasBdJac, hasBdPrec;
54693e9753d6SMatthew G. Knepley 
54703e9753d6SMatthew G. Knepley   PetscFunctionBegin;
54715fedec97SMatthew G. Knepley   if ((key[0].label == key[1].label) && (key[0].value == key[1].value) && (key[0].part == key[1].part)) {
54725fedec97SMatthew G. Knepley     const char *name;
54739566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetName((PetscObject) key[0].label, &name));
547463a3b9bcSJacob Faibussowitsch     SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Form keys for each side of a cohesive surface must be different (%s, %" PetscInt_FMT ", %" PetscInt_FMT ")", name, key[0].value, key[0].part);
54755fedec97SMatthew G. Knepley   }
54769566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_JacobianFEM,dm,0,0,0));
54779566063dSJacob Faibussowitsch   PetscCall(ISGetLocalSize(cellIS, &numCells));
54789566063dSJacob Faibussowitsch   PetscCall(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
54799566063dSJacob Faibussowitsch   PetscCall(DMConvert(dm, DMPLEX, &plex));
54809566063dSJacob Faibussowitsch   PetscCall(DMGetSection(dm, &section));
54819566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dm, &globalSection));
54829566063dSJacob Faibussowitsch   PetscCall(DMGetLabel(dm, "ghost", &ghostLabel));
54831059d808SMatthew G. Knepley   PetscCall(DMGetCellDS(dm, cells ? cells[cStart] : cStart, &ds));
54849566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumFields(ds, &Nf));
54859566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(ds, &totDim));
54869566063dSJacob Faibussowitsch   PetscCall(PetscDSHasBdJacobian(ds, &hasBdJac));
54879566063dSJacob Faibussowitsch   PetscCall(PetscDSHasBdJacobianPreconditioner(ds, &hasBdPrec));
54889566063dSJacob Faibussowitsch   PetscCall(DMGetAuxiliaryVec(dm, key[2].label, key[2].value, key[2].part, &locA[2]));
5489148442b3SMatthew G. Knepley   if (locA[2]) {
54901059d808SMatthew G. Knepley     const PetscInt cellStart = cells ? cells[cStart] : cStart;
54911059d808SMatthew G. Knepley 
54929566063dSJacob Faibussowitsch     PetscCall(VecGetDM(locA[2], &dmAux[2]));
54939566063dSJacob Faibussowitsch     PetscCall(DMConvert(dmAux[2], DMPLEX, &plexA));
54949566063dSJacob Faibussowitsch     PetscCall(DMGetSection(dmAux[2], &sectionAux[2]));
54951059d808SMatthew G. Knepley     PetscCall(DMGetCellDS(dmAux[2], cellStart, &dsAux[2]));
54969566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalDimension(dsAux[2], &totDimAux[2]));
5497148442b3SMatthew G. Knepley     {
5498148442b3SMatthew G. Knepley       const PetscInt *cone;
5499148442b3SMatthew G. Knepley       PetscInt        c;
5500148442b3SMatthew G. Knepley 
55011059d808SMatthew G. Knepley       PetscCall(DMPlexGetCone(dm, cellStart, &cone));
5502148442b3SMatthew G. Knepley       for (c = 0; c < 2; ++c) {
5503148442b3SMatthew G. Knepley         const PetscInt *support;
5504148442b3SMatthew G. Knepley         PetscInt ssize, s;
5505148442b3SMatthew G. Knepley 
55069566063dSJacob Faibussowitsch         PetscCall(DMPlexGetSupport(dm, cone[c], &support));
55079566063dSJacob Faibussowitsch         PetscCall(DMPlexGetSupportSize(dm, cone[c], &ssize));
55081059d808SMatthew G. Knepley         PetscCheck(ssize == 2,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Face %" PetscInt_FMT " from cell %" PetscInt_FMT " has support size %" PetscInt_FMT " != 2", cone[c], cellStart, ssize);
55091059d808SMatthew G. Knepley         if      (support[0] == cellStart) s = 1;
55101059d808SMatthew G. Knepley         else if (support[1] == cellStart) s = 0;
55111059d808SMatthew G. Knepley         else SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Face %" PetscInt_FMT " does not have cell %" PetscInt_FMT " in its support", cone[c], cellStart);
55129566063dSJacob Faibussowitsch         PetscCall(DMGetAuxiliaryVec(dm, key[c].label, key[c].value, key[c].part, &locA[c]));
55139566063dSJacob Faibussowitsch         if (locA[c]) PetscCall(VecGetDM(locA[c], &dmAux[c]));
5514148442b3SMatthew G. Knepley         else         {dmAux[c] = dmAux[2];}
55159566063dSJacob Faibussowitsch         PetscCall(DMGetCellDS(dmAux[c], support[s], &dsAux[c]));
55169566063dSJacob Faibussowitsch         PetscCall(PetscDSGetTotalDimension(dsAux[c], &totDimAux[c]));
5517148442b3SMatthew G. Knepley       }
5518148442b3SMatthew G. Knepley     }
55193e9753d6SMatthew G. Knepley   }
55209566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateField(dm, &coordField));
55219566063dSJacob Faibussowitsch   PetscCall(DMFieldGetDegree(coordField, cellIS, NULL, &maxDegree));
55223e9753d6SMatthew G. Knepley   if (maxDegree > 1) {
55233e9753d6SMatthew G. Knepley     PetscInt f;
55249566063dSJacob Faibussowitsch     PetscCall(PetscCalloc2(Nf, &quads, Nf, &geoms));
55253e9753d6SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
55263e9753d6SMatthew G. Knepley       PetscFE fe;
55273e9753d6SMatthew G. Knepley 
55289566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(ds, f, (PetscObject *) &fe));
55293e9753d6SMatthew G. Knepley       if (fe) {
55309566063dSJacob Faibussowitsch         PetscCall(PetscFEGetQuadrature(fe, &quads[f]));
55319566063dSJacob Faibussowitsch         PetscCall(PetscObjectReference((PetscObject) quads[f]));
55323e9753d6SMatthew G. Knepley       }
55333e9753d6SMatthew G. Knepley     }
55343e9753d6SMatthew G. Knepley   }
55353e9753d6SMatthew G. Knepley   cellChunkSize = numCells;
55363e9753d6SMatthew G. Knepley   numChunks     = !numCells ? 0 : PetscCeilReal(((PetscReal) numCells)/cellChunkSize);
5537a4158a15SMatthew G. Knepley   PetscCall(PetscCalloc1(1*cellChunkSize, &faces));
5538a4158a15SMatthew G. Knepley   PetscCall(ISCreateGeneral(PETSC_COMM_SELF, 1*cellChunkSize, faces, PETSC_USE_POINTER, &chunkIS));
55399566063dSJacob Faibussowitsch   PetscCall(DMPlexGetCellFields(dm, cellIS, locX, locX_t, locA[2], &u, &u_t, &a[2]));
55409566063dSJacob Faibussowitsch   PetscCall(DMPlexGetHybridAuxFields(dm, dmAux, dsAux, cellIS, locA, a));
55419566063dSJacob Faibussowitsch   PetscCall(DMGetWorkArray(dm, hasBdJac  ? cellChunkSize*totDim*totDim : 0, MPIU_SCALAR, &elemMat));
55429566063dSJacob Faibussowitsch   PetscCall(DMGetWorkArray(dm, hasBdPrec ? cellChunkSize*totDim*totDim : 0, MPIU_SCALAR, &elemMatP));
55433e9753d6SMatthew G. Knepley   for (chunk = 0; chunk < numChunks; ++chunk) {
55443e9753d6SMatthew G. Knepley     PetscInt cS = cStart+chunk*cellChunkSize, cE = PetscMin(cS+cellChunkSize, cEnd), numCells = cE - cS, c;
55453e9753d6SMatthew G. Knepley 
55469566063dSJacob Faibussowitsch     if (hasBdJac)  PetscCall(PetscMemzero(elemMat,  numCells*totDim*totDim * sizeof(PetscScalar)));
55479566063dSJacob Faibussowitsch     if (hasBdPrec) PetscCall(PetscMemzero(elemMatP, numCells*totDim*totDim * sizeof(PetscScalar)));
55483e9753d6SMatthew G. Knepley     /* Get faces */
55493e9753d6SMatthew G. Knepley     for (c = cS; c < cE; ++c) {
55503e9753d6SMatthew G. Knepley       const PetscInt  cell = cells ? cells[c] : c;
55513e9753d6SMatthew G. Knepley       const PetscInt *cone;
55529566063dSJacob Faibussowitsch       PetscCall(DMPlexGetCone(plex, cell, &cone));
5553a4158a15SMatthew G. Knepley       faces[0*cellChunkSize+(c-cS)] = cone[0];
5554a4158a15SMatthew G. Knepley       /*faces[2*cellChunkSize+(c-cS)] = cone[1];*/
55553e9753d6SMatthew G. Knepley     }
5556a4158a15SMatthew G. Knepley     PetscCall(ISGeneralSetIndices(chunkIS, 1*cellChunkSize, faces, PETSC_USE_POINTER));
55573e9753d6SMatthew G. Knepley     if (maxDegree <= 1) {
55589566063dSJacob Faibussowitsch       if (!affineQuad) PetscCall(DMFieldCreateDefaultQuadrature(coordField, chunkIS, &affineQuad));
55599566063dSJacob Faibussowitsch       if (affineQuad)  PetscCall(DMSNESGetFEGeom(coordField, chunkIS, affineQuad, PETSC_TRUE, &affineGeom));
55603e9753d6SMatthew G. Knepley     } else {
55613e9753d6SMatthew G. Knepley       PetscInt f;
55623e9753d6SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
55639566063dSJacob Faibussowitsch         if (quads[f]) PetscCall(DMSNESGetFEGeom(coordField, chunkIS, quads[f], PETSC_TRUE, &geoms[f]));
55643e9753d6SMatthew G. Knepley       }
55653e9753d6SMatthew G. Knepley     }
55663e9753d6SMatthew G. Knepley 
55673e9753d6SMatthew G. Knepley     for (fieldI = 0; fieldI < Nf; ++fieldI) {
55683e9753d6SMatthew G. Knepley       PetscFE         feI;
55693e9753d6SMatthew G. Knepley       PetscFEGeom    *geom = affineGeom ? affineGeom : geoms[fieldI];
55703e9753d6SMatthew G. Knepley       PetscFEGeom    *chunkGeom = NULL, *remGeom = NULL;
55713e9753d6SMatthew G. Knepley       PetscQuadrature quad = affineQuad ? affineQuad : quads[fieldI];
55723e9753d6SMatthew G. Knepley       PetscInt        numChunks, numBatches, batchSize, numBlocks, blockSize, Ne, Nr, offset, Nq, Nb;
55735fedec97SMatthew G. Knepley       PetscBool       isCohesiveField;
55743e9753d6SMatthew G. Knepley 
55759566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(ds, fieldI, (PetscObject *) &feI));
55763e9753d6SMatthew G. Knepley       if (!feI) continue;
55779566063dSJacob Faibussowitsch       PetscCall(PetscFEGetTileSizes(feI, NULL, &numBlocks, NULL, &numBatches));
55789566063dSJacob Faibussowitsch       PetscCall(PetscQuadratureGetData(quad, NULL, NULL, &Nq, NULL, NULL));
55799566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDimension(feI, &Nb));
55803e9753d6SMatthew G. Knepley       blockSize = Nb;
55813e9753d6SMatthew G. Knepley       batchSize = numBlocks * blockSize;
55829566063dSJacob Faibussowitsch       PetscCall(PetscFESetTileSizes(feI, blockSize, numBlocks, batchSize, numBatches));
55833e9753d6SMatthew G. Knepley       numChunks = numCells / (numBatches*batchSize);
55843e9753d6SMatthew G. Knepley       Ne        = numChunks*numBatches*batchSize;
55853e9753d6SMatthew G. Knepley       Nr        = numCells % (numBatches*batchSize);
55863e9753d6SMatthew G. Knepley       offset    = numCells - Nr;
55879566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomGetChunk(geom,0,offset,&chunkGeom));
55889566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomGetChunk(geom,offset,numCells,&remGeom));
55899566063dSJacob Faibussowitsch       PetscCall(PetscDSGetCohesive(ds, fieldI, &isCohesiveField));
55903e9753d6SMatthew G. Knepley       for (fieldJ = 0; fieldJ < Nf; ++fieldJ) {
55913e9753d6SMatthew G. Knepley         PetscFE feJ;
55923e9753d6SMatthew G. Knepley 
55939566063dSJacob Faibussowitsch         PetscCall(PetscDSGetDiscretization(ds, fieldJ, (PetscObject *) &feJ));
55943e9753d6SMatthew G. Knepley         if (!feJ) continue;
5595148442b3SMatthew G. Knepley         key[0].field = fieldI*Nf+fieldJ;
5596148442b3SMatthew G. Knepley         key[1].field = fieldI*Nf+fieldJ;
55975fedec97SMatthew G. Knepley         key[2].field = fieldI*Nf+fieldJ;
5598148442b3SMatthew G. Knepley         if (hasBdJac) {
55999566063dSJacob Faibussowitsch           PetscCall(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN, key[0], 0, Ne, chunkGeom, u, u_t, dsAux[0], a[0], t, X_tShift, elemMat));
56009566063dSJacob Faibussowitsch           PetscCall(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]));
56019566063dSJacob Faibussowitsch           PetscCall(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN, key[1], 1, Ne, chunkGeom, u, u_t, dsAux[1], a[1], t, X_tShift, elemMat));
56029566063dSJacob Faibussowitsch           PetscCall(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]));
5603148442b3SMatthew G. Knepley         }
5604148442b3SMatthew G. Knepley         if (hasBdPrec) {
56059566063dSJacob Faibussowitsch           PetscCall(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN_PRE, key[0], 0, Ne, chunkGeom, u, u_t, dsAux[0], a[0], t, X_tShift, elemMatP));
56069566063dSJacob Faibussowitsch           PetscCall(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]));
56079566063dSJacob Faibussowitsch           PetscCall(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN_PRE, key[1], 1, Ne, chunkGeom, u, u_t, dsAux[1], a[1], t, X_tShift, elemMatP));
56089566063dSJacob Faibussowitsch           PetscCall(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]));
5609148442b3SMatthew G. Knepley         }
56105fedec97SMatthew G. Knepley         if (hasBdJac) {
56119566063dSJacob Faibussowitsch           PetscCall(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN, key[2], 2, Ne, chunkGeom, u, u_t, dsAux[2], a[2], t, X_tShift, elemMat));
56129566063dSJacob Faibussowitsch           PetscCall(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]));
5613148442b3SMatthew G. Knepley         }
56145fedec97SMatthew G. Knepley         if (hasBdPrec) {
56159566063dSJacob Faibussowitsch           PetscCall(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN_PRE, key[2], 2, Ne, chunkGeom, u, u_t, dsAux[2], a[2], t, X_tShift, elemMatP));
56169566063dSJacob Faibussowitsch           PetscCall(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]));
56173e9753d6SMatthew G. Knepley         }
56183e9753d6SMatthew G. Knepley       }
56199566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomRestoreChunk(geom,offset,numCells,&remGeom));
56209566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomRestoreChunk(geom,0,offset,&chunkGeom));
56213e9753d6SMatthew G. Knepley     }
56223e9753d6SMatthew G. Knepley     /* Insert values into matrix */
56233e9753d6SMatthew G. Knepley     for (c = cS; c < cE; ++c) {
56243e9753d6SMatthew G. Knepley       const PetscInt cell = cells ? cells[c] : c;
56253e9753d6SMatthew G. Knepley       const PetscInt cind = c - cS;
56263e9753d6SMatthew G. Knepley 
56273e9753d6SMatthew G. Knepley       if (hasBdPrec) {
56283e9753d6SMatthew G. Knepley         if (hasBdJac) {
56299566063dSJacob Faibussowitsch           if (mesh->printFEM > 1) PetscCall(DMPrintCellMatrix(cell, name, totDim, totDim, &elemMat[cind*totDim*totDim]));
56309566063dSJacob Faibussowitsch           PetscCall(DMPlexMatSetClosure(plex, section, globalSection, Jac, cell, &elemMat[cind*totDim*totDim], ADD_VALUES));
56313e9753d6SMatthew G. Knepley         }
56329566063dSJacob Faibussowitsch         if (mesh->printFEM > 1) PetscCall(DMPrintCellMatrix(cell, name, totDim, totDim, &elemMatP[cind*totDim*totDim]));
56339566063dSJacob Faibussowitsch         PetscCall(DMPlexMatSetClosure(plex, section, globalSection, JacP, cell, &elemMatP[cind*totDim*totDim], ADD_VALUES));
56343e9753d6SMatthew G. Knepley       } else if (hasBdJac) {
56359566063dSJacob Faibussowitsch         if (mesh->printFEM > 1) PetscCall(DMPrintCellMatrix(cell, name, totDim, totDim, &elemMat[cind*totDim*totDim]));
56369566063dSJacob Faibussowitsch         PetscCall(DMPlexMatSetClosure(plex, section, globalSection, JacP, cell, &elemMat[cind*totDim*totDim], ADD_VALUES));
56373e9753d6SMatthew G. Knepley       }
56383e9753d6SMatthew G. Knepley     }
56393e9753d6SMatthew G. Knepley   }
56409566063dSJacob Faibussowitsch   PetscCall(DMPlexRestoreCellFields(dm, cellIS, locX, locX_t, locA[2], &u, &u_t, &a[2]));
56419566063dSJacob Faibussowitsch   PetscCall(DMPlexRestoreHybridAuxFields(dmAux, dsAux, cellIS, locA, a));
56429566063dSJacob Faibussowitsch   PetscCall(DMRestoreWorkArray(dm, hasBdJac  ? cellChunkSize*totDim*totDim : 0, MPIU_SCALAR, &elemMat));
56439566063dSJacob Faibussowitsch   PetscCall(DMRestoreWorkArray(dm, hasBdPrec ? cellChunkSize*totDim*totDim : 0, MPIU_SCALAR, &elemMatP));
56449566063dSJacob Faibussowitsch   PetscCall(PetscFree(faces));
56459566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&chunkIS));
56469566063dSJacob Faibussowitsch   PetscCall(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
56473e9753d6SMatthew G. Knepley   if (maxDegree <= 1) {
56489566063dSJacob Faibussowitsch     PetscCall(DMSNESRestoreFEGeom(coordField,cellIS,affineQuad,PETSC_FALSE,&affineGeom));
56499566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureDestroy(&affineQuad));
56503e9753d6SMatthew G. Knepley   } else {
56513e9753d6SMatthew G. Knepley     PetscInt f;
56523e9753d6SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
56539566063dSJacob Faibussowitsch       if (geoms) PetscCall(DMSNESRestoreFEGeom(coordField,cellIS,quads[f],PETSC_FALSE, &geoms[f]));
56549566063dSJacob Faibussowitsch       if (quads) PetscCall(PetscQuadratureDestroy(&quads[f]));
56553e9753d6SMatthew G. Knepley     }
56569566063dSJacob Faibussowitsch     PetscCall(PetscFree2(quads,geoms));
56573e9753d6SMatthew G. Knepley   }
56589566063dSJacob Faibussowitsch   if (dmAux[2]) PetscCall(DMDestroy(&plexA));
56599566063dSJacob Faibussowitsch   PetscCall(DMDestroy(&plex));
56609566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_JacobianFEM,dm,0,0,0));
56613e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
56623e9753d6SMatthew G. Knepley }
56638e3a2eefSMatthew G. Knepley 
56648e3a2eefSMatthew G. Knepley /*
56658e3a2eefSMatthew 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.
56668e3a2eefSMatthew G. Knepley 
56678e3a2eefSMatthew G. Knepley   Input Parameters:
56688e3a2eefSMatthew G. Knepley + dm     - The mesh
56698e3a2eefSMatthew G. Knepley . key    - The PetscWeakFormKey indcating where integration should happen
567006ad1575SMatthew G. Knepley . cellIS - The cells to integrate over
56718e3a2eefSMatthew G. Knepley . t      - The time
56728e3a2eefSMatthew G. Knepley . X_tShift - The multiplier for the Jacobian with repsect to X_t
56738e3a2eefSMatthew G. Knepley . X      - Local solution vector
56748e3a2eefSMatthew G. Knepley . X_t    - Time-derivative of the local solution vector
56758e3a2eefSMatthew G. Knepley . Y      - Local input vector
567606ad1575SMatthew G. Knepley - user   - the user context
56778e3a2eefSMatthew G. Knepley 
56788e3a2eefSMatthew G. Knepley   Output Parameter:
56798e3a2eefSMatthew G. Knepley . Z - Local output vector
56808e3a2eefSMatthew G. Knepley 
56818e3a2eefSMatthew G. Knepley   Note:
56828e3a2eefSMatthew G. Knepley   We form the residual one batch of elements at a time. This allows us to offload work onto an accelerator,
56838e3a2eefSMatthew G. Knepley   like a GPU, or vectorize on a multicore machine.
56848e3a2eefSMatthew G. Knepley */
568506ad1575SMatthew 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)
56868e3a2eefSMatthew G. Knepley {
56878e3a2eefSMatthew G. Knepley   DM_Plex        *mesh  = (DM_Plex *) dm->data;
56888e3a2eefSMatthew G. Knepley   const char     *name  = "Jacobian";
56898e3a2eefSMatthew G. Knepley   DM              dmAux = NULL, plex, plexAux = NULL;
56908e3a2eefSMatthew G. Knepley   DMEnclosureType encAux;
56918e3a2eefSMatthew G. Knepley   Vec             A;
56928e3a2eefSMatthew G. Knepley   DMField         coordField;
56938e3a2eefSMatthew G. Knepley   PetscDS         prob, probAux = NULL;
56948e3a2eefSMatthew G. Knepley   PetscQuadrature quad;
56958e3a2eefSMatthew G. Knepley   PetscSection    section, globalSection, sectionAux;
56968e3a2eefSMatthew G. Knepley   PetscScalar    *elemMat, *elemMatD, *u, *u_t, *a = NULL, *y, *z;
56978e3a2eefSMatthew G. Knepley   const PetscInt *cells;
56988e3a2eefSMatthew G. Knepley   PetscInt        Nf, fieldI, fieldJ;
56998e3a2eefSMatthew G. Knepley   PetscInt        totDim, totDimAux = 0, cStart, cEnd, numCells, c;
57008e3a2eefSMatthew G. Knepley   PetscBool       hasDyn;
57018e3a2eefSMatthew G. Knepley 
57028e3a2eefSMatthew G. Knepley   PetscFunctionBegin;
57039566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_JacobianFEM,dm,0,0,0));
57049566063dSJacob Faibussowitsch   PetscCall(DMConvert(dm, DMPLEX, &plex));
57058e3a2eefSMatthew G. Knepley   if (!cellIS) {
57068e3a2eefSMatthew G. Knepley     PetscInt depth;
57078e3a2eefSMatthew G. Knepley 
57089566063dSJacob Faibussowitsch     PetscCall(DMPlexGetDepth(plex, &depth));
57099566063dSJacob Faibussowitsch     PetscCall(DMGetStratumIS(plex, "dim", depth, &cellIS));
57109566063dSJacob Faibussowitsch     if (!cellIS) PetscCall(DMGetStratumIS(plex, "depth", depth, &cellIS));
57118e3a2eefSMatthew G. Knepley   } else {
57129566063dSJacob Faibussowitsch     PetscCall(PetscObjectReference((PetscObject) cellIS));
57138e3a2eefSMatthew G. Knepley   }
57149566063dSJacob Faibussowitsch   PetscCall(ISGetLocalSize(cellIS, &numCells));
57159566063dSJacob Faibussowitsch   PetscCall(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
57169566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
57179566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dm, &globalSection));
57189566063dSJacob Faibussowitsch   PetscCall(DMGetCellDS(dm, cells ? cells[cStart] : cStart, &prob));
57199566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumFields(prob, &Nf));
57209566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(prob, &totDim));
57219566063dSJacob Faibussowitsch   PetscCall(PetscDSHasDynamicJacobian(prob, &hasDyn));
57228e3a2eefSMatthew G. Knepley   hasDyn = hasDyn && (X_tShift != 0.0) ? PETSC_TRUE : PETSC_FALSE;
57239566063dSJacob Faibussowitsch   PetscCall(DMGetAuxiliaryVec(dm, key.label, key.value, key.part, &A));
57248e3a2eefSMatthew G. Knepley   if (A) {
57259566063dSJacob Faibussowitsch     PetscCall(VecGetDM(A, &dmAux));
57269566063dSJacob Faibussowitsch     PetscCall(DMGetEnclosureRelation(dmAux, dm, &encAux));
57279566063dSJacob Faibussowitsch     PetscCall(DMConvert(dmAux, DMPLEX, &plexAux));
57289566063dSJacob Faibussowitsch     PetscCall(DMGetLocalSection(plexAux, &sectionAux));
57299566063dSJacob Faibussowitsch     PetscCall(DMGetDS(dmAux, &probAux));
57309566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalDimension(probAux, &totDimAux));
57318e3a2eefSMatthew G. Knepley   }
57329566063dSJacob Faibussowitsch   PetscCall(VecSet(Z, 0.0));
57339566063dSJacob Faibussowitsch   PetscCall(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));
57349566063dSJacob Faibussowitsch   if (dmAux) PetscCall(PetscMalloc1(numCells*totDimAux, &a));
57359566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateField(dm, &coordField));
57368e3a2eefSMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
57378e3a2eefSMatthew G. Knepley     const PetscInt cell = cells ? cells[c] : c;
57388e3a2eefSMatthew G. Knepley     const PetscInt cind = c - cStart;
57398e3a2eefSMatthew G. Knepley     PetscScalar   *x = NULL,  *x_t = NULL;
57408e3a2eefSMatthew G. Knepley     PetscInt       i;
57418e3a2eefSMatthew G. Knepley 
57429566063dSJacob Faibussowitsch     PetscCall(DMPlexVecGetClosure(plex, section, X, cell, NULL, &x));
57438e3a2eefSMatthew G. Knepley     for (i = 0; i < totDim; ++i) u[cind*totDim+i] = x[i];
57449566063dSJacob Faibussowitsch     PetscCall(DMPlexVecRestoreClosure(plex, section, X, cell, NULL, &x));
57458e3a2eefSMatthew G. Knepley     if (X_t) {
57469566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(plex, section, X_t, cell, NULL, &x_t));
57478e3a2eefSMatthew G. Knepley       for (i = 0; i < totDim; ++i) u_t[cind*totDim+i] = x_t[i];
57489566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(plex, section, X_t, cell, NULL, &x_t));
57498e3a2eefSMatthew G. Knepley     }
57508e3a2eefSMatthew G. Knepley     if (dmAux) {
57518e3a2eefSMatthew G. Knepley       PetscInt subcell;
57529566063dSJacob Faibussowitsch       PetscCall(DMGetEnclosurePoint(dmAux, dm, encAux, cell, &subcell));
57539566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(plexAux, sectionAux, A, subcell, NULL, &x));
57548e3a2eefSMatthew G. Knepley       for (i = 0; i < totDimAux; ++i) a[cind*totDimAux+i] = x[i];
57559566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(plexAux, sectionAux, A, subcell, NULL, &x));
57568e3a2eefSMatthew G. Knepley     }
57579566063dSJacob Faibussowitsch     PetscCall(DMPlexVecGetClosure(plex, section, Y, cell, NULL, &x));
57588e3a2eefSMatthew G. Knepley     for (i = 0; i < totDim; ++i) y[cind*totDim+i] = x[i];
57599566063dSJacob Faibussowitsch     PetscCall(DMPlexVecRestoreClosure(plex, section, Y, cell, NULL, &x));
57608e3a2eefSMatthew G. Knepley   }
57619566063dSJacob Faibussowitsch   PetscCall(PetscArrayzero(elemMat, numCells*totDim*totDim));
57629566063dSJacob Faibussowitsch   if (hasDyn)  PetscCall(PetscArrayzero(elemMatD, numCells*totDim*totDim));
57638e3a2eefSMatthew G. Knepley   for (fieldI = 0; fieldI < Nf; ++fieldI) {
57648e3a2eefSMatthew G. Knepley     PetscFE  fe;
57658e3a2eefSMatthew G. Knepley     PetscInt Nb;
57668e3a2eefSMatthew G. Knepley     /* Conforming batches */
57678e3a2eefSMatthew G. Knepley     PetscInt numChunks, numBatches, numBlocks, Ne, blockSize, batchSize;
57688e3a2eefSMatthew G. Knepley     /* Remainder */
57698e3a2eefSMatthew G. Knepley     PetscInt Nr, offset, Nq;
57708e3a2eefSMatthew G. Knepley     PetscQuadrature qGeom = NULL;
57718e3a2eefSMatthew G. Knepley     PetscInt    maxDegree;
57728e3a2eefSMatthew G. Knepley     PetscFEGeom *cgeomFEM, *chunkGeom = NULL, *remGeom = NULL;
57738e3a2eefSMatthew G. Knepley 
57749566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, fieldI, (PetscObject *) &fe));
57759566063dSJacob Faibussowitsch     PetscCall(PetscFEGetQuadrature(fe, &quad));
57769566063dSJacob Faibussowitsch     PetscCall(PetscFEGetDimension(fe, &Nb));
57779566063dSJacob Faibussowitsch     PetscCall(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
57789566063dSJacob Faibussowitsch     PetscCall(DMFieldGetDegree(coordField,cellIS,NULL,&maxDegree));
57799566063dSJacob Faibussowitsch     if (maxDegree <= 1) PetscCall(DMFieldCreateDefaultQuadrature(coordField,cellIS,&qGeom));
57808e3a2eefSMatthew G. Knepley     if (!qGeom) {
57819566063dSJacob Faibussowitsch       PetscCall(PetscFEGetQuadrature(fe,&qGeom));
57829566063dSJacob Faibussowitsch       PetscCall(PetscObjectReference((PetscObject)qGeom));
57838e3a2eefSMatthew G. Knepley     }
57849566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureGetData(qGeom, NULL, NULL, &Nq, NULL, NULL));
57859566063dSJacob Faibussowitsch     PetscCall(DMSNESGetFEGeom(coordField,cellIS,qGeom,PETSC_FALSE,&cgeomFEM));
57868e3a2eefSMatthew G. Knepley     blockSize = Nb;
57878e3a2eefSMatthew G. Knepley     batchSize = numBlocks * blockSize;
57889566063dSJacob Faibussowitsch     PetscCall(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
57898e3a2eefSMatthew G. Knepley     numChunks = numCells / (numBatches*batchSize);
57908e3a2eefSMatthew G. Knepley     Ne        = numChunks*numBatches*batchSize;
57918e3a2eefSMatthew G. Knepley     Nr        = numCells % (numBatches*batchSize);
57928e3a2eefSMatthew G. Knepley     offset    = numCells - Nr;
57939566063dSJacob Faibussowitsch     PetscCall(PetscFEGeomGetChunk(cgeomFEM,0,offset,&chunkGeom));
57949566063dSJacob Faibussowitsch     PetscCall(PetscFEGeomGetChunk(cgeomFEM,offset,numCells,&remGeom));
57958e3a2eefSMatthew G. Knepley     for (fieldJ = 0; fieldJ < Nf; ++fieldJ) {
57968e3a2eefSMatthew G. Knepley       key.field = fieldI*Nf + fieldJ;
57979566063dSJacob Faibussowitsch       PetscCall(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN, key, Ne, chunkGeom, u, u_t, probAux, a, t, X_tShift, elemMat));
57989566063dSJacob Faibussowitsch       PetscCall(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]));
57998e3a2eefSMatthew G. Knepley       if (hasDyn) {
58009566063dSJacob Faibussowitsch         PetscCall(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN_DYN, key, Ne, chunkGeom, u, u_t, probAux, a, t, X_tShift, elemMatD));
58019566063dSJacob Faibussowitsch         PetscCall(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]));
58028e3a2eefSMatthew G. Knepley       }
58038e3a2eefSMatthew G. Knepley     }
58049566063dSJacob Faibussowitsch     PetscCall(PetscFEGeomRestoreChunk(cgeomFEM,offset,numCells,&remGeom));
58059566063dSJacob Faibussowitsch     PetscCall(PetscFEGeomRestoreChunk(cgeomFEM,0,offset,&chunkGeom));
58069566063dSJacob Faibussowitsch     PetscCall(DMSNESRestoreFEGeom(coordField,cellIS,qGeom,PETSC_FALSE,&cgeomFEM));
58079566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureDestroy(&qGeom));
58088e3a2eefSMatthew G. Knepley   }
58098e3a2eefSMatthew G. Knepley   if (hasDyn) {
58108e3a2eefSMatthew G. Knepley     for (c = 0; c < numCells*totDim*totDim; ++c) elemMat[c] += X_tShift*elemMatD[c];
58118e3a2eefSMatthew G. Knepley   }
58128e3a2eefSMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
58138e3a2eefSMatthew G. Knepley     const PetscInt     cell = cells ? cells[c] : c;
58148e3a2eefSMatthew G. Knepley     const PetscInt     cind = c - cStart;
58158e3a2eefSMatthew G. Knepley     const PetscBLASInt M = totDim, one = 1;
58168e3a2eefSMatthew G. Knepley     const PetscScalar  a = 1.0, b = 0.0;
58178e3a2eefSMatthew G. Knepley 
5818*792fecdfSBarry Smith     PetscCallBLAS("BLASgemv", BLASgemv_("N", &M, &M, &a, &elemMat[cind*totDim*totDim], &M, &y[cind*totDim], &one, &b, z, &one));
58198e3a2eefSMatthew G. Knepley     if (mesh->printFEM > 1) {
58209566063dSJacob Faibussowitsch       PetscCall(DMPrintCellMatrix(c, name, totDim, totDim, &elemMat[cind*totDim*totDim]));
58219566063dSJacob Faibussowitsch       PetscCall(DMPrintCellVector(c, "Y",  totDim, &y[cind*totDim]));
58229566063dSJacob Faibussowitsch       PetscCall(DMPrintCellVector(c, "Z",  totDim, z));
58238e3a2eefSMatthew G. Knepley     }
58249566063dSJacob Faibussowitsch     PetscCall(DMPlexVecSetClosure(dm, section, Z, cell, z, ADD_VALUES));
58258e3a2eefSMatthew G. Knepley   }
58269566063dSJacob Faibussowitsch   PetscCall(PetscFree6(u,u_t,elemMat,elemMatD,y,z));
58278e3a2eefSMatthew G. Knepley   if (mesh->printFEM) {
58289566063dSJacob Faibussowitsch     PetscCall(PetscPrintf(PetscObjectComm((PetscObject)Z), "Z:\n"));
58299566063dSJacob Faibussowitsch     PetscCall(VecView(Z, NULL));
58308e3a2eefSMatthew G. Knepley   }
58311059d808SMatthew G. Knepley   PetscCall(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
58329566063dSJacob Faibussowitsch   PetscCall(PetscFree(a));
58339566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&cellIS));
58349566063dSJacob Faibussowitsch   PetscCall(DMDestroy(&plexAux));
58359566063dSJacob Faibussowitsch   PetscCall(DMDestroy(&plex));
58369566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_JacobianFEM,dm,0,0,0));
58378e3a2eefSMatthew G. Knepley   PetscFunctionReturn(0);
58388e3a2eefSMatthew G. Knepley }
5839