xref: /petsc/src/dm/impls/plex/plexfem.c (revision cac4c232dc4f93991e342196e27ef7b0655dac7b)
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));
669566063dSJacob Faibussowitsch   PetscCall(PetscSNPrintf(composeStr, 32, "DMPlexGetFEGeom_%x\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 
10246fa42a0SMatthew G. Knepley .seealso: DMPlexSetScale(), PetscUnit
10346fa42a0SMatthew G. Knepley @*/
104cb1e1211SMatthew G Knepley PetscErrorCode DMPlexGetScale(DM dm, PetscUnit unit, PetscReal *scale)
105cb1e1211SMatthew G Knepley {
106cb1e1211SMatthew G Knepley   DM_Plex *mesh = (DM_Plex*) dm->data;
107cb1e1211SMatthew G Knepley 
108cb1e1211SMatthew G Knepley   PetscFunctionBegin;
109cb1e1211SMatthew G Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
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 
12746fa42a0SMatthew G. Knepley .seealso: DMPlexGetScale(), PetscUnit
12846fa42a0SMatthew G. Knepley @*/
129cb1e1211SMatthew G Knepley PetscErrorCode DMPlexSetScale(DM dm, PetscUnit unit, PetscReal scale)
130cb1e1211SMatthew G Knepley {
131cb1e1211SMatthew G Knepley   DM_Plex *mesh = (DM_Plex*) dm->data;
132cb1e1211SMatthew G Knepley 
133cb1e1211SMatthew G Knepley   PetscFunctionBegin;
134cb1e1211SMatthew G Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
135cb1e1211SMatthew G Knepley   mesh->scale[unit] = scale;
136cb1e1211SMatthew G Knepley   PetscFunctionReturn(0);
137cb1e1211SMatthew G Knepley }
138cb1e1211SMatthew G Knepley 
139327779f2SMatthew Knepley static PetscErrorCode DMPlexProjectRigidBody_Private(PetscInt dim, PetscReal t, const PetscReal X[], PetscInt Nc, PetscScalar *mode, void *ctx)
140026175e5SToby Isaac {
14112adca46SMatthew G. Knepley   const PetscInt eps[3][3][3] = {{{0, 0, 0}, {0, 0, 1}, {0, -1, 0}}, {{0, 0, -1}, {0, 0, 0}, {1, 0, 0}}, {{0, 1, 0}, {-1, 0, 0}, {0, 0, 0}}};
142026175e5SToby Isaac   PetscInt *ctxInt  = (PetscInt *) ctx;
143ad917190SMatthew G. Knepley   PetscInt  dim2    = ctxInt[0];
144026175e5SToby Isaac   PetscInt  d       = ctxInt[1];
145026175e5SToby Isaac   PetscInt  i, j, k = dim > 2 ? d - dim : d;
146026175e5SToby Isaac 
147ad917190SMatthew G. Knepley   PetscFunctionBegin;
1485f80ce2aSJacob Faibussowitsch   PetscCheck(dim == dim2,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Input dimension %D does not match context dimension %D", dim, dim2);
149026175e5SToby Isaac   for (i = 0; i < dim; i++) mode[i] = 0.;
150026175e5SToby Isaac   if (d < dim) {
15112adca46SMatthew G. Knepley     mode[d] = 1.; /* Translation along axis d */
152ad917190SMatthew G. Knepley   } else {
153026175e5SToby Isaac     for (i = 0; i < dim; i++) {
154026175e5SToby Isaac       for (j = 0; j < dim; j++) {
15512adca46SMatthew G. Knepley         mode[j] += eps[i][j][k]*X[i]; /* Rotation about axis d */
156026175e5SToby Isaac       }
157026175e5SToby Isaac     }
158026175e5SToby Isaac   }
159ad917190SMatthew G. Knepley   PetscFunctionReturn(0);
160026175e5SToby Isaac }
161026175e5SToby Isaac 
162cc4e42d9SMartin Diehl /*@
16312adca46SMatthew G. Knepley   DMPlexCreateRigidBody - For the default global section, create rigid body modes by function space interpolation
164cb1e1211SMatthew G Knepley 
165d083f849SBarry Smith   Collective on dm
166cb1e1211SMatthew G Knepley 
1674165533cSJose E. Roman   Input Parameters:
16856cf3b9cSMatthew G. Knepley + dm - the DM
16956cf3b9cSMatthew G. Knepley - field - The field number for the rigid body space, or 0 for the default
170cb1e1211SMatthew G Knepley 
1714165533cSJose E. Roman   Output Parameter:
172cb1e1211SMatthew G Knepley . sp - the null space
173cb1e1211SMatthew G Knepley 
17412adca46SMatthew G. Knepley   Note: This is necessary to provide a suitable coarse space for algebraic multigrid
175cb1e1211SMatthew G Knepley 
176cb1e1211SMatthew G Knepley   Level: advanced
177cb1e1211SMatthew G Knepley 
17812adca46SMatthew G. Knepley .seealso: MatNullSpaceCreate(), PCGAMG
179cb1e1211SMatthew G Knepley @*/
18056cf3b9cSMatthew G. Knepley PetscErrorCode DMPlexCreateRigidBody(DM dm, PetscInt field, MatNullSpace *sp)
181cb1e1211SMatthew G Knepley {
18256cf3b9cSMatthew G. Knepley   PetscErrorCode (**func)(PetscInt, PetscReal, const PetscReal *, PetscInt, PetscScalar *, void *);
183cb1e1211SMatthew G Knepley   MPI_Comm          comm;
184026175e5SToby Isaac   Vec               mode[6];
185026175e5SToby Isaac   PetscSection      section, globalSection;
18656cf3b9cSMatthew G. Knepley   PetscInt          dim, dimEmbed, Nf, n, m, mmin, d, i, j;
187cb1e1211SMatthew G Knepley 
188cb1e1211SMatthew G Knepley   PetscFunctionBegin;
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));
1932c71b3e2SJacob Faibussowitsch   PetscCheckFalse(Nf && (field < 0 || field >= Nf),comm, PETSC_ERR_ARG_OUTOFRANGE, "Field %D is not in [0, Nf)", field, Nf);
19456cf3b9cSMatthew G. Knepley   if (dim == 1 && Nf < 2) {
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 
25512adca46SMatthew G. Knepley .seealso: MatNullSpaceCreate()
25612adca46SMatthew G. Knepley @*/
25712adca46SMatthew G. Knepley PetscErrorCode DMPlexCreateRigidBodies(DM dm, PetscInt nb, DMLabel label, const PetscInt nids[], const PetscInt ids[], MatNullSpace *sp)
25812adca46SMatthew G. Knepley {
25912adca46SMatthew G. Knepley   MPI_Comm       comm;
26012adca46SMatthew G. Knepley   PetscSection   section, globalSection;
26112adca46SMatthew G. Knepley   Vec           *mode;
26212adca46SMatthew G. Knepley   PetscScalar   *dots;
26312adca46SMatthew G. Knepley   PetscInt       dim, dimEmbed, n, m, b, d, i, j, off;
26412adca46SMatthew G. Knepley 
26512adca46SMatthew G. Knepley   PetscFunctionBegin;
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 
3224d6f44ffSToby Isaac .seealso: DMPlexGetMaxProjectionHeight(), DMProjectFunctionLocal(), DMProjectFunctionLabelLocal()
323b29cfa1cSToby Isaac @*/
324b29cfa1cSToby Isaac PetscErrorCode DMPlexSetMaxProjectionHeight(DM dm, PetscInt height)
325b29cfa1cSToby Isaac {
326b29cfa1cSToby Isaac   DM_Plex *plex = (DM_Plex *) dm->data;
327b29cfa1cSToby Isaac 
328b29cfa1cSToby Isaac   PetscFunctionBegin;
329b29cfa1cSToby Isaac   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
330b29cfa1cSToby Isaac   plex->maxProjectionHeight = height;
331b29cfa1cSToby Isaac   PetscFunctionReturn(0);
332b29cfa1cSToby Isaac }
333b29cfa1cSToby Isaac 
334b29cfa1cSToby Isaac /*@
335b29cfa1cSToby Isaac   DMPlexGetMaxProjectionHeight - Get the maximum height (w.r.t. DAG) of mesh points used to evaluate dual bases in
336b29cfa1cSToby Isaac   DMPlexProjectXXXLocal() functions.
337b29cfa1cSToby Isaac 
338b29cfa1cSToby Isaac   Input Parameters:
339b29cfa1cSToby Isaac . dm - the DMPlex object
340b29cfa1cSToby Isaac 
341b29cfa1cSToby Isaac   Output Parameters:
342b29cfa1cSToby Isaac . height - the maximum projection height
343b29cfa1cSToby Isaac 
344b29cfa1cSToby Isaac   Level: intermediate
345b29cfa1cSToby Isaac 
3464d6f44ffSToby Isaac .seealso: DMPlexSetMaxProjectionHeight(), DMProjectFunctionLocal(), DMProjectFunctionLabelLocal()
347b29cfa1cSToby Isaac @*/
348b29cfa1cSToby Isaac PetscErrorCode DMPlexGetMaxProjectionHeight(DM dm, PetscInt *height)
349b29cfa1cSToby Isaac {
350b29cfa1cSToby Isaac   DM_Plex *plex = (DM_Plex *) dm->data;
351b29cfa1cSToby Isaac 
352b29cfa1cSToby Isaac   PetscFunctionBegin;
353b29cfa1cSToby Isaac   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
354b29cfa1cSToby Isaac   *height = plex->maxProjectionHeight;
355b29cfa1cSToby Isaac   PetscFunctionReturn(0);
356b29cfa1cSToby Isaac }
357b29cfa1cSToby Isaac 
358ca3d3a14SMatthew G. Knepley typedef struct {
359ca3d3a14SMatthew G. Knepley   PetscReal    alpha; /* The first Euler angle, and in 2D the only one */
360ca3d3a14SMatthew G. Knepley   PetscReal    beta;  /* The second Euler angle */
361ca3d3a14SMatthew G. Knepley   PetscReal    gamma; /* The third Euler angle */
362ca3d3a14SMatthew G. Knepley   PetscInt     dim;   /* The dimension of R */
363ca3d3a14SMatthew G. Knepley   PetscScalar *R;     /* The rotation matrix, transforming a vector in the local basis to the global basis */
364ca3d3a14SMatthew G. Knepley   PetscScalar *RT;    /* The transposed rotation matrix, transforming a vector in the global basis to the local basis */
365ca3d3a14SMatthew G. Knepley } RotCtx;
366ca3d3a14SMatthew G. Knepley 
367ca3d3a14SMatthew G. Knepley /*
368ca3d3a14SMatthew G. Knepley   Note: Following https://en.wikipedia.org/wiki/Euler_angles, we will specify Euler angles by extrinsic rotations, meaning that
369ca3d3a14SMatthew G. Knepley   we rotate with respect to a fixed initial coordinate system, the local basis (x-y-z). The global basis (X-Y-Z) is reached as follows:
370ca3d3a14SMatthew G. Knepley   $ The XYZ system rotates about the z axis by alpha. The X axis is now at angle alpha with respect to the x axis.
371ca3d3a14SMatthew G. Knepley   $ The XYZ system rotates again about the x axis by beta. The Z axis is now at angle beta with respect to the z axis.
372ca3d3a14SMatthew G. Knepley   $ The XYZ system rotates a third time about the z axis by gamma.
373ca3d3a14SMatthew G. Knepley */
374ca3d3a14SMatthew G. Knepley static PetscErrorCode DMPlexBasisTransformSetUp_Rotation_Internal(DM dm, void *ctx)
375ca3d3a14SMatthew G. Knepley {
376ca3d3a14SMatthew G. Knepley   RotCtx        *rc  = (RotCtx *) ctx;
377ca3d3a14SMatthew G. Knepley   PetscInt       dim = rc->dim;
378ca3d3a14SMatthew G. Knepley   PetscReal      c1, s1, c2, s2, c3, s3;
379ca3d3a14SMatthew G. Knepley 
380ca3d3a14SMatthew G. Knepley   PetscFunctionBegin;
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;
40098921bdaSJacob Faibussowitsch   default: SETERRQ(PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_OUTOFRANGE, "Dimension %D not supported", dim);
401ca3d3a14SMatthew G. Knepley   }
402ca3d3a14SMatthew G. Knepley   PetscFunctionReturn(0);
403ca3d3a14SMatthew G. Knepley }
404ca3d3a14SMatthew G. Knepley 
405ca3d3a14SMatthew G. Knepley static PetscErrorCode DMPlexBasisTransformDestroy_Rotation_Internal(DM dm, void *ctx)
406ca3d3a14SMatthew G. Knepley {
407ca3d3a14SMatthew G. Knepley   RotCtx        *rc = (RotCtx *) ctx;
408ca3d3a14SMatthew G. Knepley 
409ca3d3a14SMatthew G. Knepley   PetscFunctionBegin;
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       }
5805f80ce2aSJacob Faibussowitsch       PetscCheck(c == lda,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Invalid number of columns %D should be %D", c, lda);
581ca3d3a14SMatthew G. Knepley       r += fdof;
582ca3d3a14SMatthew G. Knepley     }
583ca3d3a14SMatthew G. Knepley   }
5845f80ce2aSJacob Faibussowitsch   PetscCheck(r == lda,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Invalid number of rows %D should be %D", 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 
632436bc73aSJed Brown .seealso: DMPlexLocalToGlobalBasis(), DMGetLocalSection(), DMPlexCreateBasisRotation()
633ca3d3a14SMatthew G. Knepley @*/
634ca3d3a14SMatthew G. Knepley PetscErrorCode DMPlexGlobalToLocalBasis(DM dm, Vec lv)
635ca3d3a14SMatthew G. Knepley {
636ca3d3a14SMatthew G. Knepley   PetscFunctionBegin;
637ca3d3a14SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
638ca3d3a14SMatthew G. Knepley   PetscValidHeaderSpecific(lv, VEC_CLASSID, 2);
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 
657436bc73aSJed Brown .seealso: DMPlexGlobalToLocalBasis(), DMGetLocalSection(), DMPlexCreateBasisRotation()
658ca3d3a14SMatthew G. Knepley @*/
659ca3d3a14SMatthew G. Knepley PetscErrorCode DMPlexLocalToGlobalBasis(DM dm, Vec lv)
660ca3d3a14SMatthew G. Knepley {
661ca3d3a14SMatthew G. Knepley   PetscFunctionBegin;
662ca3d3a14SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
663ca3d3a14SMatthew G. Knepley   PetscValidHeaderSpecific(lv, VEC_CLASSID, 2);
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 
686ca3d3a14SMatthew G. Knepley .seealso: DMPlexGlobalToLocalBasis(), DMPlexLocalToGlobalBasis()
687ca3d3a14SMatthew G. Knepley @*/
688ca3d3a14SMatthew G. Knepley PetscErrorCode DMPlexCreateBasisRotation(DM dm, PetscReal alpha, PetscReal beta, PetscReal gamma)
689ca3d3a14SMatthew G. Knepley {
690ca3d3a14SMatthew G. Knepley   RotCtx        *rc;
691ca3d3a14SMatthew G. Knepley   PetscInt       cdim;
692ca3d3a14SMatthew G. Knepley 
693362febeeSStefano Zampini   PetscFunctionBegin;
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 
729ece3a9fcSMatthew G. Knepley .seealso: DMPlexInsertBoundaryValuesEssentialField(), DMPlexInsertBoundaryValuesEssentialBdField(), DMAddBoundary()
730b278463cSMatthew G. Knepley @*/
7311c531cf8SMatthew G. Knepley PetscErrorCode DMPlexInsertBoundaryValuesEssential(DM dm, PetscReal time, PetscInt field, PetscInt Nc, const PetscInt comps[], DMLabel label, PetscInt numids, const PetscInt ids[], PetscErrorCode (*func)(PetscInt, PetscReal, const PetscReal[], PetscInt, PetscScalar *, void *), void *ctx, Vec locX)
73255f2e967SMatthew G. Knepley {
7330163fd50SMatthew G. Knepley   PetscErrorCode (**funcs)(PetscInt, PetscReal, const PetscReal x[], PetscInt, PetscScalar *u, void *ctx);
73455f2e967SMatthew G. Knepley   void            **ctxs;
735d7ddef95SMatthew G. Knepley   PetscInt          numFields;
736d7ddef95SMatthew G. Knepley 
737d7ddef95SMatthew G. Knepley   PetscFunctionBegin;
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 
768ece3a9fcSMatthew G. Knepley .seealso: DMPlexInsertBoundaryValuesEssential(), DMPlexInsertBoundaryValuesEssentialBdField(), DMAddBoundary()
769b278463cSMatthew G. Knepley @*/
7701c531cf8SMatthew G. Knepley PetscErrorCode DMPlexInsertBoundaryValuesEssentialField(DM dm, PetscReal time, Vec locU, PetscInt field, PetscInt Nc, const PetscInt comps[], DMLabel label, PetscInt numids, const PetscInt ids[],
771c60e475cSMatthew G. Knepley                                                         void (*func)(PetscInt, PetscInt, PetscInt,
772c60e475cSMatthew G. Knepley                                                                      const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
773c60e475cSMatthew G. Knepley                                                                      const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
77497b6e6e8SMatthew G. Knepley                                                                      PetscReal, const PetscReal[], PetscInt, const PetscScalar[],
775b278463cSMatthew G. Knepley                                                                      PetscScalar[]),
776b278463cSMatthew G. Knepley                                                         void *ctx, Vec locX)
777c60e475cSMatthew G. Knepley {
778c60e475cSMatthew G. Knepley   void (**funcs)(PetscInt, PetscInt, PetscInt,
779c60e475cSMatthew G. Knepley                  const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
780c60e475cSMatthew G. Knepley                  const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
78197b6e6e8SMatthew G. Knepley                  PetscReal, const PetscReal[], PetscInt, const PetscScalar[], PetscScalar[]);
782c60e475cSMatthew G. Knepley   void            **ctxs;
783c60e475cSMatthew G. Knepley   PetscInt          numFields;
784c60e475cSMatthew G. Knepley 
785c60e475cSMatthew G. Knepley   PetscFunctionBegin;
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 
818ece3a9fcSMatthew G. Knepley .seealso: DMProjectBdFieldLabelLocal(), DMPlexInsertBoundaryValuesEssential(), DMPlexInsertBoundaryValuesEssentialField(), DMAddBoundary()
819ece3a9fcSMatthew G. Knepley @*/
820ece3a9fcSMatthew G. Knepley PetscErrorCode DMPlexInsertBoundaryValuesEssentialBdField(DM dm, PetscReal time, Vec locU, PetscInt field, PetscInt Nc, const PetscInt comps[], DMLabel label, PetscInt numids, const PetscInt ids[],
821ece3a9fcSMatthew G. Knepley                                                           void (*func)(PetscInt, PetscInt, PetscInt,
822ece3a9fcSMatthew G. Knepley                                                                        const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
823ece3a9fcSMatthew G. Knepley                                                                        const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
824ece3a9fcSMatthew G. Knepley                                                                        PetscReal, const PetscReal[], const PetscReal[], PetscInt, const PetscScalar[],
825ece3a9fcSMatthew G. Knepley                                                                        PetscScalar[]),
826ece3a9fcSMatthew G. Knepley                                                           void *ctx, Vec locX)
827ece3a9fcSMatthew G. Knepley {
828ece3a9fcSMatthew G. Knepley   void (**funcs)(PetscInt, PetscInt, PetscInt,
829ece3a9fcSMatthew G. Knepley                  const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
830ece3a9fcSMatthew G. Knepley                  const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
831ece3a9fcSMatthew G. Knepley                  PetscReal, const PetscReal[], const PetscReal[], PetscInt, const PetscScalar[], PetscScalar[]);
832ece3a9fcSMatthew G. Knepley   void            **ctxs;
833ece3a9fcSMatthew G. Knepley   PetscInt          numFields;
834ece3a9fcSMatthew G. Knepley 
835ece3a9fcSMatthew G. Knepley   PetscFunctionBegin;
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 
870b278463cSMatthew G. Knepley .seealso: DMPlexInsertBoundaryValuesEssential(), DMPlexInsertBoundaryValuesEssentialField(), DMAddBoundary()
871b278463cSMatthew G. Knepley @*/
8721c531cf8SMatthew G. Knepley PetscErrorCode DMPlexInsertBoundaryValuesRiemann(DM dm, PetscReal time, Vec faceGeometry, Vec cellGeometry, Vec Grad, PetscInt field, PetscInt Nc, const PetscInt comps[], DMLabel label, PetscInt numids, const PetscInt ids[],
873b278463cSMatthew G. Knepley                                                  PetscErrorCode (*func)(PetscReal,const PetscReal*,const PetscReal*,const PetscScalar*,PetscScalar*,void*), void *ctx, Vec locX)
874d7ddef95SMatthew G. Knepley {
87561f58d28SMatthew G. Knepley   PetscDS            prob;
876da97024aSMatthew G. Knepley   PetscSF            sf;
877d7ddef95SMatthew G. Knepley   DM                 dmFace, dmCell, dmGrad;
87820369375SToby Isaac   const PetscScalar *facegeom, *cellgeom = NULL, *grad;
879da97024aSMatthew G. Knepley   const PetscInt    *leaves;
880d7ddef95SMatthew G. Knepley   PetscScalar       *x, *fx;
881520b3818SMatthew G. Knepley   PetscInt           dim, nleaves, loc, fStart, fEnd, pdim, i;
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       }
103498921bdaSJacob Faibussowitsch     } else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", field);
103555f2e967SMatthew G. Knepley   }
103655f2e967SMatthew G. Knepley   PetscFunctionReturn(0);
103755f2e967SMatthew G. Knepley }
103855f2e967SMatthew G. Knepley 
103956cf3b9cSMatthew G. Knepley PetscErrorCode DMPlexInsertTimeDerivativeBoundaryValues_Plex(DM dm, PetscBool insertEssential, Vec locX, PetscReal time, Vec faceGeomFVM, Vec cellGeomFVM, Vec gradFVM)
104056cf3b9cSMatthew G. Knepley {
104156cf3b9cSMatthew G. Knepley   PetscObject    isZero;
104256cf3b9cSMatthew G. Knepley   PetscDS        prob;
104356cf3b9cSMatthew G. Knepley   PetscInt       numBd, b;
104456cf3b9cSMatthew G. Knepley 
104556cf3b9cSMatthew G. Knepley   PetscFunctionBegin;
104656cf3b9cSMatthew G. Knepley   if (!locX) PetscFunctionReturn(0);
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       }
109298921bdaSJacob Faibussowitsch     } else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", field);
109356cf3b9cSMatthew G. Knepley   }
109456cf3b9cSMatthew G. Knepley   PetscFunctionReturn(0);
109556cf3b9cSMatthew G. Knepley }
109656cf3b9cSMatthew G. Knepley 
1097f1d73a7aSMatthew G. Knepley /*@
1098f1d73a7aSMatthew G. Knepley   DMPlexInsertBoundaryValues - Puts coefficients which represent boundary values into the local solution vector
1099f1d73a7aSMatthew G. Knepley 
1100ed808b8fSJed Brown   Not Collective
1101ed808b8fSJed Brown 
1102f1d73a7aSMatthew G. Knepley   Input Parameters:
1103f1d73a7aSMatthew G. Knepley + dm - The DM
1104f1d73a7aSMatthew G. Knepley . insertEssential - Should I insert essential (e.g. Dirichlet) or inessential (e.g. Neumann) boundary conditions
1105f1d73a7aSMatthew G. Knepley . time - The time
1106f1d73a7aSMatthew G. Knepley . faceGeomFVM - Face geometry data for FV discretizations
1107f1d73a7aSMatthew G. Knepley . cellGeomFVM - Cell geometry data for FV discretizations
1108f1d73a7aSMatthew G. Knepley - gradFVM - Gradient reconstruction data for FV discretizations
1109f1d73a7aSMatthew G. Knepley 
1110f1d73a7aSMatthew G. Knepley   Output Parameters:
1111f1d73a7aSMatthew G. Knepley . locX - Solution updated with boundary values
1112f1d73a7aSMatthew G. Knepley 
1113ed808b8fSJed Brown   Level: intermediate
1114f1d73a7aSMatthew G. Knepley 
1115ed808b8fSJed Brown .seealso: DMProjectFunctionLabelLocal(), DMAddBoundary()
1116f1d73a7aSMatthew G. Knepley @*/
1117f1d73a7aSMatthew G. Knepley PetscErrorCode DMPlexInsertBoundaryValues(DM dm, PetscBool insertEssential, Vec locX, PetscReal time, Vec faceGeomFVM, Vec cellGeomFVM, Vec gradFVM)
1118f1d73a7aSMatthew G. Knepley {
1119f1d73a7aSMatthew G. Knepley   PetscFunctionBegin;
1120f1d73a7aSMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
1121064a246eSJacob Faibussowitsch   PetscValidHeaderSpecific(locX, VEC_CLASSID, 3);
1122064a246eSJacob Faibussowitsch   if (faceGeomFVM) {PetscValidHeaderSpecific(faceGeomFVM, VEC_CLASSID, 5);}
1123064a246eSJacob Faibussowitsch   if (cellGeomFVM) {PetscValidHeaderSpecific(cellGeomFVM, VEC_CLASSID, 6);}
1124064a246eSJacob Faibussowitsch   if (gradFVM)     {PetscValidHeaderSpecific(gradFVM, VEC_CLASSID, 7);}
1125*cac4c232SBarry 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 
114556cf3b9cSMatthew G. Knepley .seealso: DMProjectFunctionLabelLocal()
114656cf3b9cSMatthew G. Knepley @*/
114756cf3b9cSMatthew G. Knepley PetscErrorCode DMPlexInsertTimeDerivativeBoundaryValues(DM dm, PetscBool insertEssential, Vec locX_t, PetscReal time, Vec faceGeomFVM, Vec cellGeomFVM, Vec gradFVM)
114856cf3b9cSMatthew G. Knepley {
114956cf3b9cSMatthew G. Knepley   PetscFunctionBegin;
115056cf3b9cSMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
1151064a246eSJacob Faibussowitsch   if (locX_t)      {PetscValidHeaderSpecific(locX_t, VEC_CLASSID, 3);}
1152064a246eSJacob Faibussowitsch   if (faceGeomFVM) {PetscValidHeaderSpecific(faceGeomFVM, VEC_CLASSID, 5);}
1153064a246eSJacob Faibussowitsch   if (cellGeomFVM) {PetscValidHeaderSpecific(cellGeomFVM, VEC_CLASSID, 6);}
1154064a246eSJacob Faibussowitsch   if (gradFVM)     {PetscValidHeaderSpecific(gradFVM, VEC_CLASSID, 7);}
1155*cac4c232SBarry 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 
1190574a98acSMatthew G. Knepley .seealso: DMProjectFunction(), DMComputeL2FieldDiff(), DMComputeL2GradientDiff()
1191574a98acSMatthew G. Knepley @*/
1192574a98acSMatthew G. Knepley PetscErrorCode DMPlexComputeL2DiffLocal(DM dm, PetscReal time, PetscErrorCode (**funcs)(PetscInt, PetscReal, const PetscReal [], PetscInt, PetscScalar *, void *), void **ctxs, Vec localX, PetscReal *diff)
1193574a98acSMatthew G. Knepley {
11940f09c10fSMatthew G. Knepley   const PetscInt   debug = ((DM_Plex*)dm->data)->printL2;
1195ca3d3a14SMatthew G. Knepley   DM               tdm;
1196ca3d3a14SMatthew G. Knepley   Vec              tv;
1197cb1e1211SMatthew G Knepley   PetscSection     section;
1198c5bbbd5bSMatthew G. Knepley   PetscQuadrature  quad;
11994bee2e38SMatthew G. Knepley   PetscFEGeom      fegeom;
120015496722SMatthew G. Knepley   PetscScalar     *funcVal, *interpolant;
12014bee2e38SMatthew G. Knepley   PetscReal       *coords, *gcoords;
1202cb1e1211SMatthew G Knepley   PetscReal        localDiff = 0.0;
12037318780aSToby Isaac   const PetscReal *quadWeights;
1204412e9a14SMatthew G. Knepley   PetscInt         dim, coordDim, numFields, numComponents = 0, qNc, Nq, cellHeight, cStart, cEnd, c, field, fieldOffset;
1205ca3d3a14SMatthew G. Knepley   PetscBool        transform;
1206cb1e1211SMatthew G Knepley   PetscErrorCode   ierr;
1207cb1e1211SMatthew G Knepley 
1208cb1e1211SMatthew G Knepley   PetscFunctionBegin;
12099566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
12109566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateDim(dm, &coordDim));
12112a4e142eSMatthew G. Knepley   fegeom.dimEmbed = coordDim;
12129566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
12139566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetNumFields(section, &numFields));
12149566063dSJacob Faibussowitsch   PetscCall(DMGetBasisTransformDM_Internal(dm, &tdm));
12159566063dSJacob Faibussowitsch   PetscCall(DMGetBasisTransformVec_Internal(dm, &tv));
12169566063dSJacob Faibussowitsch   PetscCall(DMHasBasisTransform(dm, &transform));
1217cb1e1211SMatthew G Knepley   for (field = 0; field < numFields; ++field) {
121815496722SMatthew G. Knepley     PetscObject  obj;
121915496722SMatthew G. Knepley     PetscClassId id;
1220c5bbbd5bSMatthew G. Knepley     PetscInt     Nc;
1221c5bbbd5bSMatthew G. Knepley 
12229566063dSJacob Faibussowitsch     PetscCall(DMGetField(dm, field, NULL, &obj));
12239566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
122415496722SMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
122515496722SMatthew G. Knepley       PetscFE fe = (PetscFE) obj;
122615496722SMatthew G. Knepley 
12279566063dSJacob Faibussowitsch       PetscCall(PetscFEGetQuadrature(fe, &quad));
12289566063dSJacob Faibussowitsch       PetscCall(PetscFEGetNumComponents(fe, &Nc));
122915496722SMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
123015496722SMatthew G. Knepley       PetscFV fv = (PetscFV) obj;
123115496722SMatthew G. Knepley 
12329566063dSJacob Faibussowitsch       PetscCall(PetscFVGetQuadrature(fv, &quad));
12339566063dSJacob Faibussowitsch       PetscCall(PetscFVGetNumComponents(fv, &Nc));
123498921bdaSJacob Faibussowitsch     } else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", field);
1235c5bbbd5bSMatthew G. Knepley     numComponents += Nc;
1236cb1e1211SMatthew G Knepley   }
12379566063dSJacob Faibussowitsch   PetscCall(PetscQuadratureGetData(quad, NULL, &qNc, &Nq, NULL, &quadWeights));
12382c71b3e2SJacob Faibussowitsch   PetscCheckFalse((qNc != 1) && (qNc != numComponents),PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_SIZ, "Quadrature components %D != %D field components", qNc, numComponents);
12399566063dSJacob Faibussowitsch   PetscCall(PetscMalloc6(numComponents,&funcVal,numComponents,&interpolant,coordDim*Nq,&coords,Nq,&fegeom.detJ,coordDim*coordDim*Nq,&fegeom.J,coordDim*coordDim*Nq,&fegeom.invJ));
12409566063dSJacob Faibussowitsch   PetscCall(DMPlexGetVTKCellHeight(dm, &cellHeight));
12419566063dSJacob Faibussowitsch   PetscCall(DMPlexGetSimplexOrBoxCells(dm, cellHeight, &cStart, &cEnd));
1242cb1e1211SMatthew G Knepley   for (c = cStart; c < cEnd; ++c) {
1243a1e44745SMatthew G. Knepley     PetscScalar *x = NULL;
1244cb1e1211SMatthew G Knepley     PetscReal    elemDiff = 0.0;
12459c3cf19fSMatthew G. Knepley     PetscInt     qc = 0;
1246cb1e1211SMatthew G Knepley 
12479566063dSJacob Faibussowitsch     PetscCall(DMPlexComputeCellGeometryFEM(dm, c, quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
12489566063dSJacob Faibussowitsch     PetscCall(DMPlexVecGetClosure(dm, NULL, localX, c, NULL, &x));
1249cb1e1211SMatthew G Knepley 
125015496722SMatthew G. Knepley     for (field = 0, fieldOffset = 0; field < numFields; ++field) {
125115496722SMatthew G. Knepley       PetscObject  obj;
125215496722SMatthew G. Knepley       PetscClassId id;
1253c110b1eeSGeoffrey Irving       void * const ctx = ctxs ? ctxs[field] : NULL;
125415496722SMatthew G. Knepley       PetscInt     Nb, Nc, q, fc;
1255cb1e1211SMatthew G Knepley 
12569566063dSJacob Faibussowitsch       PetscCall(DMGetField(dm, field, NULL, &obj));
12579566063dSJacob Faibussowitsch       PetscCall(PetscObjectGetClassId(obj, &id));
12589566063dSJacob Faibussowitsch       if (id == PETSCFE_CLASSID)      {PetscCall(PetscFEGetNumComponents((PetscFE) obj, &Nc));PetscCall(PetscFEGetDimension((PetscFE) obj, &Nb));}
12599566063dSJacob Faibussowitsch       else if (id == PETSCFV_CLASSID) {PetscCall(PetscFVGetNumComponents((PetscFV) obj, &Nc));Nb = 1;}
126098921bdaSJacob Faibussowitsch       else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", field);
1261cb1e1211SMatthew G Knepley       if (debug) {
1262cb1e1211SMatthew G Knepley         char title[1024];
12639566063dSJacob Faibussowitsch         PetscCall(PetscSNPrintf(title, 1023, "Solution for Field %D", field));
12649566063dSJacob Faibussowitsch         PetscCall(DMPrintCellVector(c, title, Nb, &x[fieldOffset]));
1265cb1e1211SMatthew G Knepley       }
12667318780aSToby Isaac       for (q = 0; q < Nq; ++q) {
12672a4e142eSMatthew G. Knepley         PetscFEGeom qgeom;
12682a4e142eSMatthew G. Knepley 
12692a4e142eSMatthew G. Knepley         qgeom.dimEmbed = fegeom.dimEmbed;
12702a4e142eSMatthew G. Knepley         qgeom.J        = &fegeom.J[q*coordDim*coordDim];
12712a4e142eSMatthew G. Knepley         qgeom.invJ     = &fegeom.invJ[q*coordDim*coordDim];
12722a4e142eSMatthew G. Knepley         qgeom.detJ     = &fegeom.detJ[q];
12735f80ce2aSJacob Faibussowitsch         PetscCheck(fegeom.detJ[q] > 0.0,PETSC_COMM_SELF, PETSC_ERR_ARG_OUTOFRANGE, "Invalid determinant %g for element %D, point %D", (double)fegeom.detJ[q], c, q);
1274d3a7d86cSMatthew G. Knepley         if (transform) {
1275d3a7d86cSMatthew G. Knepley           gcoords = &coords[coordDim*Nq];
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));
12869566063dSJacob Faibussowitsch           PetscCall(ierr);
1287e735a8a9SMatthew G. Knepley         }
12889566063dSJacob Faibussowitsch         if (transform) PetscCall(DMPlexBasisTransformApply_Internal(dm, &coords[coordDim*q], PETSC_FALSE, Nc, funcVal, funcVal, dm->transformCtx));
12899566063dSJacob Faibussowitsch         if (id == PETSCFE_CLASSID)      PetscCall(PetscFEInterpolate_Static((PetscFE) obj, &x[fieldOffset], &qgeom, q, interpolant));
12909566063dSJacob Faibussowitsch         else if (id == PETSCFV_CLASSID) PetscCall(PetscFVInterpolate_Static((PetscFV) obj, &x[fieldOffset], q, interpolant));
12912df84da0SMatthew G. Knepley         else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, field);
129215496722SMatthew G. Knepley         for (fc = 0; fc < Nc; ++fc) {
1293beaa55a6SMatthew G. Knepley           const PetscReal wt = quadWeights[q*qNc+(qNc == 1 ? 0 : qc+fc)];
12949566063dSJacob 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]), PetscRealPart(interpolant[fc]), PetscRealPart(funcVal[fc])));
12954bee2e38SMatthew G. Knepley           elemDiff += PetscSqr(PetscRealPart(interpolant[fc] - funcVal[fc]))*wt*fegeom.detJ[q];
1296cb1e1211SMatthew G Knepley         }
1297cb1e1211SMatthew G Knepley       }
12989c3cf19fSMatthew G. Knepley       fieldOffset += Nb;
1299beaa55a6SMatthew G. Knepley       qc += Nc;
1300cb1e1211SMatthew G Knepley     }
13019566063dSJacob Faibussowitsch     PetscCall(DMPlexVecRestoreClosure(dm, NULL, localX, c, NULL, &x));
13029566063dSJacob Faibussowitsch     if (debug) PetscCall(PetscPrintf(PETSC_COMM_SELF, "  elem %" PetscInt_FMT " diff %g\n", c, (double)elemDiff));
1303cb1e1211SMatthew G Knepley     localDiff += elemDiff;
1304cb1e1211SMatthew G Knepley   }
13059566063dSJacob Faibussowitsch   PetscCall(PetscFree6(funcVal,interpolant,coords,fegeom.detJ,fegeom.J,fegeom.invJ));
13069566063dSJacob Faibussowitsch   PetscCallMPI(MPIU_Allreduce(&localDiff, diff, 1, MPIU_REAL, MPIU_SUM, PetscObjectComm((PetscObject)dm)));
1307cb1e1211SMatthew G Knepley   *diff = PetscSqrtReal(*diff);
1308cb1e1211SMatthew G Knepley   PetscFunctionReturn(0);
1309cb1e1211SMatthew G Knepley }
1310cb1e1211SMatthew G Knepley 
1311b698f381SToby Isaac PetscErrorCode DMComputeL2GradientDiff_Plex(DM dm, PetscReal time, PetscErrorCode (**funcs)(PetscInt, PetscReal, const PetscReal [], const PetscReal [], PetscInt, PetscScalar *, void *), void **ctxs, Vec X, const PetscReal n[], PetscReal *diff)
1312cb1e1211SMatthew G Knepley {
13130f09c10fSMatthew G. Knepley   const PetscInt   debug = ((DM_Plex*)dm->data)->printL2;
1314ca3d3a14SMatthew G. Knepley   DM               tdm;
1315cb1e1211SMatthew G Knepley   PetscSection     section;
131640e14135SMatthew G. Knepley   PetscQuadrature  quad;
1317ca3d3a14SMatthew G. Knepley   Vec              localX, tv;
13189c3cf19fSMatthew G. Knepley   PetscScalar     *funcVal, *interpolant;
13192a4e142eSMatthew G. Knepley   const PetscReal *quadWeights;
13204bee2e38SMatthew G. Knepley   PetscFEGeom      fegeom;
13214bee2e38SMatthew G. Knepley   PetscReal       *coords, *gcoords;
132240e14135SMatthew G. Knepley   PetscReal        localDiff = 0.0;
1323485ad865SMatthew G. Knepley   PetscInt         dim, coordDim, qNc = 0, Nq = 0, numFields, numComponents = 0, cStart, cEnd, c, field, fieldOffset;
1324ca3d3a14SMatthew G. Knepley   PetscBool        transform;
1325cb1e1211SMatthew G Knepley   PetscErrorCode   ierr;
1326cb1e1211SMatthew G Knepley 
1327cb1e1211SMatthew G Knepley   PetscFunctionBegin;
13289566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
13299566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateDim(dm, &coordDim));
13304bee2e38SMatthew G. Knepley   fegeom.dimEmbed = coordDim;
13319566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
13329566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetNumFields(section, &numFields));
13339566063dSJacob Faibussowitsch   PetscCall(DMGetLocalVector(dm, &localX));
13349566063dSJacob Faibussowitsch   PetscCall(DMGlobalToLocalBegin(dm, X, INSERT_VALUES, localX));
13359566063dSJacob Faibussowitsch   PetscCall(DMGlobalToLocalEnd(dm, X, INSERT_VALUES, localX));
13369566063dSJacob Faibussowitsch   PetscCall(DMGetBasisTransformDM_Internal(dm, &tdm));
13379566063dSJacob Faibussowitsch   PetscCall(DMGetBasisTransformVec_Internal(dm, &tv));
13389566063dSJacob Faibussowitsch   PetscCall(DMHasBasisTransform(dm, &transform));
1339652b88e8SMatthew G. Knepley   for (field = 0; field < numFields; ++field) {
13400f2d7e86SMatthew G. Knepley     PetscFE  fe;
134140e14135SMatthew G. Knepley     PetscInt Nc;
1342652b88e8SMatthew G. Knepley 
13439566063dSJacob Faibussowitsch     PetscCall(DMGetField(dm, field, NULL, (PetscObject *) &fe));
13449566063dSJacob Faibussowitsch     PetscCall(PetscFEGetQuadrature(fe, &quad));
13459566063dSJacob Faibussowitsch     PetscCall(PetscFEGetNumComponents(fe, &Nc));
134640e14135SMatthew G. Knepley     numComponents += Nc;
1347652b88e8SMatthew G. Knepley   }
13489566063dSJacob Faibussowitsch   PetscCall(PetscQuadratureGetData(quad, NULL, &qNc, &Nq, NULL, &quadWeights));
13492c71b3e2SJacob Faibussowitsch   PetscCheckFalse((qNc != 1) && (qNc != numComponents),PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_SIZ, "Quadrature components %D != %D field components", qNc, numComponents);
13509566063dSJacob Faibussowitsch   /* PetscCall(DMProjectFunctionLocal(dm, fe, funcs, INSERT_BC_VALUES, localX)); */
13519566063dSJacob Faibussowitsch   PetscCall(PetscMalloc6(numComponents,&funcVal,coordDim*Nq,&coords,coordDim*coordDim*Nq,&fegeom.J,coordDim*coordDim*Nq,&fegeom.invJ,numComponents*coordDim,&interpolant,Nq,&fegeom.detJ));
13529566063dSJacob Faibussowitsch   PetscCall(DMPlexGetSimplexOrBoxCells(dm, 0, &cStart, &cEnd));
135340e14135SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
135440e14135SMatthew G. Knepley     PetscScalar *x = NULL;
135540e14135SMatthew G. Knepley     PetscReal    elemDiff = 0.0;
13569c3cf19fSMatthew G. Knepley     PetscInt     qc = 0;
1357652b88e8SMatthew G. Knepley 
13589566063dSJacob Faibussowitsch     PetscCall(DMPlexComputeCellGeometryFEM(dm, c, quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
13599566063dSJacob Faibussowitsch     PetscCall(DMPlexVecGetClosure(dm, NULL, localX, c, NULL, &x));
136040e14135SMatthew G. Knepley 
13619c3cf19fSMatthew G. Knepley     for (field = 0, fieldOffset = 0; field < numFields; ++field) {
13620f2d7e86SMatthew G. Knepley       PetscFE          fe;
136351259fa3SMatthew G. Knepley       void * const     ctx = ctxs ? ctxs[field] : NULL;
13649c3cf19fSMatthew G. Knepley       PetscInt         Nb, Nc, q, fc;
136540e14135SMatthew G. Knepley 
13669566063dSJacob Faibussowitsch       PetscCall(DMGetField(dm, field, NULL, (PetscObject *) &fe));
13679566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDimension(fe, &Nb));
13689566063dSJacob Faibussowitsch       PetscCall(PetscFEGetNumComponents(fe, &Nc));
136940e14135SMatthew G. Knepley       if (debug) {
137040e14135SMatthew G. Knepley         char title[1024];
13719566063dSJacob Faibussowitsch         PetscCall(PetscSNPrintf(title, 1023, "Solution for Field %" PetscInt_FMT, field));
13729566063dSJacob Faibussowitsch         PetscCall(DMPrintCellVector(c, title, Nb, &x[fieldOffset]));
1373652b88e8SMatthew G. Knepley       }
13749c3cf19fSMatthew G. Knepley       for (q = 0; q < Nq; ++q) {
13752a4e142eSMatthew G. Knepley         PetscFEGeom qgeom;
13762a4e142eSMatthew G. Knepley 
13772a4e142eSMatthew G. Knepley         qgeom.dimEmbed = fegeom.dimEmbed;
13782a4e142eSMatthew G. Knepley         qgeom.J        = &fegeom.J[q*coordDim*coordDim];
13792a4e142eSMatthew G. Knepley         qgeom.invJ     = &fegeom.invJ[q*coordDim*coordDim];
13802a4e142eSMatthew G. Knepley         qgeom.detJ     = &fegeom.detJ[q];
13812df84da0SMatthew G. Knepley         PetscCheck(fegeom.detJ[q] > 0.0, PETSC_COMM_SELF, PETSC_ERR_ARG_OUTOFRANGE, "Invalid determinant %g for element %" PetscInt_FMT ", quadrature points %" PetscInt_FMT, (double)fegeom.detJ[q], c, q);
1382d3a7d86cSMatthew G. Knepley         if (transform) {
1383d3a7d86cSMatthew G. Knepley           gcoords = &coords[coordDim*Nq];
13849566063dSJacob Faibussowitsch           PetscCall(DMPlexBasisTransformApplyReal_Internal(dm, &coords[coordDim*q], PETSC_TRUE, coordDim, &coords[coordDim*q], gcoords, dm->transformCtx));
1385d3a7d86cSMatthew G. Knepley         } else {
1386d3a7d86cSMatthew G. Knepley           gcoords = &coords[coordDim*q];
1387d3a7d86cSMatthew G. Knepley         }
13889566063dSJacob Faibussowitsch         PetscCall(PetscArrayzero(funcVal,Nc));
13894bee2e38SMatthew G. Knepley         ierr = (*funcs[field])(coordDim, time, gcoords, n, Nc, funcVal, ctx);
1390e735a8a9SMatthew G. Knepley         if (ierr) {
13919566063dSJacob Faibussowitsch           PetscCall(DMPlexVecRestoreClosure(dm, NULL, localX, c, NULL, &x));
13929566063dSJacob Faibussowitsch           PetscCall(DMRestoreLocalVector(dm, &localX));
13939566063dSJacob Faibussowitsch           PetscCall(PetscFree6(funcVal,coords,fegeom.J,fegeom.invJ,interpolant,fegeom.detJ));
13949566063dSJacob Faibussowitsch           PetscCall(ierr);
1395e735a8a9SMatthew G. Knepley         }
13969566063dSJacob Faibussowitsch         if (transform) PetscCall(DMPlexBasisTransformApply_Internal(dm, &coords[coordDim*q], PETSC_FALSE, Nc, funcVal, funcVal, dm->transformCtx));
13979566063dSJacob Faibussowitsch         PetscCall(PetscFEInterpolateGradient_Static(fe, 1, &x[fieldOffset], &qgeom, q, interpolant));
13984bee2e38SMatthew G. Knepley         /* Overwrite with the dot product if the normal is given */
13994bee2e38SMatthew G. Knepley         if (n) {
14004bee2e38SMatthew G. Knepley           for (fc = 0; fc < Nc; ++fc) {
14014bee2e38SMatthew G. Knepley             PetscScalar sum = 0.0;
14024bee2e38SMatthew G. Knepley             PetscInt    d;
14034bee2e38SMatthew G. Knepley             for (d = 0; d < dim; ++d) sum += interpolant[fc*dim+d]*n[d];
14044bee2e38SMatthew G. Knepley             interpolant[fc] = sum;
14054bee2e38SMatthew G. Knepley           }
14064bee2e38SMatthew G. Knepley         }
14079c3cf19fSMatthew G. Knepley         for (fc = 0; fc < Nc; ++fc) {
1408beaa55a6SMatthew G. Knepley           const PetscReal wt = quadWeights[q*qNc+(qNc == 1 ? 0 : qc+fc)];
14099566063dSJacob Faibussowitsch           if (debug) PetscCall(PetscPrintf(PETSC_COMM_SELF, "    elem %D fieldDer %D,%D diff %g\n", c, field, fc, (double)(PetscSqr(PetscRealPart(interpolant[fc] - funcVal[fc]))*wt*fegeom.detJ[q])));
14104bee2e38SMatthew G. Knepley           elemDiff += PetscSqr(PetscRealPart(interpolant[fc] - funcVal[fc]))*wt*fegeom.detJ[q];
141140e14135SMatthew G. Knepley         }
141240e14135SMatthew G. Knepley       }
14139c3cf19fSMatthew G. Knepley       fieldOffset += Nb;
14149c3cf19fSMatthew G. Knepley       qc          += Nc;
141540e14135SMatthew G. Knepley     }
14169566063dSJacob Faibussowitsch     PetscCall(DMPlexVecRestoreClosure(dm, NULL, localX, c, NULL, &x));
14179566063dSJacob Faibussowitsch     if (debug) PetscCall(PetscPrintf(PETSC_COMM_SELF, "  elem %D diff %g\n", c, (double)elemDiff));
141840e14135SMatthew G. Knepley     localDiff += elemDiff;
141940e14135SMatthew G. Knepley   }
14209566063dSJacob Faibussowitsch   PetscCall(PetscFree6(funcVal,coords,fegeom.J,fegeom.invJ,interpolant,fegeom.detJ));
14219566063dSJacob Faibussowitsch   PetscCall(DMRestoreLocalVector(dm, &localX));
14229566063dSJacob Faibussowitsch   PetscCallMPI(MPIU_Allreduce(&localDiff, diff, 1, MPIU_REAL, MPIU_SUM, PetscObjectComm((PetscObject)dm)));
142340e14135SMatthew G. Knepley   *diff = PetscSqrtReal(*diff);
1424cb1e1211SMatthew G Knepley   PetscFunctionReturn(0);
1425cb1e1211SMatthew G Knepley }
1426cb1e1211SMatthew G Knepley 
1427c6eecec3SToby Isaac PetscErrorCode DMComputeL2FieldDiff_Plex(DM dm, PetscReal time, PetscErrorCode (**funcs)(PetscInt, PetscReal, const PetscReal [], PetscInt, PetscScalar *, void *), void **ctxs, Vec X, PetscReal *diff)
142873d901b8SMatthew G. Knepley {
14290f09c10fSMatthew G. Knepley   const PetscInt   debug = ((DM_Plex*)dm->data)->printL2;
1430ca3d3a14SMatthew G. Knepley   DM               tdm;
1431083401c6SMatthew G. Knepley   DMLabel          depthLabel;
143273d901b8SMatthew G. Knepley   PetscSection     section;
1433ca3d3a14SMatthew G. Knepley   Vec              localX, tv;
143473d901b8SMatthew G. Knepley   PetscReal       *localDiff;
1435083401c6SMatthew G. Knepley   PetscInt         dim, depth, dE, Nf, f, Nds, s;
1436ca3d3a14SMatthew G. Knepley   PetscBool        transform;
143773d901b8SMatthew G. Knepley   PetscErrorCode   ierr;
143873d901b8SMatthew G. Knepley 
143973d901b8SMatthew G. Knepley   PetscFunctionBegin;
14409566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
14419566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateDim(dm, &dE));
14429566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
14439566063dSJacob Faibussowitsch   PetscCall(DMGetLocalVector(dm, &localX));
14449566063dSJacob Faibussowitsch   PetscCall(DMGetBasisTransformDM_Internal(dm, &tdm));
14459566063dSJacob Faibussowitsch   PetscCall(DMGetBasisTransformVec_Internal(dm, &tv));
14469566063dSJacob Faibussowitsch   PetscCall(DMHasBasisTransform(dm, &transform));
14479566063dSJacob Faibussowitsch   PetscCall(DMGetNumFields(dm, &Nf));
14489566063dSJacob Faibussowitsch   PetscCall(DMPlexGetDepthLabel(dm, &depthLabel));
14499566063dSJacob Faibussowitsch   PetscCall(DMLabelGetNumValues(depthLabel, &depth));
1450083401c6SMatthew G. Knepley 
14519566063dSJacob Faibussowitsch   PetscCall(VecSet(localX, 0.0));
14529566063dSJacob Faibussowitsch   PetscCall(DMGlobalToLocalBegin(dm, X, INSERT_VALUES, localX));
14539566063dSJacob Faibussowitsch   PetscCall(DMGlobalToLocalEnd(dm, X, INSERT_VALUES, localX));
14549566063dSJacob Faibussowitsch   PetscCall(DMProjectFunctionLocal(dm, time, funcs, ctxs, INSERT_BC_VALUES, localX));
14559566063dSJacob Faibussowitsch   PetscCall(DMGetNumDS(dm, &Nds));
14569566063dSJacob Faibussowitsch   PetscCall(PetscCalloc1(Nf, &localDiff));
1457083401c6SMatthew G. Knepley   for (s = 0; s < Nds; ++s) {
1458083401c6SMatthew G. Knepley     PetscDS          ds;
1459083401c6SMatthew G. Knepley     DMLabel          label;
1460083401c6SMatthew G. Knepley     IS               fieldIS, pointIS;
1461083401c6SMatthew G. Knepley     const PetscInt  *fields, *points = NULL;
1462083401c6SMatthew G. Knepley     PetscQuadrature  quad;
1463083401c6SMatthew G. Knepley     const PetscReal *quadPoints, *quadWeights;
1464083401c6SMatthew G. Knepley     PetscFEGeom      fegeom;
1465083401c6SMatthew G. Knepley     PetscReal       *coords, *gcoords;
1466083401c6SMatthew G. Knepley     PetscScalar     *funcVal, *interpolant;
14675fedec97SMatthew G. Knepley     PetscBool        isCohesive;
1468083401c6SMatthew G. Knepley     PetscInt         qNc, Nq, totNc, cStart = 0, cEnd, c, dsNf;
146973d901b8SMatthew G. Knepley 
14709566063dSJacob Faibussowitsch     PetscCall(DMGetRegionNumDS(dm, s, &label, &fieldIS, &ds));
14719566063dSJacob Faibussowitsch     PetscCall(ISGetIndices(fieldIS, &fields));
14729566063dSJacob Faibussowitsch     PetscCall(PetscDSIsCohesive(ds, &isCohesive));
14739566063dSJacob Faibussowitsch     PetscCall(PetscDSGetNumFields(ds, &dsNf));
14749566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalComponents(ds, &totNc));
14759566063dSJacob Faibussowitsch     PetscCall(PetscDSGetQuadrature(ds, &quad));
14769566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureGetData(quad, NULL, &qNc, &Nq, &quadPoints, &quadWeights));
14772c71b3e2SJacob Faibussowitsch     PetscCheckFalse((qNc != 1) && (qNc != totNc),PETSC_COMM_SELF, PETSC_ERR_ARG_SIZ, "Quadrature components %D != %D field components", qNc, totNc);
14789566063dSJacob Faibussowitsch     PetscCall(PetscCalloc6(totNc, &funcVal, totNc, &interpolant, dE*(Nq+1), &coords,Nq, &fegeom.detJ, dE*dE*Nq, &fegeom.J, dE*dE*Nq, &fegeom.invJ));
1479083401c6SMatthew G. Knepley     if (!label) {
14809566063dSJacob Faibussowitsch       PetscCall(DMPlexGetSimplexOrBoxCells(dm, 0, &cStart, &cEnd));
1481083401c6SMatthew G. Knepley     } else {
14829566063dSJacob Faibussowitsch       PetscCall(DMLabelGetStratumIS(label, 1, &pointIS));
14839566063dSJacob Faibussowitsch       PetscCall(ISGetLocalSize(pointIS, &cEnd));
14849566063dSJacob Faibussowitsch       PetscCall(ISGetIndices(pointIS, &points));
1485083401c6SMatthew G. Knepley     }
148673d901b8SMatthew G. Knepley     for (c = cStart; c < cEnd; ++c) {
1487083401c6SMatthew G. Knepley       const PetscInt cell  = points ? points[c] : c;
148873d901b8SMatthew G. Knepley       PetscScalar    *x    = NULL;
14895fedec97SMatthew G. Knepley       const PetscInt *cone;
14905fedec97SMatthew G. Knepley       PetscInt        qc   = 0, fOff = 0, dep;
149173d901b8SMatthew G. Knepley 
14929566063dSJacob Faibussowitsch       PetscCall(DMLabelGetValue(depthLabel, cell, &dep));
1493083401c6SMatthew G. Knepley       if (dep != depth-1) continue;
14945fedec97SMatthew G. Knepley       if (isCohesive) {
14959566063dSJacob Faibussowitsch         PetscCall(DMPlexGetCone(dm, cell, &cone));
14969566063dSJacob Faibussowitsch         PetscCall(DMPlexComputeCellGeometryFEM(dm, cone[0], quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
149796959cd1SMatthew G. Knepley       } else {
14989566063dSJacob Faibussowitsch         PetscCall(DMPlexComputeCellGeometryFEM(dm, cell, quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
149996959cd1SMatthew G. Knepley       }
15009566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(dm, NULL, localX, cell, NULL, &x));
15015fedec97SMatthew G. Knepley       for (f = 0; f < dsNf; ++f) {
150215496722SMatthew G. Knepley         PetscObject  obj;
150315496722SMatthew G. Knepley         PetscClassId id;
1504083401c6SMatthew G. Knepley         void * const ctx = ctxs ? ctxs[fields[f]] : NULL;
150515496722SMatthew G. Knepley         PetscInt     Nb, Nc, q, fc;
150615496722SMatthew G. Knepley         PetscReal    elemDiff = 0.0;
15075fedec97SMatthew G. Knepley         PetscBool    cohesive;
150815496722SMatthew G. Knepley 
15099566063dSJacob Faibussowitsch         PetscCall(PetscDSGetCohesive(ds, f, &cohesive));
15105fedec97SMatthew G. Knepley         if (isCohesive && !cohesive) continue;
15119566063dSJacob Faibussowitsch         PetscCall(PetscDSGetDiscretization(ds, f, &obj));
15129566063dSJacob Faibussowitsch         PetscCall(PetscObjectGetClassId(obj, &id));
15139566063dSJacob Faibussowitsch         if (id == PETSCFE_CLASSID)      {PetscCall(PetscFEGetNumComponents((PetscFE) obj, &Nc));PetscCall(PetscFEGetDimension((PetscFE) obj, &Nb));}
15149566063dSJacob Faibussowitsch         else if (id == PETSCFV_CLASSID) {PetscCall(PetscFVGetNumComponents((PetscFV) obj, &Nc));Nb = 1;}
151598921bdaSJacob Faibussowitsch         else SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", fields[f]);
151673d901b8SMatthew G. Knepley         if (debug) {
151773d901b8SMatthew G. Knepley           char title[1024];
15189566063dSJacob Faibussowitsch           PetscCall(PetscSNPrintf(title, 1023, "Solution for Field %D", fields[f]));
15199566063dSJacob Faibussowitsch           PetscCall(DMPrintCellVector(cell, title, Nb, &x[fOff]));
152073d901b8SMatthew G. Knepley         }
15217318780aSToby Isaac         for (q = 0; q < Nq; ++q) {
15222a4e142eSMatthew G. Knepley           PetscFEGeom qgeom;
15232a4e142eSMatthew G. Knepley 
15242a4e142eSMatthew G. Knepley           qgeom.dimEmbed = fegeom.dimEmbed;
1525083401c6SMatthew G. Knepley           qgeom.J        = &fegeom.J[q*dE*dE];
1526083401c6SMatthew G. Knepley           qgeom.invJ     = &fegeom.invJ[q*dE*dE];
15272a4e142eSMatthew G. Knepley           qgeom.detJ     = &fegeom.detJ[q];
15285f80ce2aSJacob Faibussowitsch           PetscCheck(fegeom.detJ[q] > 0.0,PETSC_COMM_SELF, PETSC_ERR_ARG_OUTOFRANGE, "Invalid determinant %g for cell %D, quadrature point %D", (double)fegeom.detJ[q], cell, q);
1529d3a7d86cSMatthew G. Knepley           if (transform) {
1530083401c6SMatthew G. Knepley             gcoords = &coords[dE*Nq];
15319566063dSJacob Faibussowitsch             PetscCall(DMPlexBasisTransformApplyReal_Internal(dm, &coords[dE*q], PETSC_TRUE, dE, &coords[dE*q], gcoords, dm->transformCtx));
1532d3a7d86cSMatthew G. Knepley           } else {
1533083401c6SMatthew G. Knepley             gcoords = &coords[dE*q];
1534d3a7d86cSMatthew G. Knepley           }
15352df84da0SMatthew G. Knepley           for (fc = 0; fc < Nc; ++fc) funcVal[fc] = 0.;
1536083401c6SMatthew G. Knepley           ierr = (*funcs[fields[f]])(dE, time, gcoords, Nc, funcVal, ctx);
1537e735a8a9SMatthew G. Knepley           if (ierr) {
15389566063dSJacob Faibussowitsch             PetscCall(DMPlexVecRestoreClosure(dm, NULL, localX, cell, NULL, &x));
15399566063dSJacob Faibussowitsch             PetscCall(DMRestoreLocalVector(dm, &localX));
15409566063dSJacob Faibussowitsch             PetscCall(PetscFree6(funcVal,interpolant,coords,fegeom.detJ,fegeom.J,fegeom.invJ));
15419566063dSJacob Faibussowitsch             PetscCall(ierr);
1542e735a8a9SMatthew G. Knepley           }
15439566063dSJacob Faibussowitsch           if (transform) PetscCall(DMPlexBasisTransformApply_Internal(dm, &coords[dE*q], PETSC_FALSE, Nc, funcVal, funcVal, dm->transformCtx));
154496959cd1SMatthew G. Knepley           /* Call once for each face, except for lagrange field */
15459566063dSJacob Faibussowitsch           if (id == PETSCFE_CLASSID)      PetscCall(PetscFEInterpolate_Static((PetscFE) obj, &x[fOff], &qgeom, q, interpolant));
15469566063dSJacob Faibussowitsch           else if (id == PETSCFV_CLASSID) PetscCall(PetscFVInterpolate_Static((PetscFV) obj, &x[fOff], q, interpolant));
154798921bdaSJacob Faibussowitsch           else SETERRQ(PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", fields[f]);
154815496722SMatthew G. Knepley           for (fc = 0; fc < Nc; ++fc) {
1549beaa55a6SMatthew G. Knepley             const PetscReal wt = quadWeights[q*qNc+(qNc == 1 ? 0 : qc+fc)];
15509566063dSJacob Faibussowitsch             if (debug) PetscCall(PetscPrintf(PETSC_COMM_SELF, "    cell %D field %D,%D point %g %g %g diff %g\n", cell, fields[f], fc, (double)(dE > 0 ? coords[dE*q] : 0.), (double)(dE > 1 ? coords[dE*q+1] : 0.),(double)(dE > 2 ? coords[dE*q+2] : 0.), (double)(PetscSqr(PetscRealPart(interpolant[fc] - funcVal[fc]))*wt*fegeom.detJ[q])));
15514bee2e38SMatthew G. Knepley             elemDiff += PetscSqr(PetscRealPart(interpolant[fc] - funcVal[fc]))*wt*fegeom.detJ[q];
155273d901b8SMatthew G. Knepley           }
155373d901b8SMatthew G. Knepley         }
1554083401c6SMatthew G. Knepley         fOff += Nb;
15559c3cf19fSMatthew G. Knepley         qc   += Nc;
1556083401c6SMatthew G. Knepley         localDiff[fields[f]] += elemDiff;
15579566063dSJacob Faibussowitsch         if (debug) PetscCall(PetscPrintf(PETSC_COMM_SELF, "  cell %D field %D cum diff %g\n", cell, fields[f], (double)localDiff[fields[f]]));
155873d901b8SMatthew G. Knepley       }
15599566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(dm, NULL, localX, cell, NULL, &x));
1560083401c6SMatthew G. Knepley     }
1561083401c6SMatthew G. Knepley     if (label) {
15629566063dSJacob Faibussowitsch       PetscCall(ISRestoreIndices(pointIS, &points));
15639566063dSJacob Faibussowitsch       PetscCall(ISDestroy(&pointIS));
1564083401c6SMatthew G. Knepley     }
15659566063dSJacob Faibussowitsch     PetscCall(ISRestoreIndices(fieldIS, &fields));
15669566063dSJacob Faibussowitsch     PetscCall(PetscFree6(funcVal, interpolant, coords, fegeom.detJ, fegeom.J, fegeom.invJ));
156773d901b8SMatthew G. Knepley   }
15689566063dSJacob Faibussowitsch   PetscCall(DMRestoreLocalVector(dm, &localX));
15699566063dSJacob Faibussowitsch   PetscCallMPI(MPIU_Allreduce(localDiff, diff, Nf, MPIU_REAL, MPIU_SUM, PetscObjectComm((PetscObject)dm)));
15709566063dSJacob Faibussowitsch   PetscCall(PetscFree(localDiff));
1571083401c6SMatthew G. Knepley   for (f = 0; f < Nf; ++f) diff[f] = PetscSqrtReal(diff[f]);
157273d901b8SMatthew G. Knepley   PetscFunctionReturn(0);
157373d901b8SMatthew G. Knepley }
157473d901b8SMatthew G. Knepley 
1575e729f68cSMatthew G. Knepley /*@C
1576e729f68cSMatthew G. Knepley   DMPlexComputeL2DiffVec - This function computes the cellwise L_2 difference between a function u and an FEM interpolant solution u_h, and stores it in a Vec.
1577e729f68cSMatthew G. Knepley 
1578d083f849SBarry Smith   Collective on dm
1579c0f8e1fdSMatthew G. Knepley 
1580e729f68cSMatthew G. Knepley   Input Parameters:
1581e729f68cSMatthew G. Knepley + dm    - The DM
15820163fd50SMatthew G. Knepley . time  - The time
1583ca3eba1bSToby Isaac . funcs - The functions to evaluate for each field component: NULL means that component does not contribute to error calculation
1584e729f68cSMatthew G. Knepley . ctxs  - Optional array of contexts to pass to each function, or NULL.
1585e729f68cSMatthew G. Knepley - X     - The coefficient vector u_h
1586e729f68cSMatthew G. Knepley 
1587e729f68cSMatthew G. Knepley   Output Parameter:
1588e729f68cSMatthew G. Knepley . D - A Vec which holds the difference ||u - u_h||_2 for each cell
1589e729f68cSMatthew G. Knepley 
1590e729f68cSMatthew G. Knepley   Level: developer
1591e729f68cSMatthew G. Knepley 
1592b698f381SToby Isaac .seealso: DMProjectFunction(), DMComputeL2Diff(), DMPlexComputeL2FieldDiff(), DMComputeL2GradientDiff()
1593e729f68cSMatthew G. Knepley @*/
15940163fd50SMatthew G. Knepley PetscErrorCode DMPlexComputeL2DiffVec(DM dm, PetscReal time, PetscErrorCode (**funcs)(PetscInt, PetscReal, const PetscReal [], PetscInt, PetscScalar *, void *), void **ctxs, Vec X, Vec D)
1595e729f68cSMatthew G. Knepley {
1596e729f68cSMatthew G. Knepley   PetscSection     section;
1597e729f68cSMatthew G. Knepley   PetscQuadrature  quad;
1598e729f68cSMatthew G. Knepley   Vec              localX;
15994bee2e38SMatthew G. Knepley   PetscFEGeom      fegeom;
1600e729f68cSMatthew G. Knepley   PetscScalar     *funcVal, *interpolant;
16014bee2e38SMatthew G. Knepley   PetscReal       *coords;
1602e729f68cSMatthew G. Knepley   const PetscReal *quadPoints, *quadWeights;
1603485ad865SMatthew G. Knepley   PetscInt         dim, coordDim, numFields, numComponents = 0, qNc, Nq, cStart, cEnd, c, field, fieldOffset;
1604e729f68cSMatthew G. Knepley 
1605e729f68cSMatthew G. Knepley   PetscFunctionBegin;
16069566063dSJacob Faibussowitsch   PetscCall(VecSet(D, 0.0));
16079566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
16089566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateDim(dm, &coordDim));
16099566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
16109566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetNumFields(section, &numFields));
16119566063dSJacob Faibussowitsch   PetscCall(DMGetLocalVector(dm, &localX));
16129566063dSJacob Faibussowitsch   PetscCall(DMProjectFunctionLocal(dm, time, funcs, ctxs, INSERT_BC_VALUES, localX));
16139566063dSJacob Faibussowitsch   PetscCall(DMGlobalToLocalBegin(dm, X, INSERT_VALUES, localX));
16149566063dSJacob Faibussowitsch   PetscCall(DMGlobalToLocalEnd(dm, X, INSERT_VALUES, localX));
1615e729f68cSMatthew G. Knepley   for (field = 0; field < numFields; ++field) {
1616e729f68cSMatthew G. Knepley     PetscObject  obj;
1617e729f68cSMatthew G. Knepley     PetscClassId id;
1618e729f68cSMatthew G. Knepley     PetscInt     Nc;
1619e729f68cSMatthew G. Knepley 
16209566063dSJacob Faibussowitsch     PetscCall(DMGetField(dm, field, NULL, &obj));
16219566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
1622e729f68cSMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
1623e729f68cSMatthew G. Knepley       PetscFE fe = (PetscFE) obj;
1624e729f68cSMatthew G. Knepley 
16259566063dSJacob Faibussowitsch       PetscCall(PetscFEGetQuadrature(fe, &quad));
16269566063dSJacob Faibussowitsch       PetscCall(PetscFEGetNumComponents(fe, &Nc));
1627e729f68cSMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
1628e729f68cSMatthew G. Knepley       PetscFV fv = (PetscFV) obj;
1629e729f68cSMatthew G. Knepley 
16309566063dSJacob Faibussowitsch       PetscCall(PetscFVGetQuadrature(fv, &quad));
16319566063dSJacob Faibussowitsch       PetscCall(PetscFVGetNumComponents(fv, &Nc));
163298921bdaSJacob Faibussowitsch     } else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", field);
1633e729f68cSMatthew G. Knepley     numComponents += Nc;
1634e729f68cSMatthew G. Knepley   }
16359566063dSJacob Faibussowitsch   PetscCall(PetscQuadratureGetData(quad, NULL, &qNc, &Nq, &quadPoints, &quadWeights));
16362c71b3e2SJacob Faibussowitsch   PetscCheckFalse((qNc != 1) && (qNc != numComponents),PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_SIZ, "Quadrature components %D != %D field components", qNc, numComponents);
16379566063dSJacob Faibussowitsch   PetscCall(PetscMalloc6(numComponents,&funcVal,numComponents,&interpolant,coordDim*Nq,&coords,Nq,&fegeom.detJ,coordDim*coordDim*Nq,&fegeom.J,coordDim*coordDim*Nq,&fegeom.invJ));
16389566063dSJacob Faibussowitsch   PetscCall(DMPlexGetSimplexOrBoxCells(dm, 0, &cStart, &cEnd));
1639e729f68cSMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
1640e729f68cSMatthew G. Knepley     PetscScalar *x = NULL;
16416f288a59SMatthew G. Knepley     PetscScalar  elemDiff = 0.0;
16429c3cf19fSMatthew G. Knepley     PetscInt     qc = 0;
1643e729f68cSMatthew G. Knepley 
16449566063dSJacob Faibussowitsch     PetscCall(DMPlexComputeCellGeometryFEM(dm, c, quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
16459566063dSJacob Faibussowitsch     PetscCall(DMPlexVecGetClosure(dm, NULL, localX, c, NULL, &x));
1646e729f68cSMatthew G. Knepley 
1647e729f68cSMatthew G. Knepley     for (field = 0, fieldOffset = 0; field < numFields; ++field) {
1648e729f68cSMatthew G. Knepley       PetscObject  obj;
1649e729f68cSMatthew G. Knepley       PetscClassId id;
1650e729f68cSMatthew G. Knepley       void * const ctx = ctxs ? ctxs[field] : NULL;
1651e729f68cSMatthew G. Knepley       PetscInt     Nb, Nc, q, fc;
1652e729f68cSMatthew G. Knepley 
16539566063dSJacob Faibussowitsch       PetscCall(DMGetField(dm, field, NULL, &obj));
16549566063dSJacob Faibussowitsch       PetscCall(PetscObjectGetClassId(obj, &id));
16559566063dSJacob Faibussowitsch       if (id == PETSCFE_CLASSID)      {PetscCall(PetscFEGetNumComponents((PetscFE) obj, &Nc));PetscCall(PetscFEGetDimension((PetscFE) obj, &Nb));}
16569566063dSJacob Faibussowitsch       else if (id == PETSCFV_CLASSID) {PetscCall(PetscFVGetNumComponents((PetscFV) obj, &Nc));Nb = 1;}
165798921bdaSJacob Faibussowitsch       else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", field);
165823f34ed2SToby Isaac       if (funcs[field]) {
16597318780aSToby Isaac         for (q = 0; q < Nq; ++q) {
16602a4e142eSMatthew G. Knepley           PetscFEGeom qgeom;
16612a4e142eSMatthew G. Knepley 
16622a4e142eSMatthew G. Knepley           qgeom.dimEmbed = fegeom.dimEmbed;
16632a4e142eSMatthew G. Knepley           qgeom.J        = &fegeom.J[q*coordDim*coordDim];
16642a4e142eSMatthew G. Knepley           qgeom.invJ     = &fegeom.invJ[q*coordDim*coordDim];
16652a4e142eSMatthew G. Knepley           qgeom.detJ     = &fegeom.detJ[q];
16665f80ce2aSJacob Faibussowitsch           PetscCheck(fegeom.detJ[q] > 0.0,PETSC_COMM_SELF, PETSC_ERR_ARG_OUTOFRANGE, "Invalid determinant %g for element %D, quadrature points %D", (double)fegeom.detJ[q], c, q);
16679566063dSJacob Faibussowitsch           PetscCall((*funcs[field])(coordDim, time, &coords[q*coordDim], Nc, funcVal, ctx));
1668c3e24edfSBarry Smith #if defined(needs_fix_with_return_code_argument)
1669e735a8a9SMatthew G. Knepley           if (ierr) {
16709566063dSJacob Faibussowitsch             PetscCall(DMPlexVecRestoreClosure(dm, NULL, localX, c, NULL, &x));
16719566063dSJacob Faibussowitsch             PetscCall(PetscFree6(funcVal,interpolant,coords,fegeom.detJ,fegeom.J,fegeom.invJ));
16729566063dSJacob Faibussowitsch             PetscCall(DMRestoreLocalVector(dm, &localX));
1673e735a8a9SMatthew G. Knepley           }
1674c3e24edfSBarry Smith #endif
16759566063dSJacob Faibussowitsch           if (id == PETSCFE_CLASSID)      PetscCall(PetscFEInterpolate_Static((PetscFE) obj, &x[fieldOffset], &qgeom, q, interpolant));
16769566063dSJacob Faibussowitsch           else if (id == PETSCFV_CLASSID) PetscCall(PetscFVInterpolate_Static((PetscFV) obj, &x[fieldOffset], q, interpolant));
167798921bdaSJacob Faibussowitsch           else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", field);
1678e729f68cSMatthew G. Knepley           for (fc = 0; fc < Nc; ++fc) {
1679beaa55a6SMatthew G. Knepley             const PetscReal wt = quadWeights[q*qNc+(qNc == 1 ? 0 : qc+fc)];
16804bee2e38SMatthew G. Knepley             elemDiff += PetscSqr(PetscRealPart(interpolant[fc] - funcVal[fc]))*wt*fegeom.detJ[q];
1681e729f68cSMatthew G. Knepley           }
1682e729f68cSMatthew G. Knepley         }
168323f34ed2SToby Isaac       }
1684beaa55a6SMatthew G. Knepley       fieldOffset += Nb;
16859c3cf19fSMatthew G. Knepley       qc          += Nc;
1686e729f68cSMatthew G. Knepley     }
16879566063dSJacob Faibussowitsch     PetscCall(DMPlexVecRestoreClosure(dm, NULL, localX, c, NULL, &x));
16889566063dSJacob Faibussowitsch     PetscCall(VecSetValue(D, c - cStart, elemDiff, INSERT_VALUES));
1689e729f68cSMatthew G. Knepley   }
16909566063dSJacob Faibussowitsch   PetscCall(PetscFree6(funcVal,interpolant,coords,fegeom.detJ,fegeom.J,fegeom.invJ));
16919566063dSJacob Faibussowitsch   PetscCall(DMRestoreLocalVector(dm, &localX));
16929566063dSJacob Faibussowitsch   PetscCall(VecSqrtAbs(D));
1693e729f68cSMatthew G. Knepley   PetscFunctionReturn(0);
1694e729f68cSMatthew G. Knepley }
1695e729f68cSMatthew G. Knepley 
16965f0b18bfSMatthew G. Knepley /*@
16975f0b18bfSMatthew 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.
16985f0b18bfSMatthew G. Knepley 
16995f0b18bfSMatthew G. Knepley   Collective on dm
17005f0b18bfSMatthew G. Knepley 
17015f0b18bfSMatthew G. Knepley   Input Parameters:
17025f0b18bfSMatthew G. Knepley + dm - The DM
17035f0b18bfSMatthew G. Knepley - locX  - The coefficient vector u_h
17045f0b18bfSMatthew G. Knepley 
17055f0b18bfSMatthew G. Knepley   Output Parameter:
17065f0b18bfSMatthew G. Knepley . locC - A Vec which holds the Clement interpolant of the function
17075f0b18bfSMatthew G. Knepley 
17085f0b18bfSMatthew G. Knepley   Notes:
17095f0b18bfSMatthew 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
17105f0b18bfSMatthew G. Knepley 
17115f0b18bfSMatthew G. Knepley   Level: developer
17125f0b18bfSMatthew G. Knepley 
17135f0b18bfSMatthew G. Knepley .seealso: DMProjectFunction(), DMComputeL2Diff(), DMPlexComputeL2FieldDiff(), DMComputeL2GradientDiff()
17145f0b18bfSMatthew G. Knepley @*/
17155f0b18bfSMatthew G. Knepley PetscErrorCode DMPlexComputeClementInterpolant(DM dm, Vec locX, Vec locC)
17165f0b18bfSMatthew G. Knepley {
17175f0b18bfSMatthew G. Knepley   PetscInt         debug = ((DM_Plex *) dm->data)->printFEM;
17185f0b18bfSMatthew G. Knepley   DM               dmc;
17195f0b18bfSMatthew G. Knepley   PetscQuadrature  quad;
17205f0b18bfSMatthew G. Knepley   PetscScalar     *interpolant, *valsum;
17215f0b18bfSMatthew G. Knepley   PetscFEGeom      fegeom;
17225f0b18bfSMatthew G. Knepley   PetscReal       *coords;
17235f0b18bfSMatthew G. Knepley   const PetscReal *quadPoints, *quadWeights;
17245f0b18bfSMatthew G. Knepley   PetscInt         dim, cdim, Nf, f, Nc = 0, Nq, qNc, cStart, cEnd, vStart, vEnd, v;
17255f0b18bfSMatthew G. Knepley 
17265f0b18bfSMatthew G. Knepley   PetscFunctionBegin;
17279566063dSJacob Faibussowitsch   PetscCall(PetscCitationsRegister(ClementCitation, &Clementcite));
17289566063dSJacob Faibussowitsch   PetscCall(VecGetDM(locC, &dmc));
17299566063dSJacob Faibussowitsch   PetscCall(VecSet(locC, 0.0));
17309566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
17319566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateDim(dm, &cdim));
17325f0b18bfSMatthew G. Knepley   fegeom.dimEmbed = cdim;
17339566063dSJacob Faibussowitsch   PetscCall(DMGetNumFields(dm, &Nf));
17345f0b18bfSMatthew G. Knepley   PetscCheck(Nf > 0, PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of fields is zero!");
17355f0b18bfSMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
17365f0b18bfSMatthew G. Knepley     PetscObject  obj;
17375f0b18bfSMatthew G. Knepley     PetscClassId id;
17385f0b18bfSMatthew G. Knepley     PetscInt     fNc;
17395f0b18bfSMatthew G. Knepley 
17409566063dSJacob Faibussowitsch     PetscCall(DMGetField(dm, f, NULL, &obj));
17419566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
17425f0b18bfSMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
17435f0b18bfSMatthew G. Knepley       PetscFE fe = (PetscFE) obj;
17445f0b18bfSMatthew G. Knepley 
17459566063dSJacob Faibussowitsch       PetscCall(PetscFEGetQuadrature(fe, &quad));
17469566063dSJacob Faibussowitsch       PetscCall(PetscFEGetNumComponents(fe, &fNc));
17475f0b18bfSMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
17485f0b18bfSMatthew G. Knepley       PetscFV fv = (PetscFV) obj;
17495f0b18bfSMatthew G. Knepley 
17509566063dSJacob Faibussowitsch       PetscCall(PetscFVGetQuadrature(fv, &quad));
17519566063dSJacob Faibussowitsch       PetscCall(PetscFVGetNumComponents(fv, &fNc));
17525f0b18bfSMatthew G. Knepley     } else SETERRQ(PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", f);
17535f0b18bfSMatthew G. Knepley     Nc += fNc;
17545f0b18bfSMatthew G. Knepley   }
17559566063dSJacob Faibussowitsch   PetscCall(PetscQuadratureGetData(quad, NULL, &qNc, &Nq, &quadPoints, &quadWeights));
17565f0b18bfSMatthew G. Knepley   PetscCheck(qNc == 1,PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_SIZ, "Quadrature components %D > 1", qNc);
17579566063dSJacob Faibussowitsch   PetscCall(PetscMalloc6(Nc*2, &valsum, Nc, &interpolant, cdim*Nq, &coords, Nq, &fegeom.detJ, cdim*cdim*Nq, &fegeom.J, cdim*cdim*Nq, &fegeom.invJ));
17589566063dSJacob Faibussowitsch   PetscCall(DMPlexGetDepthStratum(dm, 0, &vStart, &vEnd));
17599566063dSJacob Faibussowitsch   PetscCall(DMPlexGetSimplexOrBoxCells(dm, 0, &cStart, &cEnd));
17605f0b18bfSMatthew G. Knepley   for (v = vStart; v < vEnd; ++v) {
17615f0b18bfSMatthew G. Knepley     PetscScalar volsum = 0.0;
17625f0b18bfSMatthew G. Knepley     PetscInt   *star   = NULL;
17635f0b18bfSMatthew G. Knepley     PetscInt    starSize, st, fc;
17645f0b18bfSMatthew G. Knepley 
17659566063dSJacob Faibussowitsch     PetscCall(PetscArrayzero(valsum, Nc));
17669566063dSJacob Faibussowitsch     PetscCall(DMPlexGetTransitiveClosure(dm, v, PETSC_FALSE, &starSize, &star));
17675f0b18bfSMatthew G. Knepley     for (st = 0; st < starSize*2; st += 2) {
17685f0b18bfSMatthew G. Knepley       const PetscInt cell = star[st];
17695f0b18bfSMatthew G. Knepley       PetscScalar   *val  = &valsum[Nc];
17705f0b18bfSMatthew G. Knepley       PetscScalar   *x    = NULL;
17715f0b18bfSMatthew G. Knepley       PetscReal      vol  = 0.0;
17725f0b18bfSMatthew G. Knepley       PetscInt       foff = 0;
17735f0b18bfSMatthew G. Knepley 
17745f0b18bfSMatthew G. Knepley       if ((cell < cStart) || (cell >= cEnd)) continue;
17759566063dSJacob Faibussowitsch       PetscCall(DMPlexComputeCellGeometryFEM(dm, cell, quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
17769566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(dm, NULL, locX, cell, NULL, &x));
17775f0b18bfSMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
17785f0b18bfSMatthew G. Knepley         PetscObject  obj;
17795f0b18bfSMatthew G. Knepley         PetscClassId id;
17805f0b18bfSMatthew G. Knepley         PetscInt     Nb, fNc, q;
17815f0b18bfSMatthew G. Knepley 
17829566063dSJacob Faibussowitsch         PetscCall(PetscArrayzero(val, Nc));
17839566063dSJacob Faibussowitsch         PetscCall(DMGetField(dm, f, NULL, &obj));
17849566063dSJacob Faibussowitsch         PetscCall(PetscObjectGetClassId(obj, &id));
17859566063dSJacob Faibussowitsch         if (id == PETSCFE_CLASSID)      {PetscCall(PetscFEGetNumComponents((PetscFE) obj, &fNc));PetscCall(PetscFEGetDimension((PetscFE) obj, &Nb));}
17869566063dSJacob Faibussowitsch         else if (id == PETSCFV_CLASSID) {PetscCall(PetscFVGetNumComponents((PetscFV) obj, &fNc));Nb = 1;}
17875f0b18bfSMatthew G. Knepley         else SETERRQ(PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", f);
17885f0b18bfSMatthew G. Knepley         for (q = 0; q < Nq; ++q) {
17895f0b18bfSMatthew G. Knepley           const PetscReal wt = quadWeights[q]*fegeom.detJ[q];
17905f0b18bfSMatthew G. Knepley           PetscFEGeom     qgeom;
17915f0b18bfSMatthew G. Knepley 
17925f0b18bfSMatthew G. Knepley           qgeom.dimEmbed = fegeom.dimEmbed;
17935f0b18bfSMatthew G. Knepley           qgeom.J        = &fegeom.J[q*cdim*cdim];
17945f0b18bfSMatthew G. Knepley           qgeom.invJ     = &fegeom.invJ[q*cdim*cdim];
17955f0b18bfSMatthew G. Knepley           qgeom.detJ     = &fegeom.detJ[q];
17965f0b18bfSMatthew G. Knepley           PetscCheck(fegeom.detJ[q] > 0.0, PETSC_COMM_SELF, PETSC_ERR_ARG_OUTOFRANGE, "Invalid determinant %g for element %D, quadrature points %D", (double) fegeom.detJ[q], cell, q);
17979566063dSJacob Faibussowitsch           if (id == PETSCFE_CLASSID) PetscCall(PetscFEInterpolate_Static((PetscFE) obj, &x[foff], &qgeom, q, interpolant));
17985f0b18bfSMatthew G. Knepley           else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", f);
17995f0b18bfSMatthew G. Knepley           for (fc = 0; fc < fNc; ++fc) val[foff+fc] += interpolant[fc]*wt;
18005f0b18bfSMatthew G. Knepley           vol += wt;
18015f0b18bfSMatthew G. Knepley         }
18025f0b18bfSMatthew G. Knepley         foff += Nb;
18035f0b18bfSMatthew G. Knepley       }
18049566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(dm, NULL, locX, cell, NULL, &x));
18055f0b18bfSMatthew G. Knepley       for (fc = 0; fc < Nc; ++fc) valsum[fc] += val[fc];
18065f0b18bfSMatthew G. Knepley       volsum += vol;
18075f0b18bfSMatthew G. Knepley       if (debug) {
18089566063dSJacob Faibussowitsch         PetscCall(PetscPrintf(PETSC_COMM_SELF, "Vertex %" PetscInt_FMT " Cell %" PetscInt_FMT " value: [", v, cell));
18095f0b18bfSMatthew G. Knepley         for (fc = 0; fc < Nc; ++fc) {
18109566063dSJacob Faibussowitsch           if (fc) PetscCall(PetscPrintf(PETSC_COMM_SELF, ", "));
18119566063dSJacob Faibussowitsch           PetscCall(PetscPrintf(PETSC_COMM_SELF, "%g", (double) PetscRealPart(val[fc])));
18125f0b18bfSMatthew G. Knepley         }
18139566063dSJacob Faibussowitsch         PetscCall(PetscPrintf(PETSC_COMM_SELF, "]\n"));
18145f0b18bfSMatthew G. Knepley       }
18155f0b18bfSMatthew G. Knepley     }
18165f0b18bfSMatthew G. Knepley     for (fc = 0; fc < Nc; ++fc) valsum[fc] /= volsum;
18179566063dSJacob Faibussowitsch     PetscCall(DMPlexRestoreTransitiveClosure(dm, v, PETSC_FALSE, &starSize, &star));
18189566063dSJacob Faibussowitsch     PetscCall(DMPlexVecSetClosure(dmc, NULL, locC, v, valsum, INSERT_VALUES));
18195f0b18bfSMatthew G. Knepley   }
18209566063dSJacob Faibussowitsch   PetscCall(PetscFree6(valsum, interpolant, coords, fegeom.detJ, fegeom.J, fegeom.invJ));
18215f0b18bfSMatthew G. Knepley   PetscFunctionReturn(0);
18225f0b18bfSMatthew G. Knepley }
18235f0b18bfSMatthew G. Knepley 
18245f0b18bfSMatthew G. Knepley /*@
18251555c271SMatthew 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.
18261555c271SMatthew G. Knepley 
1827d083f849SBarry Smith   Collective on dm
1828c0f8e1fdSMatthew G. Knepley 
18291555c271SMatthew G. Knepley   Input Parameters:
18301555c271SMatthew G. Knepley + dm - The DM
18315f0b18bfSMatthew G. Knepley - locX  - The coefficient vector u_h
18321555c271SMatthew G. Knepley 
18331555c271SMatthew G. Knepley   Output Parameter:
18341555c271SMatthew G. Knepley . locC - A Vec which holds the Clement interpolant of the gradient
18351555c271SMatthew G. Knepley 
183695452b02SPatrick Sanan   Notes:
18371555c271SMatthew 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
18381555c271SMatthew G. Knepley 
18391555c271SMatthew G. Knepley   Level: developer
18401555c271SMatthew G. Knepley 
18411555c271SMatthew G. Knepley .seealso: DMProjectFunction(), DMComputeL2Diff(), DMPlexComputeL2FieldDiff(), DMComputeL2GradientDiff()
18421555c271SMatthew G. Knepley @*/
18431555c271SMatthew G. Knepley PetscErrorCode DMPlexComputeGradientClementInterpolant(DM dm, Vec locX, Vec locC)
18441555c271SMatthew G. Knepley {
1845db1066baSMatthew G. Knepley   DM_Plex         *mesh  = (DM_Plex *) dm->data;
1846db1066baSMatthew G. Knepley   PetscInt         debug = mesh->printFEM;
18471555c271SMatthew G. Knepley   DM               dmC;
18481555c271SMatthew G. Knepley   PetscQuadrature  quad;
18491555c271SMatthew G. Knepley   PetscScalar     *interpolant, *gradsum;
18504bee2e38SMatthew G. Knepley   PetscFEGeom      fegeom;
18514bee2e38SMatthew G. Knepley   PetscReal       *coords;
18521555c271SMatthew G. Knepley   const PetscReal *quadPoints, *quadWeights;
1853485ad865SMatthew G. Knepley   PetscInt         dim, coordDim, numFields, numComponents = 0, qNc, Nq, cStart, cEnd, vStart, vEnd, v, field, fieldOffset;
18541555c271SMatthew G. Knepley 
18551555c271SMatthew G. Knepley   PetscFunctionBegin;
18569566063dSJacob Faibussowitsch   PetscCall(PetscCitationsRegister(ClementCitation, &Clementcite));
18579566063dSJacob Faibussowitsch   PetscCall(VecGetDM(locC, &dmC));
18589566063dSJacob Faibussowitsch   PetscCall(VecSet(locC, 0.0));
18599566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
18609566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateDim(dm, &coordDim));
18614bee2e38SMatthew G. Knepley   fegeom.dimEmbed = coordDim;
18629566063dSJacob Faibussowitsch   PetscCall(DMGetNumFields(dm, &numFields));
18635f80ce2aSJacob Faibussowitsch   PetscCheck(numFields,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of fields is zero!");
18641555c271SMatthew G. Knepley   for (field = 0; field < numFields; ++field) {
18651555c271SMatthew G. Knepley     PetscObject  obj;
18661555c271SMatthew G. Knepley     PetscClassId id;
18671555c271SMatthew G. Knepley     PetscInt     Nc;
18681555c271SMatthew G. Knepley 
18699566063dSJacob Faibussowitsch     PetscCall(DMGetField(dm, field, NULL, &obj));
18709566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
18711555c271SMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
18721555c271SMatthew G. Knepley       PetscFE fe = (PetscFE) obj;
18731555c271SMatthew G. Knepley 
18749566063dSJacob Faibussowitsch       PetscCall(PetscFEGetQuadrature(fe, &quad));
18759566063dSJacob Faibussowitsch       PetscCall(PetscFEGetNumComponents(fe, &Nc));
18761555c271SMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
18771555c271SMatthew G. Knepley       PetscFV fv = (PetscFV) obj;
18781555c271SMatthew G. Knepley 
18799566063dSJacob Faibussowitsch       PetscCall(PetscFVGetQuadrature(fv, &quad));
18809566063dSJacob Faibussowitsch       PetscCall(PetscFVGetNumComponents(fv, &Nc));
188198921bdaSJacob Faibussowitsch     } else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", field);
18821555c271SMatthew G. Knepley     numComponents += Nc;
18831555c271SMatthew G. Knepley   }
18849566063dSJacob Faibussowitsch   PetscCall(PetscQuadratureGetData(quad, NULL, &qNc, &Nq, &quadPoints, &quadWeights));
18852c71b3e2SJacob Faibussowitsch   PetscCheckFalse((qNc != 1) && (qNc != numComponents),PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_SIZ, "Quadrature components %D != %D field components", qNc, numComponents);
18869566063dSJacob 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));
18879566063dSJacob Faibussowitsch   PetscCall(DMPlexGetDepthStratum(dm, 0, &vStart, &vEnd));
18889566063dSJacob Faibussowitsch   PetscCall(DMPlexGetSimplexOrBoxCells(dm, 0, &cStart, &cEnd));
18891555c271SMatthew G. Knepley   for (v = vStart; v < vEnd; ++v) {
18901555c271SMatthew G. Knepley     PetscScalar volsum = 0.0;
18911555c271SMatthew G. Knepley     PetscInt   *star   = NULL;
18921555c271SMatthew G. Knepley     PetscInt    starSize, st, d, fc;
18931555c271SMatthew G. Knepley 
18949566063dSJacob Faibussowitsch     PetscCall(PetscArrayzero(gradsum, coordDim*numComponents));
18959566063dSJacob Faibussowitsch     PetscCall(DMPlexGetTransitiveClosure(dm, v, PETSC_FALSE, &starSize, &star));
18961555c271SMatthew G. Knepley     for (st = 0; st < starSize*2; st += 2) {
18971555c271SMatthew G. Knepley       const PetscInt cell = star[st];
18981555c271SMatthew G. Knepley       PetscScalar   *grad = &gradsum[coordDim*numComponents];
18991555c271SMatthew G. Knepley       PetscScalar   *x    = NULL;
19001555c271SMatthew G. Knepley       PetscReal      vol  = 0.0;
19011555c271SMatthew G. Knepley 
19021555c271SMatthew G. Knepley       if ((cell < cStart) || (cell >= cEnd)) continue;
19039566063dSJacob Faibussowitsch       PetscCall(DMPlexComputeCellGeometryFEM(dm, cell, quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
19049566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(dm, NULL, locX, cell, NULL, &x));
19051555c271SMatthew G. Knepley       for (field = 0, fieldOffset = 0; field < numFields; ++field) {
19061555c271SMatthew G. Knepley         PetscObject  obj;
19071555c271SMatthew G. Knepley         PetscClassId id;
19081555c271SMatthew G. Knepley         PetscInt     Nb, Nc, q, qc = 0;
19091555c271SMatthew G. Knepley 
19109566063dSJacob Faibussowitsch         PetscCall(PetscArrayzero(grad, coordDim*numComponents));
19119566063dSJacob Faibussowitsch         PetscCall(DMGetField(dm, field, NULL, &obj));
19129566063dSJacob Faibussowitsch         PetscCall(PetscObjectGetClassId(obj, &id));
19139566063dSJacob Faibussowitsch         if (id == PETSCFE_CLASSID)      {PetscCall(PetscFEGetNumComponents((PetscFE) obj, &Nc));PetscCall(PetscFEGetDimension((PetscFE) obj, &Nb));}
19149566063dSJacob Faibussowitsch         else if (id == PETSCFV_CLASSID) {PetscCall(PetscFVGetNumComponents((PetscFV) obj, &Nc));Nb = 1;}
191598921bdaSJacob Faibussowitsch         else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", field);
19161555c271SMatthew G. Knepley         for (q = 0; q < Nq; ++q) {
19172a4e142eSMatthew G. Knepley           PetscFEGeom qgeom;
19182a4e142eSMatthew G. Knepley 
19192a4e142eSMatthew G. Knepley           qgeom.dimEmbed = fegeom.dimEmbed;
19202a4e142eSMatthew G. Knepley           qgeom.J        = &fegeom.J[q*coordDim*coordDim];
19212a4e142eSMatthew G. Knepley           qgeom.invJ     = &fegeom.invJ[q*coordDim*coordDim];
19222a4e142eSMatthew G. Knepley           qgeom.detJ     = &fegeom.detJ[q];
19235f80ce2aSJacob Faibussowitsch           PetscCheck(fegeom.detJ[q] > 0.0,PETSC_COMM_SELF, PETSC_ERR_ARG_OUTOFRANGE, "Invalid determinant %g for element %D, quadrature points %D", (double)fegeom.detJ[q], cell, q);
19249566063dSJacob Faibussowitsch           if (id == PETSCFE_CLASSID)      PetscCall(PetscFEInterpolateGradient_Static((PetscFE) obj, 1, &x[fieldOffset], &qgeom, q, interpolant));
192598921bdaSJacob Faibussowitsch           else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", field);
19261555c271SMatthew G. Knepley           for (fc = 0; fc < Nc; ++fc) {
192753d2db2dSJoe Wallwork             const PetscReal wt = quadWeights[q*qNc+qc];
19281555c271SMatthew G. Knepley 
19294bee2e38SMatthew G. Knepley             for (d = 0; d < coordDim; ++d) grad[fc*coordDim+d] += interpolant[fc*dim+d]*wt*fegeom.detJ[q];
19301555c271SMatthew G. Knepley           }
19314bee2e38SMatthew G. Knepley           vol += quadWeights[q*qNc]*fegeom.detJ[q];
19321555c271SMatthew G. Knepley         }
19331555c271SMatthew G. Knepley         fieldOffset += Nb;
19341555c271SMatthew G. Knepley         qc          += Nc;
19351555c271SMatthew G. Knepley       }
19369566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(dm, NULL, locX, cell, NULL, &x));
1937f8527842SMatthew G. Knepley       for (fc = 0; fc < numComponents; ++fc) {
1938f8527842SMatthew G. Knepley         for (d = 0; d < coordDim; ++d) {
1939f8527842SMatthew G. Knepley           gradsum[fc*coordDim+d] += grad[fc*coordDim+d];
1940f8527842SMatthew G. Knepley         }
1941f8527842SMatthew G. Knepley       }
1942f8527842SMatthew G. Knepley       volsum += vol;
1943db1066baSMatthew G. Knepley       if (debug) {
19449566063dSJacob Faibussowitsch         PetscCall(PetscPrintf(PETSC_COMM_SELF, "Vertex %" PetscInt_FMT " Cell %" PetscInt_FMT " gradient: [", v, cell));
19451555c271SMatthew G. Knepley         for (fc = 0; fc < numComponents; ++fc) {
19461555c271SMatthew G. Knepley           for (d = 0; d < coordDim; ++d) {
19479566063dSJacob Faibussowitsch             if (fc || d > 0) PetscCall(PetscPrintf(PETSC_COMM_SELF, ", "));
19489566063dSJacob Faibussowitsch             PetscCall(PetscPrintf(PETSC_COMM_SELF, "%g", (double)PetscRealPart(grad[fc*coordDim+d])));
19491555c271SMatthew G. Knepley           }
19501555c271SMatthew G. Knepley         }
19519566063dSJacob Faibussowitsch         PetscCall(PetscPrintf(PETSC_COMM_SELF, "]\n"));
1952db1066baSMatthew G. Knepley       }
19531555c271SMatthew G. Knepley     }
19541555c271SMatthew G. Knepley     for (fc = 0; fc < numComponents; ++fc) {
19551555c271SMatthew G. Knepley       for (d = 0; d < coordDim; ++d) gradsum[fc*coordDim+d] /= volsum;
19561555c271SMatthew G. Knepley     }
19579566063dSJacob Faibussowitsch     PetscCall(DMPlexRestoreTransitiveClosure(dm, v, PETSC_FALSE, &starSize, &star));
19589566063dSJacob Faibussowitsch     PetscCall(DMPlexVecSetClosure(dmC, NULL, locC, v, gradsum, INSERT_VALUES));
19591555c271SMatthew G. Knepley   }
19609566063dSJacob Faibussowitsch   PetscCall(PetscFree6(gradsum,interpolant,coords,fegeom.detJ,fegeom.J,fegeom.invJ));
19611555c271SMatthew G. Knepley   PetscFunctionReturn(0);
19621555c271SMatthew G. Knepley }
19631555c271SMatthew G. Knepley 
1964338f77d5SMatthew G. Knepley static PetscErrorCode DMPlexComputeIntegral_Internal(DM dm, Vec X, PetscInt cStart, PetscInt cEnd, PetscScalar *cintegral, void *user)
196573d901b8SMatthew G. Knepley {
1966338f77d5SMatthew G. Knepley   DM                 dmAux = NULL;
196761aaff12SToby Isaac   PetscDS            prob,    probAux = NULL;
196873d901b8SMatthew G. Knepley   PetscSection       section, sectionAux;
1969338f77d5SMatthew G. Knepley   Vec                locX,    locA;
1970c330f8ffSToby Isaac   PetscInt           dim, numCells = cEnd - cStart, c, f;
1971c330f8ffSToby Isaac   PetscBool          useFVM = PETSC_FALSE;
1972338f77d5SMatthew G. Knepley   /* DS */
1973338f77d5SMatthew G. Knepley   PetscInt           Nf,    totDim,    *uOff, *uOff_x, numConstants;
1974338f77d5SMatthew G. Knepley   PetscInt           NfAux, totDimAux, *aOff;
1975338f77d5SMatthew G. Knepley   PetscScalar       *u, *a;
1976338f77d5SMatthew G. Knepley   const PetscScalar *constants;
1977338f77d5SMatthew G. Knepley   /* Geometry */
1978c330f8ffSToby Isaac   PetscFEGeom       *cgeomFEM;
1979338f77d5SMatthew G. Knepley   DM                 dmGrad;
1980c330f8ffSToby Isaac   PetscQuadrature    affineQuad = NULL;
1981338f77d5SMatthew G. Knepley   Vec                cellGeometryFVM = NULL, faceGeometryFVM = NULL, locGrad = NULL;
1982b5a3613cSMatthew G. Knepley   PetscFVCellGeom   *cgeomFVM;
1983338f77d5SMatthew G. Knepley   const PetscScalar *lgrad;
1984b7260050SToby Isaac   PetscInt           maxDegree;
1985c330f8ffSToby Isaac   DMField            coordField;
1986c330f8ffSToby Isaac   IS                 cellIS;
198773d901b8SMatthew G. Knepley 
198873d901b8SMatthew G. Knepley   PetscFunctionBegin;
19899566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dm, &prob));
19909566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
19919566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
19929566063dSJacob Faibussowitsch   PetscCall(DMGetNumFields(dm, &Nf));
1993338f77d5SMatthew G. Knepley   /* Determine which discretizations we have */
1994b5a3613cSMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
1995b5a3613cSMatthew G. Knepley     PetscObject  obj;
1996b5a3613cSMatthew G. Knepley     PetscClassId id;
1997b5a3613cSMatthew G. Knepley 
19989566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, f, &obj));
19999566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
2000338f77d5SMatthew G. Knepley     if (id == PETSCFV_CLASSID) useFVM = PETSC_TRUE;
2001338f77d5SMatthew G. Knepley   }
2002338f77d5SMatthew G. Knepley   /* Get local solution with boundary values */
20039566063dSJacob Faibussowitsch   PetscCall(DMGetLocalVector(dm, &locX));
20049566063dSJacob Faibussowitsch   PetscCall(DMPlexInsertBoundaryValues(dm, PETSC_TRUE, locX, 0.0, NULL, NULL, NULL));
20059566063dSJacob Faibussowitsch   PetscCall(DMGlobalToLocalBegin(dm, X, INSERT_VALUES, locX));
20069566063dSJacob Faibussowitsch   PetscCall(DMGlobalToLocalEnd(dm, X, INSERT_VALUES, locX));
2007338f77d5SMatthew G. Knepley   /* Read DS information */
20089566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(prob, &totDim));
20099566063dSJacob Faibussowitsch   PetscCall(PetscDSGetComponentOffsets(prob, &uOff));
20109566063dSJacob Faibussowitsch   PetscCall(PetscDSGetComponentDerivativeOffsets(prob, &uOff_x));
20119566063dSJacob Faibussowitsch   PetscCall(ISCreateStride(PETSC_COMM_SELF,numCells,cStart,1,&cellIS));
20129566063dSJacob Faibussowitsch   PetscCall(PetscDSGetConstants(prob, &numConstants, &constants));
2013338f77d5SMatthew G. Knepley   /* Read Auxiliary DS information */
20149566063dSJacob Faibussowitsch   PetscCall(DMGetAuxiliaryVec(dm, NULL, 0, 0, &locA));
20159a2a23afSMatthew G. Knepley   if (locA) {
20169566063dSJacob Faibussowitsch     PetscCall(VecGetDM(locA, &dmAux));
20179566063dSJacob Faibussowitsch     PetscCall(DMGetDS(dmAux, &probAux));
20189566063dSJacob Faibussowitsch     PetscCall(PetscDSGetNumFields(probAux, &NfAux));
20199566063dSJacob Faibussowitsch     PetscCall(DMGetLocalSection(dmAux, &sectionAux));
20209566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalDimension(probAux, &totDimAux));
20219566063dSJacob Faibussowitsch     PetscCall(PetscDSGetComponentOffsets(probAux, &aOff));
2022338f77d5SMatthew G. Knepley   }
2023338f77d5SMatthew G. Knepley   /* Allocate data  arrays */
20249566063dSJacob Faibussowitsch   PetscCall(PetscCalloc1(numCells*totDim, &u));
20259566063dSJacob Faibussowitsch   if (dmAux) PetscCall(PetscMalloc1(numCells*totDimAux, &a));
2026338f77d5SMatthew G. Knepley   /* Read out geometry */
20279566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateField(dm,&coordField));
20289566063dSJacob Faibussowitsch   PetscCall(DMFieldGetDegree(coordField,cellIS,NULL,&maxDegree));
2029b7260050SToby Isaac   if (maxDegree <= 1) {
20309566063dSJacob Faibussowitsch     PetscCall(DMFieldCreateDefaultQuadrature(coordField,cellIS,&affineQuad));
2031c330f8ffSToby Isaac     if (affineQuad) {
20329566063dSJacob Faibussowitsch       PetscCall(DMFieldCreateFEGeom(coordField,cellIS,affineQuad,PETSC_FALSE,&cgeomFEM));
2033338f77d5SMatthew G. Knepley     }
2034b5a3613cSMatthew G. Knepley   }
2035b5a3613cSMatthew G. Knepley   if (useFVM) {
2036338f77d5SMatthew G. Knepley     PetscFV   fv = NULL;
2037b5a3613cSMatthew G. Knepley     Vec       grad;
2038b5a3613cSMatthew G. Knepley     PetscInt  fStart, fEnd;
2039b5a3613cSMatthew G. Knepley     PetscBool compGrad;
2040b5a3613cSMatthew G. Knepley 
2041338f77d5SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
2042338f77d5SMatthew G. Knepley       PetscObject  obj;
2043338f77d5SMatthew G. Knepley       PetscClassId id;
2044338f77d5SMatthew G. Knepley 
20459566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(prob, f, &obj));
20469566063dSJacob Faibussowitsch       PetscCall(PetscObjectGetClassId(obj, &id));
2047338f77d5SMatthew G. Knepley       if (id == PETSCFV_CLASSID) {fv = (PetscFV) obj; break;}
2048338f77d5SMatthew G. Knepley     }
20499566063dSJacob Faibussowitsch     PetscCall(PetscFVGetComputeGradients(fv, &compGrad));
20509566063dSJacob Faibussowitsch     PetscCall(PetscFVSetComputeGradients(fv, PETSC_TRUE));
20519566063dSJacob Faibussowitsch     PetscCall(DMPlexComputeGeometryFVM(dm, &cellGeometryFVM, &faceGeometryFVM));
20529566063dSJacob Faibussowitsch     PetscCall(DMPlexComputeGradientFVM(dm, fv, faceGeometryFVM, cellGeometryFVM, &dmGrad));
20539566063dSJacob Faibussowitsch     PetscCall(PetscFVSetComputeGradients(fv, compGrad));
20549566063dSJacob Faibussowitsch     PetscCall(VecGetArrayRead(cellGeometryFVM, (const PetscScalar **) &cgeomFVM));
2055b5a3613cSMatthew G. Knepley     /* Reconstruct and limit cell gradients */
20569566063dSJacob Faibussowitsch     PetscCall(DMPlexGetHeightStratum(dm, 1, &fStart, &fEnd));
20579566063dSJacob Faibussowitsch     PetscCall(DMGetGlobalVector(dmGrad, &grad));
20589566063dSJacob Faibussowitsch     PetscCall(DMPlexReconstructGradients_Internal(dm, fv, fStart, fEnd, faceGeometryFVM, cellGeometryFVM, locX, grad));
2059b5a3613cSMatthew G. Knepley     /* Communicate gradient values */
20609566063dSJacob Faibussowitsch     PetscCall(DMGetLocalVector(dmGrad, &locGrad));
20619566063dSJacob Faibussowitsch     PetscCall(DMGlobalToLocalBegin(dmGrad, grad, INSERT_VALUES, locGrad));
20629566063dSJacob Faibussowitsch     PetscCall(DMGlobalToLocalEnd(dmGrad, grad, INSERT_VALUES, locGrad));
20639566063dSJacob Faibussowitsch     PetscCall(DMRestoreGlobalVector(dmGrad, &grad));
2064b5a3613cSMatthew G. Knepley     /* Handle non-essential (e.g. outflow) boundary values */
20659566063dSJacob Faibussowitsch     PetscCall(DMPlexInsertBoundaryValues(dm, PETSC_FALSE, locX, 0.0, faceGeometryFVM, cellGeometryFVM, locGrad));
20669566063dSJacob Faibussowitsch     PetscCall(VecGetArrayRead(locGrad, &lgrad));
2067b5a3613cSMatthew G. Knepley   }
2068338f77d5SMatthew G. Knepley   /* Read out data from inputs */
206973d901b8SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
207073d901b8SMatthew G. Knepley     PetscScalar *x = NULL;
207173d901b8SMatthew G. Knepley     PetscInt     i;
207273d901b8SMatthew G. Knepley 
20739566063dSJacob Faibussowitsch     PetscCall(DMPlexVecGetClosure(dm, section, locX, c, NULL, &x));
20740f2d7e86SMatthew G. Knepley     for (i = 0; i < totDim; ++i) u[c*totDim+i] = x[i];
20759566063dSJacob Faibussowitsch     PetscCall(DMPlexVecRestoreClosure(dm, section, locX, c, NULL, &x));
207673d901b8SMatthew G. Knepley     if (dmAux) {
20779566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(dmAux, sectionAux, locA, c, NULL, &x));
20780f2d7e86SMatthew G. Knepley       for (i = 0; i < totDimAux; ++i) a[c*totDimAux+i] = x[i];
20799566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(dmAux, sectionAux, locA, c, NULL, &x));
208073d901b8SMatthew G. Knepley     }
208173d901b8SMatthew G. Knepley   }
2082338f77d5SMatthew G. Knepley   /* Do integration for each field */
208373d901b8SMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
2084c1f031eeSMatthew G. Knepley     PetscObject  obj;
2085c1f031eeSMatthew G. Knepley     PetscClassId id;
2086c1f031eeSMatthew G. Knepley     PetscInt     numChunks, numBatches, batchSize, numBlocks, blockSize, Ne, Nr, offset;
208773d901b8SMatthew G. Knepley 
20889566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, f, &obj));
20899566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
2090c1f031eeSMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
2091c1f031eeSMatthew G. Knepley       PetscFE         fe = (PetscFE) obj;
2092c1f031eeSMatthew G. Knepley       PetscQuadrature q;
2093c330f8ffSToby Isaac       PetscFEGeom     *chunkGeom = NULL;
2094c1f031eeSMatthew G. Knepley       PetscInt        Nq, Nb;
2095c1f031eeSMatthew G. Knepley 
20969566063dSJacob Faibussowitsch       PetscCall(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
20979566063dSJacob Faibussowitsch       PetscCall(PetscFEGetQuadrature(fe, &q));
20989566063dSJacob Faibussowitsch       PetscCall(PetscQuadratureGetData(q, NULL, NULL, &Nq, NULL, NULL));
20999566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDimension(fe, &Nb));
2100c1f031eeSMatthew G. Knepley       blockSize = Nb*Nq;
210173d901b8SMatthew G. Knepley       batchSize = numBlocks * blockSize;
21029566063dSJacob Faibussowitsch       PetscCall(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
210373d901b8SMatthew G. Knepley       numChunks = numCells / (numBatches*batchSize);
210473d901b8SMatthew G. Knepley       Ne        = numChunks*numBatches*batchSize;
210573d901b8SMatthew G. Knepley       Nr        = numCells % (numBatches*batchSize);
210673d901b8SMatthew G. Knepley       offset    = numCells - Nr;
2107c330f8ffSToby Isaac       if (!affineQuad) {
21089566063dSJacob Faibussowitsch         PetscCall(DMFieldCreateFEGeom(coordField,cellIS,q,PETSC_FALSE,&cgeomFEM));
2109c330f8ffSToby Isaac       }
21109566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomGetChunk(cgeomFEM,0,offset,&chunkGeom));
21119566063dSJacob Faibussowitsch       PetscCall(PetscFEIntegrate(prob, f, Ne, chunkGeom, u, probAux, a, cintegral));
21129566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomGetChunk(cgeomFEM,offset,numCells,&chunkGeom));
21139566063dSJacob Faibussowitsch       PetscCall(PetscFEIntegrate(prob, f, Nr, chunkGeom, &u[offset*totDim], probAux, &a[offset*totDimAux], &cintegral[offset*Nf]));
21149566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomRestoreChunk(cgeomFEM,offset,numCells,&chunkGeom));
2115c330f8ffSToby Isaac       if (!affineQuad) {
21169566063dSJacob Faibussowitsch         PetscCall(PetscFEGeomDestroy(&cgeomFEM));
2117c330f8ffSToby Isaac       }
2118c1f031eeSMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
2119c1f031eeSMatthew G. Knepley       PetscInt       foff;
2120420e96edSMatthew G. Knepley       PetscPointFunc obj_func;
2121b69edc29SMatthew G. Knepley       PetscScalar    lint;
2122c1f031eeSMatthew G. Knepley 
21239566063dSJacob Faibussowitsch       PetscCall(PetscDSGetObjective(prob, f, &obj_func));
21249566063dSJacob Faibussowitsch       PetscCall(PetscDSGetFieldOffset(prob, f, &foff));
2125c1f031eeSMatthew G. Knepley       if (obj_func) {
2126c1f031eeSMatthew G. Knepley         for (c = 0; c < numCells; ++c) {
2127b5a3613cSMatthew G. Knepley           PetscScalar *u_x;
2128b5a3613cSMatthew G. Knepley 
21299566063dSJacob Faibussowitsch           PetscCall(DMPlexPointLocalRead(dmGrad, c, lgrad, &u_x));
2130338f77d5SMatthew 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);
2131338f77d5SMatthew G. Knepley           cintegral[c*Nf+f] += PetscRealPart(lint)*cgeomFVM[c].volume;
213273d901b8SMatthew G. Knepley         }
2133c1f031eeSMatthew G. Knepley       }
213498921bdaSJacob Faibussowitsch     } else SETERRQ(PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", f);
2135c1f031eeSMatthew G. Knepley   }
2136338f77d5SMatthew G. Knepley   /* Cleanup data arrays */
2137b5a3613cSMatthew G. Knepley   if (useFVM) {
21389566063dSJacob Faibussowitsch     PetscCall(VecRestoreArrayRead(locGrad, &lgrad));
21399566063dSJacob Faibussowitsch     PetscCall(VecRestoreArrayRead(cellGeometryFVM, (const PetscScalar **) &cgeomFVM));
21409566063dSJacob Faibussowitsch     PetscCall(DMRestoreLocalVector(dmGrad, &locGrad));
21419566063dSJacob Faibussowitsch     PetscCall(VecDestroy(&faceGeometryFVM));
21429566063dSJacob Faibussowitsch     PetscCall(VecDestroy(&cellGeometryFVM));
21439566063dSJacob Faibussowitsch     PetscCall(DMDestroy(&dmGrad));
2144b5a3613cSMatthew G. Knepley   }
21459566063dSJacob Faibussowitsch   if (dmAux) PetscCall(PetscFree(a));
21469566063dSJacob Faibussowitsch   PetscCall(PetscFree(u));
2147338f77d5SMatthew G. Knepley   /* Cleanup */
2148f99c8401SToby Isaac   if (affineQuad) {
21499566063dSJacob Faibussowitsch     PetscCall(PetscFEGeomDestroy(&cgeomFEM));
2150f99c8401SToby Isaac   }
21519566063dSJacob Faibussowitsch   PetscCall(PetscQuadratureDestroy(&affineQuad));
21529566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&cellIS));
21539566063dSJacob Faibussowitsch   PetscCall(DMRestoreLocalVector(dm, &locX));
2154338f77d5SMatthew G. Knepley   PetscFunctionReturn(0);
2155338f77d5SMatthew G. Knepley }
2156338f77d5SMatthew G. Knepley 
2157338f77d5SMatthew G. Knepley /*@
2158338f77d5SMatthew G. Knepley   DMPlexComputeIntegralFEM - Form the integral over the domain from the global input X using pointwise functions specified by the user
2159338f77d5SMatthew G. Knepley 
2160338f77d5SMatthew G. Knepley   Input Parameters:
2161338f77d5SMatthew G. Knepley + dm - The mesh
2162338f77d5SMatthew G. Knepley . X  - Global input vector
2163338f77d5SMatthew G. Knepley - user - The user context
2164338f77d5SMatthew G. Knepley 
2165338f77d5SMatthew G. Knepley   Output Parameter:
2166338f77d5SMatthew G. Knepley . integral - Integral for each field
2167338f77d5SMatthew G. Knepley 
2168338f77d5SMatthew G. Knepley   Level: developer
2169338f77d5SMatthew G. Knepley 
2170446c23c1SPierre Jolivet .seealso: DMPlexSNESComputeResidualFEM()
2171338f77d5SMatthew G. Knepley @*/
2172b8feb594SMatthew G. Knepley PetscErrorCode DMPlexComputeIntegralFEM(DM dm, Vec X, PetscScalar *integral, void *user)
2173338f77d5SMatthew G. Knepley {
2174338f77d5SMatthew G. Knepley   DM_Plex       *mesh = (DM_Plex *) dm->data;
2175b8feb594SMatthew G. Knepley   PetscScalar   *cintegral, *lintegral;
2176412e9a14SMatthew G. Knepley   PetscInt       Nf, f, cellHeight, cStart, cEnd, cell;
2177338f77d5SMatthew G. Knepley 
2178338f77d5SMatthew G. Knepley   PetscFunctionBegin;
2179338f77d5SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
2180338f77d5SMatthew G. Knepley   PetscValidHeaderSpecific(X, VEC_CLASSID, 2);
2181dadcf809SJacob Faibussowitsch   PetscValidScalarPointer(integral, 3);
21829566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_IntegralFEM,dm,0,0,0));
21839566063dSJacob Faibussowitsch   PetscCall(DMGetNumFields(dm, &Nf));
21849566063dSJacob Faibussowitsch   PetscCall(DMPlexGetVTKCellHeight(dm, &cellHeight));
21859566063dSJacob Faibussowitsch   PetscCall(DMPlexGetSimplexOrBoxCells(dm, cellHeight, &cStart, &cEnd));
2186338f77d5SMatthew G. Knepley   /* TODO Introduce a loop over large chunks (right now this is a single chunk) */
21879566063dSJacob Faibussowitsch   PetscCall(PetscCalloc2(Nf, &lintegral, (cEnd-cStart)*Nf, &cintegral));
21889566063dSJacob Faibussowitsch   PetscCall(DMPlexComputeIntegral_Internal(dm, X, cStart, cEnd, cintegral, user));
2189338f77d5SMatthew G. Knepley   /* Sum up values */
2190338f77d5SMatthew G. Knepley   for (cell = cStart; cell < cEnd; ++cell) {
2191338f77d5SMatthew G. Knepley     const PetscInt c = cell - cStart;
2192338f77d5SMatthew G. Knepley 
21939566063dSJacob Faibussowitsch     if (mesh->printFEM > 1) PetscCall(DMPrintCellVector(cell, "Cell Integral", Nf, &cintegral[c*Nf]));
2194b8feb594SMatthew G. Knepley     for (f = 0; f < Nf; ++f) lintegral[f] += cintegral[c*Nf+f];
2195338f77d5SMatthew G. Knepley   }
21969566063dSJacob Faibussowitsch   PetscCallMPI(MPIU_Allreduce(lintegral, integral, Nf, MPIU_SCALAR, MPIU_SUM, PetscObjectComm((PetscObject) dm)));
219773d901b8SMatthew G. Knepley   if (mesh->printFEM) {
21989566063dSJacob Faibussowitsch     PetscCall(PetscPrintf(PetscObjectComm((PetscObject) dm), "Integral:"));
21999566063dSJacob Faibussowitsch     for (f = 0; f < Nf; ++f) PetscCall(PetscPrintf(PetscObjectComm((PetscObject) dm), " %g", (double) PetscRealPart(integral[f])));
22009566063dSJacob Faibussowitsch     PetscCall(PetscPrintf(PetscObjectComm((PetscObject) dm), "\n"));
220173d901b8SMatthew G. Knepley   }
22029566063dSJacob Faibussowitsch   PetscCall(PetscFree2(lintegral, cintegral));
22039566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_IntegralFEM,dm,0,0,0));
2204338f77d5SMatthew G. Knepley   PetscFunctionReturn(0);
2205338f77d5SMatthew G. Knepley }
2206338f77d5SMatthew G. Knepley 
2207338f77d5SMatthew G. Knepley /*@
2208338f77d5SMatthew G. Knepley   DMPlexComputeCellwiseIntegralFEM - Form the vector of cellwise integrals F from the global input X using pointwise functions specified by the user
2209338f77d5SMatthew G. Knepley 
2210338f77d5SMatthew G. Knepley   Input Parameters:
2211338f77d5SMatthew G. Knepley + dm - The mesh
2212338f77d5SMatthew G. Knepley . X  - Global input vector
2213338f77d5SMatthew G. Knepley - user - The user context
2214338f77d5SMatthew G. Knepley 
2215338f77d5SMatthew G. Knepley   Output Parameter:
2216338f77d5SMatthew G. Knepley . integral - Cellwise integrals for each field
2217338f77d5SMatthew G. Knepley 
2218338f77d5SMatthew G. Knepley   Level: developer
2219338f77d5SMatthew G. Knepley 
2220446c23c1SPierre Jolivet .seealso: DMPlexSNESComputeResidualFEM()
2221338f77d5SMatthew G. Knepley @*/
2222338f77d5SMatthew G. Knepley PetscErrorCode DMPlexComputeCellwiseIntegralFEM(DM dm, Vec X, Vec F, void *user)
2223338f77d5SMatthew G. Knepley {
2224338f77d5SMatthew G. Knepley   DM_Plex       *mesh = (DM_Plex *) dm->data;
2225338f77d5SMatthew G. Knepley   DM             dmF;
2226338f77d5SMatthew G. Knepley   PetscSection   sectionF;
2227338f77d5SMatthew G. Knepley   PetscScalar   *cintegral, *af;
2228412e9a14SMatthew G. Knepley   PetscInt       Nf, f, cellHeight, cStart, cEnd, cell;
2229338f77d5SMatthew G. Knepley 
2230338f77d5SMatthew G. Knepley   PetscFunctionBegin;
2231338f77d5SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
2232338f77d5SMatthew G. Knepley   PetscValidHeaderSpecific(X, VEC_CLASSID, 2);
2233338f77d5SMatthew G. Knepley   PetscValidHeaderSpecific(F, VEC_CLASSID, 3);
22349566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_IntegralFEM,dm,0,0,0));
22359566063dSJacob Faibussowitsch   PetscCall(DMGetNumFields(dm, &Nf));
22369566063dSJacob Faibussowitsch   PetscCall(DMPlexGetVTKCellHeight(dm, &cellHeight));
22379566063dSJacob Faibussowitsch   PetscCall(DMPlexGetSimplexOrBoxCells(dm, cellHeight, &cStart, &cEnd));
2238338f77d5SMatthew G. Knepley   /* TODO Introduce a loop over large chunks (right now this is a single chunk) */
22399566063dSJacob Faibussowitsch   PetscCall(PetscCalloc1((cEnd-cStart)*Nf, &cintegral));
22409566063dSJacob Faibussowitsch   PetscCall(DMPlexComputeIntegral_Internal(dm, X, cStart, cEnd, cintegral, user));
2241338f77d5SMatthew G. Knepley   /* Put values in F*/
22429566063dSJacob Faibussowitsch   PetscCall(VecGetDM(F, &dmF));
22439566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dmF, &sectionF));
22449566063dSJacob Faibussowitsch   PetscCall(VecGetArray(F, &af));
2245338f77d5SMatthew G. Knepley   for (cell = cStart; cell < cEnd; ++cell) {
2246338f77d5SMatthew G. Knepley     const PetscInt c = cell - cStart;
2247338f77d5SMatthew G. Knepley     PetscInt       dof, off;
2248338f77d5SMatthew G. Knepley 
22499566063dSJacob Faibussowitsch     if (mesh->printFEM > 1) PetscCall(DMPrintCellVector(cell, "Cell Integral", Nf, &cintegral[c*Nf]));
22509566063dSJacob Faibussowitsch     PetscCall(PetscSectionGetDof(sectionF, cell, &dof));
22519566063dSJacob Faibussowitsch     PetscCall(PetscSectionGetOffset(sectionF, cell, &off));
22525f80ce2aSJacob Faibussowitsch     PetscCheck(dof == Nf,PETSC_COMM_SELF, PETSC_ERR_ARG_SIZ, "The number of cell dofs %D != %D", dof, Nf);
2253338f77d5SMatthew G. Knepley     for (f = 0; f < Nf; ++f) af[off+f] = cintegral[c*Nf+f];
2254338f77d5SMatthew G. Knepley   }
22559566063dSJacob Faibussowitsch   PetscCall(VecRestoreArray(F, &af));
22569566063dSJacob Faibussowitsch   PetscCall(PetscFree(cintegral));
22579566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_IntegralFEM,dm,0,0,0));
225873d901b8SMatthew G. Knepley   PetscFunctionReturn(0);
225973d901b8SMatthew G. Knepley }
226073d901b8SMatthew G. Knepley 
22619b6f715bSMatthew G. Knepley static PetscErrorCode DMPlexComputeBdIntegral_Internal(DM dm, Vec locX, IS pointIS,
22629b6f715bSMatthew G. Knepley                                                        void (*func)(PetscInt, PetscInt, PetscInt,
226364c72086SMatthew G. Knepley                                                                     const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
226464c72086SMatthew G. Knepley                                                                     const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
226564c72086SMatthew G. Knepley                                                                     PetscReal, const PetscReal[], const PetscReal[], PetscInt, const PetscScalar[], PetscScalar[]),
226664c72086SMatthew G. Knepley                                                        PetscScalar *fintegral, void *user)
226764c72086SMatthew G. Knepley {
22689b6f715bSMatthew G. Knepley   DM                 plex = NULL, plexA = NULL;
2269a6e0b375SMatthew G. Knepley   DMEnclosureType    encAux;
22709b6f715bSMatthew G. Knepley   PetscDS            prob, probAux = NULL;
22719b6f715bSMatthew G. Knepley   PetscSection       section, sectionAux = NULL;
22729b6f715bSMatthew G. Knepley   Vec                locA = NULL;
22739b6f715bSMatthew G. Knepley   DMField            coordField;
22749b6f715bSMatthew G. Knepley   PetscInt           Nf,        totDim,        *uOff, *uOff_x;
22759b6f715bSMatthew G. Knepley   PetscInt           NfAux = 0, totDimAux = 0, *aOff = NULL;
22769b6f715bSMatthew G. Knepley   PetscScalar       *u, *a = NULL;
227764c72086SMatthew G. Knepley   const PetscScalar *constants;
22789b6f715bSMatthew G. Knepley   PetscInt           numConstants, f;
227964c72086SMatthew G. Knepley 
228064c72086SMatthew G. Knepley   PetscFunctionBegin;
22819566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateField(dm, &coordField));
22829566063dSJacob Faibussowitsch   PetscCall(DMConvert(dm, DMPLEX, &plex));
22839566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dm, &prob));
22849566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
22859566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetNumFields(section, &Nf));
228664c72086SMatthew G. Knepley   /* Determine which discretizations we have */
22879b6f715bSMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
228864c72086SMatthew G. Knepley     PetscObject  obj;
228964c72086SMatthew G. Knepley     PetscClassId id;
229064c72086SMatthew G. Knepley 
22919566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, f, &obj));
22929566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
22935f80ce2aSJacob Faibussowitsch     PetscCheck(id != PETSCFV_CLASSID,PetscObjectComm((PetscObject) dm), PETSC_ERR_SUP, "Not supported for FVM (field %D)", f);
229464c72086SMatthew G. Knepley   }
229564c72086SMatthew G. Knepley   /* Read DS information */
22969566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(prob, &totDim));
22979566063dSJacob Faibussowitsch   PetscCall(PetscDSGetComponentOffsets(prob, &uOff));
22989566063dSJacob Faibussowitsch   PetscCall(PetscDSGetComponentDerivativeOffsets(prob, &uOff_x));
22999566063dSJacob Faibussowitsch   PetscCall(PetscDSGetConstants(prob, &numConstants, &constants));
230064c72086SMatthew G. Knepley   /* Read Auxiliary DS information */
23019566063dSJacob Faibussowitsch   PetscCall(DMGetAuxiliaryVec(dm, NULL, 0, 0, &locA));
23029b6f715bSMatthew G. Knepley   if (locA) {
23039b6f715bSMatthew G. Knepley     DM dmAux;
23049b6f715bSMatthew G. Knepley 
23059566063dSJacob Faibussowitsch     PetscCall(VecGetDM(locA, &dmAux));
23069566063dSJacob Faibussowitsch     PetscCall(DMGetEnclosureRelation(dmAux, dm, &encAux));
23079566063dSJacob Faibussowitsch     PetscCall(DMConvert(dmAux, DMPLEX, &plexA));
23089566063dSJacob Faibussowitsch     PetscCall(DMGetDS(dmAux, &probAux));
23099566063dSJacob Faibussowitsch     PetscCall(PetscDSGetNumFields(probAux, &NfAux));
23109566063dSJacob Faibussowitsch     PetscCall(DMGetLocalSection(dmAux, &sectionAux));
23119566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalDimension(probAux, &totDimAux));
23129566063dSJacob Faibussowitsch     PetscCall(PetscDSGetComponentOffsets(probAux, &aOff));
231364c72086SMatthew G. Knepley   }
23149b6f715bSMatthew G. Knepley   /* Integrate over points */
23159b6f715bSMatthew G. Knepley   {
23169b6f715bSMatthew G. Knepley     PetscFEGeom    *fgeom, *chunkGeom = NULL;
2317b7260050SToby Isaac     PetscInt        maxDegree;
23189b6f715bSMatthew G. Knepley     PetscQuadrature qGeom = NULL;
23199b6f715bSMatthew G. Knepley     const PetscInt *points;
23209b6f715bSMatthew G. Knepley     PetscInt        numFaces, face, Nq, field;
23219b6f715bSMatthew G. Knepley     PetscInt        numChunks, chunkSize, chunk, Nr, offset;
232264c72086SMatthew G. Knepley 
23239566063dSJacob Faibussowitsch     PetscCall(ISGetLocalSize(pointIS, &numFaces));
23249566063dSJacob Faibussowitsch     PetscCall(ISGetIndices(pointIS, &points));
23259566063dSJacob Faibussowitsch     PetscCall(PetscCalloc2(numFaces*totDim, &u, locA ? numFaces*totDimAux : 0, &a));
23269566063dSJacob Faibussowitsch     PetscCall(DMFieldGetDegree(coordField, pointIS, NULL, &maxDegree));
232764c72086SMatthew G. Knepley     for (field = 0; field < Nf; ++field) {
232864c72086SMatthew G. Knepley       PetscFE fe;
232964c72086SMatthew G. Knepley 
23309566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(prob, field, (PetscObject *) &fe));
23319566063dSJacob Faibussowitsch       if (maxDegree <= 1) PetscCall(DMFieldCreateDefaultQuadrature(coordField, pointIS, &qGeom));
23329b6f715bSMatthew G. Knepley       if (!qGeom) {
23339566063dSJacob Faibussowitsch         PetscCall(PetscFEGetFaceQuadrature(fe, &qGeom));
23349566063dSJacob Faibussowitsch         PetscCall(PetscObjectReference((PetscObject) qGeom));
23359b6f715bSMatthew G. Knepley       }
23369566063dSJacob Faibussowitsch       PetscCall(PetscQuadratureGetData(qGeom, NULL, NULL, &Nq, NULL, NULL));
23379566063dSJacob Faibussowitsch       PetscCall(DMPlexGetFEGeom(coordField, pointIS, qGeom, PETSC_TRUE, &fgeom));
23389b6f715bSMatthew G. Knepley       for (face = 0; face < numFaces; ++face) {
2339f15274beSMatthew Knepley         const PetscInt point = points[face], *support;
23409b6f715bSMatthew G. Knepley         PetscScalar    *x    = NULL;
2341f15274beSMatthew Knepley         PetscInt       i;
23429b6f715bSMatthew G. Knepley 
23439566063dSJacob Faibussowitsch         PetscCall(DMPlexGetSupport(dm, point, &support));
23449566063dSJacob Faibussowitsch         PetscCall(DMPlexVecGetClosure(plex, section, locX, support[0], NULL, &x));
23459b6f715bSMatthew G. Knepley         for (i = 0; i < totDim; ++i) u[face*totDim+i] = x[i];
23469566063dSJacob Faibussowitsch         PetscCall(DMPlexVecRestoreClosure(plex, section, locX, support[0], NULL, &x));
23479b6f715bSMatthew G. Knepley         if (locA) {
23489b6f715bSMatthew G. Knepley           PetscInt subp;
23499566063dSJacob Faibussowitsch           PetscCall(DMGetEnclosurePoint(plexA, dm, encAux, support[0], &subp));
23509566063dSJacob Faibussowitsch           PetscCall(DMPlexVecGetClosure(plexA, sectionAux, locA, subp, NULL, &x));
23519b6f715bSMatthew G. Knepley           for (i = 0; i < totDimAux; ++i) a[f*totDimAux+i] = x[i];
23529566063dSJacob Faibussowitsch           PetscCall(DMPlexVecRestoreClosure(plexA, sectionAux, locA, subp, NULL, &x));
23539b6f715bSMatthew G. Knepley         }
23549b6f715bSMatthew G. Knepley       }
23559b6f715bSMatthew G. Knepley       /* Get blocking */
23569b6f715bSMatthew G. Knepley       {
23579b6f715bSMatthew G. Knepley         PetscQuadrature q;
23589b6f715bSMatthew G. Knepley         PetscInt        numBatches, batchSize, numBlocks, blockSize;
23599b6f715bSMatthew G. Knepley         PetscInt        Nq, Nb;
23609b6f715bSMatthew G. Knepley 
23619566063dSJacob Faibussowitsch         PetscCall(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
23629566063dSJacob Faibussowitsch         PetscCall(PetscFEGetQuadrature(fe, &q));
23639566063dSJacob Faibussowitsch         PetscCall(PetscQuadratureGetData(q, NULL, NULL, &Nq, NULL, NULL));
23649566063dSJacob Faibussowitsch         PetscCall(PetscFEGetDimension(fe, &Nb));
236564c72086SMatthew G. Knepley         blockSize = Nb*Nq;
236664c72086SMatthew G. Knepley         batchSize = numBlocks * blockSize;
23679b6f715bSMatthew G. Knepley         chunkSize = numBatches*batchSize;
23689566063dSJacob Faibussowitsch         PetscCall(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
23699b6f715bSMatthew G. Knepley         numChunks = numFaces / chunkSize;
23709b6f715bSMatthew G. Knepley         Nr        = numFaces % chunkSize;
237164c72086SMatthew G. Knepley         offset    = numFaces - Nr;
237264c72086SMatthew G. Knepley       }
23739b6f715bSMatthew G. Knepley       /* Do integration for each field */
23749b6f715bSMatthew G. Knepley       for (chunk = 0; chunk < numChunks; ++chunk) {
23759566063dSJacob Faibussowitsch         PetscCall(PetscFEGeomGetChunk(fgeom, chunk*chunkSize, (chunk+1)*chunkSize, &chunkGeom));
23769566063dSJacob Faibussowitsch         PetscCall(PetscFEIntegrateBd(prob, field, func, chunkSize, chunkGeom, u, probAux, a, fintegral));
23779566063dSJacob Faibussowitsch         PetscCall(PetscFEGeomRestoreChunk(fgeom, 0, offset, &chunkGeom));
237864c72086SMatthew G. Knepley       }
23799566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomGetChunk(fgeom, offset, numFaces, &chunkGeom));
23809566063dSJacob Faibussowitsch       PetscCall(PetscFEIntegrateBd(prob, field, func, Nr, chunkGeom, &u[offset*totDim], probAux, a ? &a[offset*totDimAux] : NULL, &fintegral[offset*Nf]));
23819566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomRestoreChunk(fgeom, offset, numFaces, &chunkGeom));
238264c72086SMatthew G. Knepley       /* Cleanup data arrays */
23839566063dSJacob Faibussowitsch       PetscCall(DMPlexRestoreFEGeom(coordField, pointIS, qGeom, PETSC_TRUE, &fgeom));
23849566063dSJacob Faibussowitsch       PetscCall(PetscQuadratureDestroy(&qGeom));
23859566063dSJacob Faibussowitsch       PetscCall(PetscFree2(u, a));
23869566063dSJacob Faibussowitsch       PetscCall(ISRestoreIndices(pointIS, &points));
238764c72086SMatthew G. Knepley     }
238864c72086SMatthew G. Knepley   }
23899566063dSJacob Faibussowitsch   if (plex)  PetscCall(DMDestroy(&plex));
23909566063dSJacob Faibussowitsch   if (plexA) PetscCall(DMDestroy(&plexA));
23919b6f715bSMatthew G. Knepley   PetscFunctionReturn(0);
23929b6f715bSMatthew G. Knepley }
23939b6f715bSMatthew G. Knepley 
23949b6f715bSMatthew G. Knepley /*@
23959b6f715bSMatthew G. Knepley   DMPlexComputeBdIntegral - Form the integral over the specified boundary from the global input X using pointwise functions specified by the user
23969b6f715bSMatthew G. Knepley 
23979b6f715bSMatthew G. Knepley   Input Parameters:
23989b6f715bSMatthew G. Knepley + dm      - The mesh
23999b6f715bSMatthew G. Knepley . X       - Global input vector
24009b6f715bSMatthew G. Knepley . label   - The boundary DMLabel
24019b6f715bSMatthew G. Knepley . numVals - The number of label values to use, or PETSC_DETERMINE for all values
24029b6f715bSMatthew G. Knepley . vals    - The label values to use, or PETSC_NULL for all values
240367b8a455SSatish Balay . func    - The function to integrate along the boundary
24049b6f715bSMatthew G. Knepley - user    - The user context
24059b6f715bSMatthew G. Knepley 
24069b6f715bSMatthew G. Knepley   Output Parameter:
24079b6f715bSMatthew G. Knepley . integral - Integral for each field
24089b6f715bSMatthew G. Knepley 
24099b6f715bSMatthew G. Knepley   Level: developer
24109b6f715bSMatthew G. Knepley 
24119b6f715bSMatthew G. Knepley .seealso: DMPlexComputeIntegralFEM(), DMPlexComputeBdResidualFEM()
24129b6f715bSMatthew G. Knepley @*/
24139b6f715bSMatthew G. Knepley PetscErrorCode DMPlexComputeBdIntegral(DM dm, Vec X, DMLabel label, PetscInt numVals, const PetscInt vals[],
24149b6f715bSMatthew G. Knepley                                        void (*func)(PetscInt, PetscInt, PetscInt,
24159b6f715bSMatthew G. Knepley                                                     const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
24169b6f715bSMatthew G. Knepley                                                     const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
24179b6f715bSMatthew G. Knepley                                                     PetscReal, const PetscReal[], const PetscReal[], PetscInt, const PetscScalar[], PetscScalar[]),
24189b6f715bSMatthew G. Knepley                                        PetscScalar *integral, void *user)
24199b6f715bSMatthew G. Knepley {
24209b6f715bSMatthew G. Knepley   Vec            locX;
24219b6f715bSMatthew G. Knepley   PetscSection   section;
24229b6f715bSMatthew G. Knepley   DMLabel        depthLabel;
24239b6f715bSMatthew G. Knepley   IS             facetIS;
24249b6f715bSMatthew G. Knepley   PetscInt       dim, Nf, f, v;
24259b6f715bSMatthew G. Knepley 
24269b6f715bSMatthew G. Knepley   PetscFunctionBegin;
24279b6f715bSMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
24289b6f715bSMatthew G. Knepley   PetscValidHeaderSpecific(X, VEC_CLASSID, 2);
24299b6f715bSMatthew G. Knepley   PetscValidPointer(label, 3);
2430dadcf809SJacob Faibussowitsch   if (vals) PetscValidIntPointer(vals, 5);
2431dadcf809SJacob Faibussowitsch   PetscValidScalarPointer(integral, 7);
24329566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_IntegralFEM,dm,0,0,0));
24339566063dSJacob Faibussowitsch   PetscCall(DMPlexGetDepthLabel(dm, &depthLabel));
24349566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
24359566063dSJacob Faibussowitsch   PetscCall(DMLabelGetStratumIS(depthLabel, dim-1, &facetIS));
24369566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
24379566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetNumFields(section, &Nf));
24389b6f715bSMatthew G. Knepley   /* Get local solution with boundary values */
24399566063dSJacob Faibussowitsch   PetscCall(DMGetLocalVector(dm, &locX));
24409566063dSJacob Faibussowitsch   PetscCall(DMPlexInsertBoundaryValues(dm, PETSC_TRUE, locX, 0.0, NULL, NULL, NULL));
24419566063dSJacob Faibussowitsch   PetscCall(DMGlobalToLocalBegin(dm, X, INSERT_VALUES, locX));
24429566063dSJacob Faibussowitsch   PetscCall(DMGlobalToLocalEnd(dm, X, INSERT_VALUES, locX));
24439b6f715bSMatthew G. Knepley   /* Loop over label values */
24449566063dSJacob Faibussowitsch   PetscCall(PetscArrayzero(integral, Nf));
24459b6f715bSMatthew G. Knepley   for (v = 0; v < numVals; ++v) {
24469b6f715bSMatthew G. Knepley     IS           pointIS;
24479b6f715bSMatthew G. Knepley     PetscInt     numFaces, face;
24489b6f715bSMatthew G. Knepley     PetscScalar *fintegral;
24499b6f715bSMatthew G. Knepley 
24509566063dSJacob Faibussowitsch     PetscCall(DMLabelGetStratumIS(label, vals[v], &pointIS));
24519b6f715bSMatthew G. Knepley     if (!pointIS) continue; /* No points with that id on this process */
24529b6f715bSMatthew G. Knepley     {
24539b6f715bSMatthew G. Knepley       IS isectIS;
24549b6f715bSMatthew G. Knepley 
24559b6f715bSMatthew G. Knepley       /* TODO: Special cases of ISIntersect where it is quick to check a priori if one is a superset of the other */
24569566063dSJacob Faibussowitsch       PetscCall(ISIntersect_Caching_Internal(facetIS, pointIS, &isectIS));
24579566063dSJacob Faibussowitsch       PetscCall(ISDestroy(&pointIS));
24589b6f715bSMatthew G. Knepley       pointIS = isectIS;
24599b6f715bSMatthew G. Knepley     }
24609566063dSJacob Faibussowitsch     PetscCall(ISGetLocalSize(pointIS, &numFaces));
24619566063dSJacob Faibussowitsch     PetscCall(PetscCalloc1(numFaces*Nf, &fintegral));
24629566063dSJacob Faibussowitsch     PetscCall(DMPlexComputeBdIntegral_Internal(dm, locX, pointIS, func, fintegral, user));
24639b6f715bSMatthew G. Knepley     /* Sum point contributions into integral */
24649b6f715bSMatthew G. Knepley     for (f = 0; f < Nf; ++f) for (face = 0; face < numFaces; ++face) integral[f] += fintegral[face*Nf+f];
24659566063dSJacob Faibussowitsch     PetscCall(PetscFree(fintegral));
24669566063dSJacob Faibussowitsch     PetscCall(ISDestroy(&pointIS));
24679b6f715bSMatthew G. Knepley   }
24689566063dSJacob Faibussowitsch   PetscCall(DMRestoreLocalVector(dm, &locX));
24699566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&facetIS));
24709566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_IntegralFEM,dm,0,0,0));
247164c72086SMatthew G. Knepley   PetscFunctionReturn(0);
247264c72086SMatthew G. Knepley }
247364c72086SMatthew G. Knepley 
2474d69c5d34SMatthew G. Knepley /*@
2475cf51de39SMatthew G. Knepley   DMPlexComputeInterpolatorNested - Form the local portion of the interpolation matrix I from the coarse DM to a uniformly refined DM.
2476d69c5d34SMatthew G. Knepley 
2477d69c5d34SMatthew G. Knepley   Input Parameters:
2478cf51de39SMatthew G. Knepley + dmc  - The coarse mesh
2479cf51de39SMatthew G. Knepley . dmf  - The fine mesh
2480cf51de39SMatthew G. Knepley . isRefined - Flag indicating regular refinement, rather than the same topology
2481d69c5d34SMatthew G. Knepley - user - The user context
2482d69c5d34SMatthew G. Knepley 
2483d69c5d34SMatthew G. Knepley   Output Parameter:
2484934789fcSMatthew G. Knepley . In  - The interpolation matrix
2485d69c5d34SMatthew G. Knepley 
2486d69c5d34SMatthew G. Knepley   Level: developer
2487d69c5d34SMatthew G. Knepley 
248868132eb9SMatthew G. Knepley .seealso: DMPlexComputeInterpolatorGeneral(), DMPlexComputeJacobianFEM()
2489d69c5d34SMatthew G. Knepley @*/
2490cf51de39SMatthew G. Knepley PetscErrorCode DMPlexComputeInterpolatorNested(DM dmc, DM dmf, PetscBool isRefined, Mat In, void *user)
2491d69c5d34SMatthew G. Knepley {
2492d69c5d34SMatthew G. Knepley   DM_Plex          *mesh  = (DM_Plex *) dmc->data;
2493d69c5d34SMatthew G. Knepley   const char       *name  = "Interpolator";
2494d69c5d34SMatthew G. Knepley   PetscFE          *feRef;
249597c42addSMatthew G. Knepley   PetscFV          *fvRef;
2496d69c5d34SMatthew G. Knepley   PetscSection      fsection, fglobalSection;
2497d69c5d34SMatthew G. Knepley   PetscSection      csection, cglobalSection;
2498d69c5d34SMatthew G. Knepley   PetscScalar      *elemMat;
2499485ad865SMatthew G. Knepley   PetscInt          dim, Nf, f, fieldI, fieldJ, offsetI, offsetJ, cStart, cEnd, c;
25002ea9c922SToby Isaac   PetscInt          cTotDim=0, rTotDim = 0;
2501d69c5d34SMatthew G. Knepley 
2502d69c5d34SMatthew G. Knepley   PetscFunctionBegin;
25039566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_InterpolatorFEM,dmc,dmf,0,0));
25049566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dmf, &dim));
25059566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dmf, &fsection));
25069566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dmf, &fglobalSection));
25079566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dmc, &csection));
25089566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dmc, &cglobalSection));
25099566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetNumFields(fsection, &Nf));
25109566063dSJacob Faibussowitsch   PetscCall(DMPlexGetSimplexOrBoxCells(dmc, 0, &cStart, &cEnd));
25119566063dSJacob Faibussowitsch   PetscCall(PetscCalloc2(Nf, &feRef, Nf, &fvRef));
2512d69c5d34SMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
25132ea9c922SToby Isaac     PetscObject  obj, objc;
25142ea9c922SToby Isaac     PetscClassId id, idc;
25152ea9c922SToby Isaac     PetscInt     rNb = 0, Nc = 0, cNb = 0;
2516d69c5d34SMatthew G. Knepley 
25179566063dSJacob Faibussowitsch     PetscCall(DMGetField(dmf, f, NULL, &obj));
25189566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
251997c42addSMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
252097c42addSMatthew G. Knepley       PetscFE fe = (PetscFE) obj;
252197c42addSMatthew G. Knepley 
2522cf51de39SMatthew G. Knepley       if (isRefined) {
25239566063dSJacob Faibussowitsch         PetscCall(PetscFERefine(fe, &feRef[f]));
2524cf51de39SMatthew G. Knepley       } else {
25259566063dSJacob Faibussowitsch         PetscCall(PetscObjectReference((PetscObject) fe));
2526cf51de39SMatthew G. Knepley         feRef[f] = fe;
2527cf51de39SMatthew G. Knepley       }
25289566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDimension(feRef[f], &rNb));
25299566063dSJacob Faibussowitsch       PetscCall(PetscFEGetNumComponents(fe, &Nc));
253097c42addSMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
253197c42addSMatthew G. Knepley       PetscFV        fv = (PetscFV) obj;
253297c42addSMatthew G. Knepley       PetscDualSpace Q;
253397c42addSMatthew G. Knepley 
2534cf51de39SMatthew G. Knepley       if (isRefined) {
25359566063dSJacob Faibussowitsch         PetscCall(PetscFVRefine(fv, &fvRef[f]));
2536cf51de39SMatthew G. Knepley       } else {
25379566063dSJacob Faibussowitsch         PetscCall(PetscObjectReference((PetscObject) fv));
2538cf51de39SMatthew G. Knepley         fvRef[f] = fv;
2539cf51de39SMatthew G. Knepley       }
25409566063dSJacob Faibussowitsch       PetscCall(PetscFVGetDualSpace(fvRef[f], &Q));
25419566063dSJacob Faibussowitsch       PetscCall(PetscDualSpaceGetDimension(Q, &rNb));
25429566063dSJacob Faibussowitsch       PetscCall(PetscFVGetDualSpace(fv, &Q));
25439566063dSJacob Faibussowitsch       PetscCall(PetscFVGetNumComponents(fv, &Nc));
254497c42addSMatthew G. Knepley     }
25459566063dSJacob Faibussowitsch     PetscCall(DMGetField(dmc, f, NULL, &objc));
25469566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(objc, &idc));
25472ea9c922SToby Isaac     if (idc == PETSCFE_CLASSID) {
25482ea9c922SToby Isaac       PetscFE fe = (PetscFE) objc;
25492ea9c922SToby Isaac 
25509566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDimension(fe, &cNb));
25512ea9c922SToby Isaac     } else if (id == PETSCFV_CLASSID) {
25522ea9c922SToby Isaac       PetscFV        fv = (PetscFV) obj;
25532ea9c922SToby Isaac       PetscDualSpace Q;
25542ea9c922SToby Isaac 
25559566063dSJacob Faibussowitsch       PetscCall(PetscFVGetDualSpace(fv, &Q));
25569566063dSJacob Faibussowitsch       PetscCall(PetscDualSpaceGetDimension(Q, &cNb));
2557d69c5d34SMatthew G. Knepley     }
25582ea9c922SToby Isaac     rTotDim += rNb;
25592ea9c922SToby Isaac     cTotDim += cNb;
25602ea9c922SToby Isaac   }
25619566063dSJacob Faibussowitsch   PetscCall(PetscMalloc1(rTotDim*cTotDim,&elemMat));
25629566063dSJacob Faibussowitsch   PetscCall(PetscArrayzero(elemMat, rTotDim*cTotDim));
2563d69c5d34SMatthew G. Knepley   for (fieldI = 0, offsetI = 0; fieldI < Nf; ++fieldI) {
2564d69c5d34SMatthew G. Knepley     PetscDualSpace   Qref;
2565d69c5d34SMatthew G. Knepley     PetscQuadrature  f;
2566d69c5d34SMatthew G. Knepley     const PetscReal *qpoints, *qweights;
2567d69c5d34SMatthew G. Knepley     PetscReal       *points;
2568d69c5d34SMatthew G. Knepley     PetscInt         npoints = 0, Nc, Np, fpdim, i, k, p, d;
2569d69c5d34SMatthew G. Knepley 
2570d69c5d34SMatthew G. Knepley     /* Compose points from all dual basis functionals */
257197c42addSMatthew G. Knepley     if (feRef[fieldI]) {
25729566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDualSpace(feRef[fieldI], &Qref));
25739566063dSJacob Faibussowitsch       PetscCall(PetscFEGetNumComponents(feRef[fieldI], &Nc));
257497c42addSMatthew G. Knepley     } else {
25759566063dSJacob Faibussowitsch       PetscCall(PetscFVGetDualSpace(fvRef[fieldI], &Qref));
25769566063dSJacob Faibussowitsch       PetscCall(PetscFVGetNumComponents(fvRef[fieldI], &Nc));
257797c42addSMatthew G. Knepley     }
25789566063dSJacob Faibussowitsch     PetscCall(PetscDualSpaceGetDimension(Qref, &fpdim));
2579d69c5d34SMatthew G. Knepley     for (i = 0; i < fpdim; ++i) {
25809566063dSJacob Faibussowitsch       PetscCall(PetscDualSpaceGetFunctional(Qref, i, &f));
25819566063dSJacob Faibussowitsch       PetscCall(PetscQuadratureGetData(f, NULL, NULL, &Np, NULL, NULL));
2582d69c5d34SMatthew G. Knepley       npoints += Np;
2583d69c5d34SMatthew G. Knepley     }
25849566063dSJacob Faibussowitsch     PetscCall(PetscMalloc1(npoints*dim,&points));
2585d69c5d34SMatthew G. Knepley     for (i = 0, k = 0; i < fpdim; ++i) {
25869566063dSJacob Faibussowitsch       PetscCall(PetscDualSpaceGetFunctional(Qref, i, &f));
25879566063dSJacob Faibussowitsch       PetscCall(PetscQuadratureGetData(f, NULL, NULL, &Np, &qpoints, NULL));
2588d69c5d34SMatthew G. Knepley       for (p = 0; p < Np; ++p, ++k) for (d = 0; d < dim; ++d) points[k*dim+d] = qpoints[p*dim+d];
2589d69c5d34SMatthew G. Knepley     }
2590d69c5d34SMatthew G. Knepley 
2591d69c5d34SMatthew G. Knepley     for (fieldJ = 0, offsetJ = 0; fieldJ < Nf; ++fieldJ) {
259297c42addSMatthew G. Knepley       PetscObject  obj;
259397c42addSMatthew G. Knepley       PetscClassId id;
25949c3cf19fSMatthew G. Knepley       PetscInt     NcJ = 0, cpdim = 0, j, qNc;
2595d69c5d34SMatthew G. Knepley 
25969566063dSJacob Faibussowitsch       PetscCall(DMGetField(dmc, fieldJ, NULL, &obj));
25979566063dSJacob Faibussowitsch       PetscCall(PetscObjectGetClassId(obj, &id));
259897c42addSMatthew G. Knepley       if (id == PETSCFE_CLASSID) {
259997c42addSMatthew G. Knepley         PetscFE           fe = (PetscFE) obj;
2600ef0bb6c7SMatthew G. Knepley         PetscTabulation T  = NULL;
2601d69c5d34SMatthew G. Knepley 
2602d69c5d34SMatthew G. Knepley         /* Evaluate basis at points */
26039566063dSJacob Faibussowitsch         PetscCall(PetscFEGetNumComponents(fe, &NcJ));
26049566063dSJacob Faibussowitsch         PetscCall(PetscFEGetDimension(fe, &cpdim));
2605ffe73a53SMatthew G. Knepley         /* For now, fields only interpolate themselves */
2606ffe73a53SMatthew G. Knepley         if (fieldI == fieldJ) {
26075f80ce2aSJacob Faibussowitsch           PetscCheck(Nc == NcJ,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of components in fine space field %D does not match coarse field %D", Nc, NcJ);
26089566063dSJacob Faibussowitsch           PetscCall(PetscFECreateTabulation(fe, 1, npoints, points, 0, &T));
2609d69c5d34SMatthew G. Knepley           for (i = 0, k = 0; i < fpdim; ++i) {
26109566063dSJacob Faibussowitsch             PetscCall(PetscDualSpaceGetFunctional(Qref, i, &f));
26119566063dSJacob Faibussowitsch             PetscCall(PetscQuadratureGetData(f, NULL, &qNc, &Np, NULL, &qweights));
26125f80ce2aSJacob Faibussowitsch             PetscCheck(qNc == NcJ,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of components in quadrature %D does not match coarse field %D", qNc, NcJ);
2613d69c5d34SMatthew G. Knepley             for (p = 0; p < Np; ++p, ++k) {
261436a6d9c0SMatthew G. Knepley               for (j = 0; j < cpdim; ++j) {
2615d172c84bSMatthew G. Knepley                 /*
2616d172c84bSMatthew G. Knepley                    cTotDim:            Total columns in element interpolation matrix, sum of number of dual basis functionals in each field
2617d172c84bSMatthew G. Knepley                    offsetI, offsetJ:   Offsets into the larger element interpolation matrix for different fields
2618d172c84bSMatthew G. Knepley                    fpdim, i, cpdim, j: Dofs for fine and coarse grids, correspond to dual space basis functionals
2619d172c84bSMatthew G. Knepley                    qNC, Nc, Ncj, c:    Number of components in this field
2620d172c84bSMatthew G. Knepley                    Np, p:              Number of quad points in the fine grid functional i
2621d172c84bSMatthew G. Knepley                    k:                  i*Np + p, overall point number for the interpolation
2622d172c84bSMatthew G. Knepley                 */
2623ef0bb6c7SMatthew 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];
262436a6d9c0SMatthew G. Knepley               }
2625d69c5d34SMatthew G. Knepley             }
2626d69c5d34SMatthew G. Knepley           }
26279566063dSJacob Faibussowitsch           PetscCall(PetscTabulationDestroy(&T));
2628ffe73a53SMatthew G. Knepley         }
262997c42addSMatthew G. Knepley       } else if (id == PETSCFV_CLASSID) {
263097c42addSMatthew G. Knepley         PetscFV        fv = (PetscFV) obj;
263197c42addSMatthew G. Knepley 
263297c42addSMatthew G. Knepley         /* Evaluate constant function at points */
26339566063dSJacob Faibussowitsch         PetscCall(PetscFVGetNumComponents(fv, &NcJ));
263497c42addSMatthew G. Knepley         cpdim = 1;
263597c42addSMatthew G. Knepley         /* For now, fields only interpolate themselves */
263697c42addSMatthew G. Knepley         if (fieldI == fieldJ) {
26375f80ce2aSJacob Faibussowitsch           PetscCheck(Nc == NcJ,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of components in fine space field %D does not match coarse field %D", Nc, NcJ);
263897c42addSMatthew G. Knepley           for (i = 0, k = 0; i < fpdim; ++i) {
26399566063dSJacob Faibussowitsch             PetscCall(PetscDualSpaceGetFunctional(Qref, i, &f));
26409566063dSJacob Faibussowitsch             PetscCall(PetscQuadratureGetData(f, NULL, &qNc, &Np, NULL, &qweights));
26415f80ce2aSJacob Faibussowitsch             PetscCheck(qNc == NcJ,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of components in quadrature %D does not match coarse field %D", qNc, NcJ);
264297c42addSMatthew G. Knepley             for (p = 0; p < Np; ++p, ++k) {
264397c42addSMatthew G. Knepley               for (j = 0; j < cpdim; ++j) {
2644458eb97cSMatthew G. Knepley                 for (c = 0; c < Nc; ++c) elemMat[(offsetI + i)*cTotDim + offsetJ + j] += 1.0*qweights[p*qNc+c];
264597c42addSMatthew G. Knepley               }
264697c42addSMatthew G. Knepley             }
264797c42addSMatthew G. Knepley           }
264897c42addSMatthew G. Knepley         }
264997c42addSMatthew G. Knepley       }
2650d172c84bSMatthew G. Knepley       offsetJ += cpdim;
2651d69c5d34SMatthew G. Knepley     }
2652d172c84bSMatthew G. Knepley     offsetI += fpdim;
26539566063dSJacob Faibussowitsch     PetscCall(PetscFree(points));
2654d69c5d34SMatthew G. Knepley   }
26559566063dSJacob Faibussowitsch   if (mesh->printFEM > 1) PetscCall(DMPrintCellMatrix(0, name, rTotDim, cTotDim, elemMat));
26567f5b169aSMatthew G. Knepley   /* Preallocate matrix */
26577f5b169aSMatthew G. Knepley   {
2658c094ef40SMatthew G. Knepley     Mat          preallocator;
2659c094ef40SMatthew G. Knepley     PetscScalar *vals;
2660c094ef40SMatthew G. Knepley     PetscInt    *cellCIndices, *cellFIndices;
2661c094ef40SMatthew G. Knepley     PetscInt     locRows, locCols, cell;
26627f5b169aSMatthew G. Knepley 
26639566063dSJacob Faibussowitsch     PetscCall(MatGetLocalSize(In, &locRows, &locCols));
26649566063dSJacob Faibussowitsch     PetscCall(MatCreate(PetscObjectComm((PetscObject) In), &preallocator));
26659566063dSJacob Faibussowitsch     PetscCall(MatSetType(preallocator, MATPREALLOCATOR));
26669566063dSJacob Faibussowitsch     PetscCall(MatSetSizes(preallocator, locRows, locCols, PETSC_DETERMINE, PETSC_DETERMINE));
26679566063dSJacob Faibussowitsch     PetscCall(MatSetUp(preallocator));
26689566063dSJacob Faibussowitsch     PetscCall(PetscCalloc3(rTotDim*cTotDim, &vals,cTotDim,&cellCIndices,rTotDim,&cellFIndices));
26697f5b169aSMatthew G. Knepley     for (cell = cStart; cell < cEnd; ++cell) {
2670cf51de39SMatthew G. Knepley       if (isRefined) {
26719566063dSJacob Faibussowitsch         PetscCall(DMPlexMatGetClosureIndicesRefined(dmf, fsection, fglobalSection, dmc, csection, cglobalSection, cell, cellCIndices, cellFIndices));
26729566063dSJacob Faibussowitsch         PetscCall(MatSetValues(preallocator, rTotDim, cellFIndices, cTotDim, cellCIndices, vals, INSERT_VALUES));
2673cf51de39SMatthew G. Knepley       } else {
26749566063dSJacob Faibussowitsch         PetscCall(DMPlexMatSetClosureGeneral(dmf, fsection, fglobalSection, dmc, csection, cglobalSection, preallocator, cell, vals, INSERT_VALUES));
2675cf51de39SMatthew G. Knepley       }
26767f5b169aSMatthew G. Knepley     }
26779566063dSJacob Faibussowitsch     PetscCall(PetscFree3(vals,cellCIndices,cellFIndices));
26789566063dSJacob Faibussowitsch     PetscCall(MatAssemblyBegin(preallocator, MAT_FINAL_ASSEMBLY));
26799566063dSJacob Faibussowitsch     PetscCall(MatAssemblyEnd(preallocator, MAT_FINAL_ASSEMBLY));
26809566063dSJacob Faibussowitsch     PetscCall(MatPreallocatorPreallocate(preallocator, PETSC_TRUE, In));
26819566063dSJacob Faibussowitsch     PetscCall(MatDestroy(&preallocator));
26827f5b169aSMatthew G. Knepley   }
26837f5b169aSMatthew G. Knepley   /* Fill matrix */
26849566063dSJacob Faibussowitsch   PetscCall(MatZeroEntries(In));
2685d69c5d34SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
2686cf51de39SMatthew G. Knepley     if (isRefined) {
26879566063dSJacob Faibussowitsch       PetscCall(DMPlexMatSetClosureRefined(dmf, fsection, fglobalSection, dmc, csection, cglobalSection, In, c, elemMat, INSERT_VALUES));
2688cf51de39SMatthew G. Knepley     } else {
26899566063dSJacob Faibussowitsch       PetscCall(DMPlexMatSetClosureGeneral(dmf, fsection, fglobalSection, dmc, csection, cglobalSection, In, c, elemMat, INSERT_VALUES));
2690cf51de39SMatthew G. Knepley     }
2691d69c5d34SMatthew G. Knepley   }
26929566063dSJacob Faibussowitsch   for (f = 0; f < Nf; ++f) PetscCall(PetscFEDestroy(&feRef[f]));
26939566063dSJacob Faibussowitsch   PetscCall(PetscFree2(feRef,fvRef));
26949566063dSJacob Faibussowitsch   PetscCall(PetscFree(elemMat));
26959566063dSJacob Faibussowitsch   PetscCall(MatAssemblyBegin(In, MAT_FINAL_ASSEMBLY));
26969566063dSJacob Faibussowitsch   PetscCall(MatAssemblyEnd(In, MAT_FINAL_ASSEMBLY));
26979318fe57SMatthew G. Knepley   if (mesh->printFEM > 1) {
26989566063dSJacob Faibussowitsch     PetscCall(PetscPrintf(PetscObjectComm((PetscObject)In), "%s:\n", name));
26999566063dSJacob Faibussowitsch     PetscCall(MatChop(In, 1.0e-10));
27009566063dSJacob Faibussowitsch     PetscCall(MatView(In, NULL));
2701d69c5d34SMatthew G. Knepley   }
27029566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_InterpolatorFEM,dmc,dmf,0,0));
2703d69c5d34SMatthew G. Knepley   PetscFunctionReturn(0);
2704d69c5d34SMatthew G. Knepley }
27056c73c22cSMatthew G. Knepley 
2706bd041c0cSMatthew G. Knepley PetscErrorCode DMPlexComputeMassMatrixNested(DM dmc, DM dmf, Mat mass, void *user)
2707bd041c0cSMatthew G. Knepley {
2708bd041c0cSMatthew G. Knepley   SETERRQ(PetscObjectComm((PetscObject) dmc), PETSC_ERR_SUP, "Laziness");
2709bd041c0cSMatthew G. Knepley }
2710bd041c0cSMatthew G. Knepley 
271168132eb9SMatthew G. Knepley /*@
271268132eb9SMatthew G. Knepley   DMPlexComputeInterpolatorGeneral - Form the local portion of the interpolation matrix I from the coarse DM to a non-nested fine DM.
271368132eb9SMatthew G. Knepley 
271468132eb9SMatthew G. Knepley   Input Parameters:
271568132eb9SMatthew G. Knepley + dmf  - The fine mesh
271668132eb9SMatthew G. Knepley . dmc  - The coarse mesh
271768132eb9SMatthew G. Knepley - user - The user context
271868132eb9SMatthew G. Knepley 
271968132eb9SMatthew G. Knepley   Output Parameter:
272068132eb9SMatthew G. Knepley . In  - The interpolation matrix
272168132eb9SMatthew G. Knepley 
272268132eb9SMatthew G. Knepley   Level: developer
272368132eb9SMatthew G. Knepley 
272468132eb9SMatthew G. Knepley .seealso: DMPlexComputeInterpolatorNested(), DMPlexComputeJacobianFEM()
272568132eb9SMatthew G. Knepley @*/
272668132eb9SMatthew G. Knepley PetscErrorCode DMPlexComputeInterpolatorGeneral(DM dmc, DM dmf, Mat In, void *user)
27274ef9d792SMatthew G. Knepley {
272864e98e1dSMatthew G. Knepley   DM_Plex       *mesh = (DM_Plex *) dmf->data;
272964e98e1dSMatthew G. Knepley   const char    *name = "Interpolator";
27304ef9d792SMatthew G. Knepley   PetscDS        prob;
27314ef9d792SMatthew G. Knepley   PetscSection   fsection, csection, globalFSection, globalCSection;
2732e8f14785SLisandro Dalcin   PetscHSetIJ    ht;
27334ef9d792SMatthew G. Knepley   PetscLayout    rLayout;
27344ef9d792SMatthew G. Knepley   PetscInt      *dnz, *onz;
27354ef9d792SMatthew G. Knepley   PetscInt       locRows, rStart, rEnd;
27364ef9d792SMatthew G. Knepley   PetscReal     *x, *v0, *J, *invJ, detJ;
27374ef9d792SMatthew G. Knepley   PetscReal     *v0c, *Jc, *invJc, detJc;
27384ef9d792SMatthew G. Knepley   PetscScalar   *elemMat;
27394ef9d792SMatthew G. Knepley   PetscInt       dim, Nf, field, totDim, cStart, cEnd, cell, ccell;
27404ef9d792SMatthew G. Knepley 
27414ef9d792SMatthew G. Knepley   PetscFunctionBegin;
27429566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_InterpolatorFEM,dmc,dmf,0,0));
27439566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateDim(dmc, &dim));
27449566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dmc, &prob));
27459566063dSJacob Faibussowitsch   PetscCall(PetscDSGetWorkspace(prob, &x, NULL, NULL, NULL, NULL));
27469566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumFields(prob, &Nf));
27479566063dSJacob Faibussowitsch   PetscCall(PetscMalloc3(dim,&v0,dim*dim,&J,dim*dim,&invJ));
27489566063dSJacob Faibussowitsch   PetscCall(PetscMalloc3(dim,&v0c,dim*dim,&Jc,dim*dim,&invJc));
27499566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dmf, &fsection));
27509566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dmf, &globalFSection));
27519566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dmc, &csection));
27529566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dmc, &globalCSection));
27539566063dSJacob Faibussowitsch   PetscCall(DMPlexGetHeightStratum(dmf, 0, &cStart, &cEnd));
27549566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(prob, &totDim));
27559566063dSJacob Faibussowitsch   PetscCall(PetscMalloc1(totDim, &elemMat));
27564ef9d792SMatthew G. Knepley 
27579566063dSJacob Faibussowitsch   PetscCall(MatGetLocalSize(In, &locRows, NULL));
27589566063dSJacob Faibussowitsch   PetscCall(PetscLayoutCreate(PetscObjectComm((PetscObject) In), &rLayout));
27599566063dSJacob Faibussowitsch   PetscCall(PetscLayoutSetLocalSize(rLayout, locRows));
27609566063dSJacob Faibussowitsch   PetscCall(PetscLayoutSetBlockSize(rLayout, 1));
27619566063dSJacob Faibussowitsch   PetscCall(PetscLayoutSetUp(rLayout));
27629566063dSJacob Faibussowitsch   PetscCall(PetscLayoutGetRange(rLayout, &rStart, &rEnd));
27639566063dSJacob Faibussowitsch   PetscCall(PetscLayoutDestroy(&rLayout));
27649566063dSJacob Faibussowitsch   PetscCall(PetscCalloc2(locRows,&dnz,locRows,&onz));
27659566063dSJacob Faibussowitsch   PetscCall(PetscHSetIJCreate(&ht));
27664ef9d792SMatthew G. Knepley   for (field = 0; field < Nf; ++field) {
27674ef9d792SMatthew G. Knepley     PetscObject      obj;
27684ef9d792SMatthew G. Knepley     PetscClassId     id;
2769c0d7054bSMatthew G. Knepley     PetscDualSpace   Q = NULL;
27704ef9d792SMatthew G. Knepley     PetscQuadrature  f;
277117f047d8SMatthew G. Knepley     const PetscReal *qpoints;
277217f047d8SMatthew G. Knepley     PetscInt         Nc, Np, fpdim, i, d;
27734ef9d792SMatthew G. Knepley 
27749566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, field, &obj));
27759566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
27764ef9d792SMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
27774ef9d792SMatthew G. Knepley       PetscFE fe = (PetscFE) obj;
27784ef9d792SMatthew G. Knepley 
27799566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDualSpace(fe, &Q));
27809566063dSJacob Faibussowitsch       PetscCall(PetscFEGetNumComponents(fe, &Nc));
27814ef9d792SMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
27824ef9d792SMatthew G. Knepley       PetscFV fv = (PetscFV) obj;
27834ef9d792SMatthew G. Knepley 
27849566063dSJacob Faibussowitsch       PetscCall(PetscFVGetDualSpace(fv, &Q));
27854ef9d792SMatthew G. Knepley       Nc   = 1;
27864ef9d792SMatthew G. Knepley     }
27879566063dSJacob Faibussowitsch     PetscCall(PetscDualSpaceGetDimension(Q, &fpdim));
27884ef9d792SMatthew G. Knepley     /* For each fine grid cell */
27894ef9d792SMatthew G. Knepley     for (cell = cStart; cell < cEnd; ++cell) {
27904ef9d792SMatthew G. Knepley       PetscInt *findices,   *cindices;
27914ef9d792SMatthew G. Knepley       PetscInt  numFIndices, numCIndices;
27924ef9d792SMatthew G. Knepley 
27939566063dSJacob Faibussowitsch       PetscCall(DMPlexGetClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
27949566063dSJacob Faibussowitsch       PetscCall(DMPlexComputeCellGeometryFEM(dmf, cell, NULL, v0, J, invJ, &detJ));
27955f80ce2aSJacob Faibussowitsch       PetscCheck(numFIndices == fpdim,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of fine indices %D != %D dual basis vecs", numFIndices, fpdim);
27964ef9d792SMatthew G. Knepley       for (i = 0; i < fpdim; ++i) {
27974ef9d792SMatthew G. Knepley         Vec             pointVec;
27984ef9d792SMatthew G. Knepley         PetscScalar    *pV;
27993a93e3b7SToby Isaac         PetscSF         coarseCellSF = NULL;
28003a93e3b7SToby Isaac         const PetscSFNode *coarseCells;
28019c3cf19fSMatthew G. Knepley         PetscInt        numCoarseCells, q, c;
28024ef9d792SMatthew G. Knepley 
28034ef9d792SMatthew G. Knepley         /* Get points from the dual basis functional quadrature */
28049566063dSJacob Faibussowitsch         PetscCall(PetscDualSpaceGetFunctional(Q, i, &f));
28059566063dSJacob Faibussowitsch         PetscCall(PetscQuadratureGetData(f, NULL, NULL, &Np, &qpoints, NULL));
28069566063dSJacob Faibussowitsch         PetscCall(VecCreateSeq(PETSC_COMM_SELF, Np*dim, &pointVec));
28079566063dSJacob Faibussowitsch         PetscCall(VecSetBlockSize(pointVec, dim));
28089566063dSJacob Faibussowitsch         PetscCall(VecGetArray(pointVec, &pV));
28094ef9d792SMatthew G. Knepley         for (q = 0; q < Np; ++q) {
2810c330f8ffSToby Isaac           const PetscReal xi0[3] = {-1., -1., -1.};
2811c330f8ffSToby Isaac 
28124ef9d792SMatthew G. Knepley           /* Transform point to real space */
2813c330f8ffSToby Isaac           CoordinatesRefToReal(dim, dim, xi0, v0, J, &qpoints[q*dim], x);
28144ef9d792SMatthew G. Knepley           for (d = 0; d < dim; ++d) pV[q*dim+d] = x[d];
28154ef9d792SMatthew G. Knepley         }
28169566063dSJacob Faibussowitsch         PetscCall(VecRestoreArray(pointVec, &pV));
28174ef9d792SMatthew G. Knepley         /* Get set of coarse cells that overlap points (would like to group points by coarse cell) */
28181555c271SMatthew G. Knepley         /* OPT: Pack all quad points from fine cell */
28199566063dSJacob Faibussowitsch         PetscCall(DMLocatePoints(dmc, pointVec, DM_POINTLOCATION_NEAREST, &coarseCellSF));
28209566063dSJacob Faibussowitsch         PetscCall(PetscSFViewFromOptions(coarseCellSF, NULL, "-interp_sf_view"));
28214ef9d792SMatthew G. Knepley         /* Update preallocation info */
28229566063dSJacob Faibussowitsch         PetscCall(PetscSFGetGraph(coarseCellSF, NULL, &numCoarseCells, NULL, &coarseCells));
28235f80ce2aSJacob Faibussowitsch         PetscCheck(numCoarseCells == Np,PETSC_COMM_SELF,PETSC_ERR_PLIB,"Not all closure points located");
28249c3cf19fSMatthew G. Knepley         {
2825e8f14785SLisandro Dalcin           PetscHashIJKey key;
2826e8f14785SLisandro Dalcin           PetscBool      missing;
28274ef9d792SMatthew G. Knepley 
2828e8f14785SLisandro Dalcin           key.i = findices[i];
2829e8f14785SLisandro Dalcin           if (key.i >= 0) {
28304ef9d792SMatthew G. Knepley             /* Get indices for coarse elements */
28314ef9d792SMatthew G. Knepley             for (ccell = 0; ccell < numCoarseCells; ++ccell) {
28329566063dSJacob Faibussowitsch               PetscCall(DMPlexGetClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
28334ef9d792SMatthew G. Knepley               for (c = 0; c < numCIndices; ++c) {
2834e8f14785SLisandro Dalcin                 key.j = cindices[c];
2835e8f14785SLisandro Dalcin                 if (key.j < 0) continue;
28369566063dSJacob Faibussowitsch                 PetscCall(PetscHSetIJQueryAdd(ht, key, &missing));
28374ef9d792SMatthew G. Knepley                 if (missing) {
2838e8f14785SLisandro Dalcin                   if ((key.j >= rStart) && (key.j < rEnd)) ++dnz[key.i-rStart];
2839e8f14785SLisandro Dalcin                   else                                     ++onz[key.i-rStart];
28404ef9d792SMatthew G. Knepley                 }
28414ef9d792SMatthew G. Knepley               }
28429566063dSJacob Faibussowitsch               PetscCall(DMPlexRestoreClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
28434ef9d792SMatthew G. Knepley             }
28444ef9d792SMatthew G. Knepley           }
28458c543595SMatthew G. Knepley         }
28469566063dSJacob Faibussowitsch         PetscCall(PetscSFDestroy(&coarseCellSF));
28479566063dSJacob Faibussowitsch         PetscCall(VecDestroy(&pointVec));
28484ef9d792SMatthew G. Knepley       }
28499566063dSJacob Faibussowitsch       PetscCall(DMPlexRestoreClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
28504ef9d792SMatthew G. Knepley     }
28514ef9d792SMatthew G. Knepley   }
28529566063dSJacob Faibussowitsch   PetscCall(PetscHSetIJDestroy(&ht));
28539566063dSJacob Faibussowitsch   PetscCall(MatXAIJSetPreallocation(In, 1, dnz, onz, NULL, NULL));
28549566063dSJacob Faibussowitsch   PetscCall(MatSetOption(In, MAT_NEW_NONZERO_ALLOCATION_ERR,PETSC_TRUE));
28559566063dSJacob Faibussowitsch   PetscCall(PetscFree2(dnz,onz));
28564ef9d792SMatthew G. Knepley   for (field = 0; field < Nf; ++field) {
28574ef9d792SMatthew G. Knepley     PetscObject       obj;
28584ef9d792SMatthew G. Knepley     PetscClassId      id;
2859c0d7054bSMatthew G. Knepley     PetscDualSpace    Q = NULL;
2860ef0bb6c7SMatthew G. Knepley     PetscTabulation T = NULL;
28614ef9d792SMatthew G. Knepley     PetscQuadrature   f;
28624ef9d792SMatthew G. Knepley     const PetscReal  *qpoints, *qweights;
28639c3cf19fSMatthew G. Knepley     PetscInt          Nc, qNc, Np, fpdim, i, d;
28644ef9d792SMatthew G. Knepley 
28659566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, field, &obj));
28669566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
28674ef9d792SMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
28684ef9d792SMatthew G. Knepley       PetscFE fe = (PetscFE) obj;
28694ef9d792SMatthew G. Knepley 
28709566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDualSpace(fe, &Q));
28719566063dSJacob Faibussowitsch       PetscCall(PetscFEGetNumComponents(fe, &Nc));
28729566063dSJacob Faibussowitsch       PetscCall(PetscFECreateTabulation(fe, 1, 1, x, 0, &T));
28734ef9d792SMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
28744ef9d792SMatthew G. Knepley       PetscFV fv = (PetscFV) obj;
28754ef9d792SMatthew G. Knepley 
28769566063dSJacob Faibussowitsch       PetscCall(PetscFVGetDualSpace(fv, &Q));
28774ef9d792SMatthew G. Knepley       Nc   = 1;
287898921bdaSJacob Faibussowitsch     } else SETERRQ(PetscObjectComm((PetscObject)dmc),PETSC_ERR_ARG_WRONG,"Unknown discretization type for field %D",field);
28799566063dSJacob Faibussowitsch     PetscCall(PetscDualSpaceGetDimension(Q, &fpdim));
28804ef9d792SMatthew G. Knepley     /* For each fine grid cell */
28814ef9d792SMatthew G. Knepley     for (cell = cStart; cell < cEnd; ++cell) {
28824ef9d792SMatthew G. Knepley       PetscInt *findices,   *cindices;
28834ef9d792SMatthew G. Knepley       PetscInt  numFIndices, numCIndices;
28844ef9d792SMatthew G. Knepley 
28859566063dSJacob Faibussowitsch       PetscCall(DMPlexGetClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
28869566063dSJacob Faibussowitsch       PetscCall(DMPlexComputeCellGeometryFEM(dmf, cell, NULL, v0, J, invJ, &detJ));
28875f80ce2aSJacob Faibussowitsch       PetscCheck(numFIndices == fpdim,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of fine indices %D != %D dual basis vecs", numFIndices, fpdim);
28884ef9d792SMatthew G. Knepley       for (i = 0; i < fpdim; ++i) {
28894ef9d792SMatthew G. Knepley         Vec             pointVec;
28904ef9d792SMatthew G. Knepley         PetscScalar    *pV;
289112111d7cSToby Isaac         PetscSF         coarseCellSF = NULL;
28923a93e3b7SToby Isaac         const PetscSFNode *coarseCells;
289317f047d8SMatthew G. Knepley         PetscInt        numCoarseCells, cpdim, q, c, j;
28944ef9d792SMatthew G. Knepley 
28954ef9d792SMatthew G. Knepley         /* Get points from the dual basis functional quadrature */
28969566063dSJacob Faibussowitsch         PetscCall(PetscDualSpaceGetFunctional(Q, i, &f));
28979566063dSJacob Faibussowitsch         PetscCall(PetscQuadratureGetData(f, NULL, &qNc, &Np, &qpoints, &qweights));
28985f80ce2aSJacob Faibussowitsch         PetscCheck(qNc == Nc,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of components in quadrature %D does not match coarse field %D", qNc, Nc);
28999566063dSJacob Faibussowitsch         PetscCall(VecCreateSeq(PETSC_COMM_SELF, Np*dim, &pointVec));
29009566063dSJacob Faibussowitsch         PetscCall(VecSetBlockSize(pointVec, dim));
29019566063dSJacob Faibussowitsch         PetscCall(VecGetArray(pointVec, &pV));
29024ef9d792SMatthew G. Knepley         for (q = 0; q < Np; ++q) {
2903c330f8ffSToby Isaac           const PetscReal xi0[3] = {-1., -1., -1.};
2904c330f8ffSToby Isaac 
29054ef9d792SMatthew G. Knepley           /* Transform point to real space */
2906c330f8ffSToby Isaac           CoordinatesRefToReal(dim, dim, xi0, v0, J, &qpoints[q*dim], x);
29074ef9d792SMatthew G. Knepley           for (d = 0; d < dim; ++d) pV[q*dim+d] = x[d];
29084ef9d792SMatthew G. Knepley         }
29099566063dSJacob Faibussowitsch         PetscCall(VecRestoreArray(pointVec, &pV));
29104ef9d792SMatthew G. Knepley         /* Get set of coarse cells that overlap points (would like to group points by coarse cell) */
29111555c271SMatthew G. Knepley         /* OPT: Read this out from preallocation information */
29129566063dSJacob Faibussowitsch         PetscCall(DMLocatePoints(dmc, pointVec, DM_POINTLOCATION_NEAREST, &coarseCellSF));
29134ef9d792SMatthew G. Knepley         /* Update preallocation info */
29149566063dSJacob Faibussowitsch         PetscCall(PetscSFGetGraph(coarseCellSF, NULL, &numCoarseCells, NULL, &coarseCells));
29155f80ce2aSJacob Faibussowitsch         PetscCheck(numCoarseCells == Np,PETSC_COMM_SELF,PETSC_ERR_PLIB,"Not all closure points located");
29169566063dSJacob Faibussowitsch         PetscCall(VecGetArray(pointVec, &pV));
29174ef9d792SMatthew G. Knepley         for (ccell = 0; ccell < numCoarseCells; ++ccell) {
2918826eb36dSMatthew G. Knepley           PetscReal pVReal[3];
2919c330f8ffSToby Isaac           const PetscReal xi0[3] = {-1., -1., -1.};
2920826eb36dSMatthew G. Knepley 
29219566063dSJacob Faibussowitsch           PetscCall(DMPlexGetClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
29224ef9d792SMatthew G. Knepley           /* Transform points from real space to coarse reference space */
29239566063dSJacob Faibussowitsch           PetscCall(DMPlexComputeCellGeometryFEM(dmc, coarseCells[ccell].index, NULL, v0c, Jc, invJc, &detJc));
2924e2d86523SMatthew G. Knepley           for (d = 0; d < dim; ++d) pVReal[d] = PetscRealPart(pV[ccell*dim+d]);
2925c330f8ffSToby Isaac           CoordinatesRealToRef(dim, dim, xi0, v0c, invJc, pVReal, x);
29264ef9d792SMatthew G. Knepley 
29274ef9d792SMatthew G. Knepley           if (id == PETSCFE_CLASSID) {
29284ef9d792SMatthew G. Knepley             PetscFE fe = (PetscFE) obj;
29294ef9d792SMatthew G. Knepley 
29304ef9d792SMatthew G. Knepley             /* Evaluate coarse basis on contained point */
29319566063dSJacob Faibussowitsch             PetscCall(PetscFEGetDimension(fe, &cpdim));
29329566063dSJacob Faibussowitsch             PetscCall(PetscFEComputeTabulation(fe, 1, x, 0, T));
29339566063dSJacob Faibussowitsch             PetscCall(PetscArrayzero(elemMat, cpdim));
29344ef9d792SMatthew G. Knepley             /* Get elemMat entries by multiplying by weight */
29354ef9d792SMatthew G. Knepley             for (j = 0; j < cpdim; ++j) {
2936ef0bb6c7SMatthew G. Knepley               for (c = 0; c < Nc; ++c) elemMat[j] += T->T[0][j*Nc + c]*qweights[ccell*qNc + c];
29374ef9d792SMatthew G. Knepley             }
29384ef9d792SMatthew G. Knepley           } else {
29394ef9d792SMatthew G. Knepley             cpdim = 1;
29404ef9d792SMatthew G. Knepley             for (j = 0; j < cpdim; ++j) {
29419c3cf19fSMatthew G. Knepley               for (c = 0; c < Nc; ++c) elemMat[j] += 1.0*qweights[ccell*qNc + c];
29424ef9d792SMatthew G. Knepley             }
29434ef9d792SMatthew G. Knepley           }
29444ef9d792SMatthew G. Knepley           /* Update interpolator */
29459566063dSJacob Faibussowitsch           if (mesh->printFEM > 1) PetscCall(DMPrintCellMatrix(cell, name, 1, numCIndices, elemMat));
29465f80ce2aSJacob Faibussowitsch           PetscCheck(numCIndices == cpdim,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Number of element matrix columns %D != %D", numCIndices, cpdim);
29479566063dSJacob Faibussowitsch           PetscCall(MatSetValues(In, 1, &findices[i], numCIndices, cindices, elemMat, INSERT_VALUES));
29489566063dSJacob Faibussowitsch           PetscCall(DMPlexRestoreClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
29494ef9d792SMatthew G. Knepley         }
29509566063dSJacob Faibussowitsch         PetscCall(VecRestoreArray(pointVec, &pV));
29519566063dSJacob Faibussowitsch         PetscCall(PetscSFDestroy(&coarseCellSF));
29529566063dSJacob Faibussowitsch         PetscCall(VecDestroy(&pointVec));
29534ef9d792SMatthew G. Knepley       }
29549566063dSJacob Faibussowitsch       PetscCall(DMPlexRestoreClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
29554ef9d792SMatthew G. Knepley     }
29569566063dSJacob Faibussowitsch     if (id == PETSCFE_CLASSID) PetscCall(PetscTabulationDestroy(&T));
29574ef9d792SMatthew G. Knepley   }
29589566063dSJacob Faibussowitsch   PetscCall(PetscFree3(v0,J,invJ));
29599566063dSJacob Faibussowitsch   PetscCall(PetscFree3(v0c,Jc,invJc));
29609566063dSJacob Faibussowitsch   PetscCall(PetscFree(elemMat));
29619566063dSJacob Faibussowitsch   PetscCall(MatAssemblyBegin(In, MAT_FINAL_ASSEMBLY));
29629566063dSJacob Faibussowitsch   PetscCall(MatAssemblyEnd(In, MAT_FINAL_ASSEMBLY));
29639566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_InterpolatorFEM,dmc,dmf,0,0));
29644ef9d792SMatthew G. Knepley   PetscFunctionReturn(0);
29654ef9d792SMatthew G. Knepley }
29664ef9d792SMatthew G. Knepley 
296746fa42a0SMatthew G. Knepley /*@
2968bd041c0cSMatthew G. Knepley   DMPlexComputeMassMatrixGeneral - Form the local portion of the mass matrix M from the coarse DM to a non-nested fine DM.
2969bd041c0cSMatthew G. Knepley 
2970bd041c0cSMatthew G. Knepley   Input Parameters:
2971bd041c0cSMatthew G. Knepley + dmf  - The fine mesh
2972bd041c0cSMatthew G. Knepley . dmc  - The coarse mesh
2973bd041c0cSMatthew G. Knepley - user - The user context
2974bd041c0cSMatthew G. Knepley 
2975bd041c0cSMatthew G. Knepley   Output Parameter:
2976bd041c0cSMatthew G. Knepley . mass  - The mass matrix
2977bd041c0cSMatthew G. Knepley 
2978bd041c0cSMatthew G. Knepley   Level: developer
2979bd041c0cSMatthew G. Knepley 
2980bd041c0cSMatthew G. Knepley .seealso: DMPlexComputeMassMatrixNested(), DMPlexComputeInterpolatorNested(), DMPlexComputeInterpolatorGeneral(), DMPlexComputeJacobianFEM()
2981bd041c0cSMatthew G. Knepley @*/
2982bd041c0cSMatthew G. Knepley PetscErrorCode DMPlexComputeMassMatrixGeneral(DM dmc, DM dmf, Mat mass, void *user)
2983bd041c0cSMatthew G. Knepley {
2984bd041c0cSMatthew G. Knepley   DM_Plex       *mesh = (DM_Plex *) dmf->data;
2985bd041c0cSMatthew G. Knepley   const char    *name = "Mass Matrix";
2986bd041c0cSMatthew G. Knepley   PetscDS        prob;
2987bd041c0cSMatthew G. Knepley   PetscSection   fsection, csection, globalFSection, globalCSection;
2988e8f14785SLisandro Dalcin   PetscHSetIJ    ht;
2989bd041c0cSMatthew G. Knepley   PetscLayout    rLayout;
2990bd041c0cSMatthew G. Knepley   PetscInt      *dnz, *onz;
2991bd041c0cSMatthew G. Knepley   PetscInt       locRows, rStart, rEnd;
2992bd041c0cSMatthew G. Knepley   PetscReal     *x, *v0, *J, *invJ, detJ;
2993bd041c0cSMatthew G. Knepley   PetscReal     *v0c, *Jc, *invJc, detJc;
2994bd041c0cSMatthew G. Knepley   PetscScalar   *elemMat;
2995bd041c0cSMatthew G. Knepley   PetscInt       dim, Nf, field, totDim, cStart, cEnd, cell, ccell;
2996bd041c0cSMatthew G. Knepley 
2997bd041c0cSMatthew G. Knepley   PetscFunctionBegin;
29989566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateDim(dmc, &dim));
29999566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dmc, &prob));
30009566063dSJacob Faibussowitsch   PetscCall(PetscDSGetWorkspace(prob, &x, NULL, NULL, NULL, NULL));
30019566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumFields(prob, &Nf));
30029566063dSJacob Faibussowitsch   PetscCall(PetscMalloc3(dim,&v0,dim*dim,&J,dim*dim,&invJ));
30039566063dSJacob Faibussowitsch   PetscCall(PetscMalloc3(dim,&v0c,dim*dim,&Jc,dim*dim,&invJc));
30049566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dmf, &fsection));
30059566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dmf, &globalFSection));
30069566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dmc, &csection));
30079566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dmc, &globalCSection));
30089566063dSJacob Faibussowitsch   PetscCall(DMPlexGetHeightStratum(dmf, 0, &cStart, &cEnd));
30099566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(prob, &totDim));
30109566063dSJacob Faibussowitsch   PetscCall(PetscMalloc1(totDim, &elemMat));
3011bd041c0cSMatthew G. Knepley 
30129566063dSJacob Faibussowitsch   PetscCall(MatGetLocalSize(mass, &locRows, NULL));
30139566063dSJacob Faibussowitsch   PetscCall(PetscLayoutCreate(PetscObjectComm((PetscObject) mass), &rLayout));
30149566063dSJacob Faibussowitsch   PetscCall(PetscLayoutSetLocalSize(rLayout, locRows));
30159566063dSJacob Faibussowitsch   PetscCall(PetscLayoutSetBlockSize(rLayout, 1));
30169566063dSJacob Faibussowitsch   PetscCall(PetscLayoutSetUp(rLayout));
30179566063dSJacob Faibussowitsch   PetscCall(PetscLayoutGetRange(rLayout, &rStart, &rEnd));
30189566063dSJacob Faibussowitsch   PetscCall(PetscLayoutDestroy(&rLayout));
30199566063dSJacob Faibussowitsch   PetscCall(PetscCalloc2(locRows,&dnz,locRows,&onz));
30209566063dSJacob Faibussowitsch   PetscCall(PetscHSetIJCreate(&ht));
3021bd041c0cSMatthew G. Knepley   for (field = 0; field < Nf; ++field) {
3022bd041c0cSMatthew G. Knepley     PetscObject      obj;
3023bd041c0cSMatthew G. Knepley     PetscClassId     id;
3024bd041c0cSMatthew G. Knepley     PetscQuadrature  quad;
3025bd041c0cSMatthew G. Knepley     const PetscReal *qpoints;
3026bd041c0cSMatthew G. Knepley     PetscInt         Nq, Nc, i, d;
3027bd041c0cSMatthew G. Knepley 
30289566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, field, &obj));
30299566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
30309566063dSJacob Faibussowitsch     if (id == PETSCFE_CLASSID) PetscCall(PetscFEGetQuadrature((PetscFE) obj, &quad));
30319566063dSJacob Faibussowitsch     else                       PetscCall(PetscFVGetQuadrature((PetscFV) obj, &quad));
30329566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureGetData(quad, NULL, &Nc, &Nq, &qpoints, NULL));
3033bd041c0cSMatthew G. Knepley     /* For each fine grid cell */
3034bd041c0cSMatthew G. Knepley     for (cell = cStart; cell < cEnd; ++cell) {
3035bd041c0cSMatthew G. Knepley       Vec                pointVec;
3036bd041c0cSMatthew G. Knepley       PetscScalar       *pV;
3037bd041c0cSMatthew G. Knepley       PetscSF            coarseCellSF = NULL;
3038bd041c0cSMatthew G. Knepley       const PetscSFNode *coarseCells;
3039bd041c0cSMatthew G. Knepley       PetscInt           numCoarseCells, q, c;
3040bd041c0cSMatthew G. Knepley       PetscInt          *findices,   *cindices;
3041bd041c0cSMatthew G. Knepley       PetscInt           numFIndices, numCIndices;
3042bd041c0cSMatthew G. Knepley 
30439566063dSJacob Faibussowitsch       PetscCall(DMPlexGetClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
30449566063dSJacob Faibussowitsch       PetscCall(DMPlexComputeCellGeometryFEM(dmf, cell, NULL, v0, J, invJ, &detJ));
3045bd041c0cSMatthew G. Knepley       /* Get points from the quadrature */
30469566063dSJacob Faibussowitsch       PetscCall(VecCreateSeq(PETSC_COMM_SELF, Nq*dim, &pointVec));
30479566063dSJacob Faibussowitsch       PetscCall(VecSetBlockSize(pointVec, dim));
30489566063dSJacob Faibussowitsch       PetscCall(VecGetArray(pointVec, &pV));
3049bd041c0cSMatthew G. Knepley       for (q = 0; q < Nq; ++q) {
3050c330f8ffSToby Isaac         const PetscReal xi0[3] = {-1., -1., -1.};
3051c330f8ffSToby Isaac 
3052bd041c0cSMatthew G. Knepley         /* Transform point to real space */
3053c330f8ffSToby Isaac         CoordinatesRefToReal(dim, dim, xi0, v0, J, &qpoints[q*dim], x);
3054bd041c0cSMatthew G. Knepley         for (d = 0; d < dim; ++d) pV[q*dim+d] = x[d];
3055bd041c0cSMatthew G. Knepley       }
30569566063dSJacob Faibussowitsch       PetscCall(VecRestoreArray(pointVec, &pV));
3057bd041c0cSMatthew G. Knepley       /* Get set of coarse cells that overlap points (would like to group points by coarse cell) */
30589566063dSJacob Faibussowitsch       PetscCall(DMLocatePoints(dmc, pointVec, DM_POINTLOCATION_NEAREST, &coarseCellSF));
30599566063dSJacob Faibussowitsch       PetscCall(PetscSFViewFromOptions(coarseCellSF, NULL, "-interp_sf_view"));
3060bd041c0cSMatthew G. Knepley       /* Update preallocation info */
30619566063dSJacob Faibussowitsch       PetscCall(PetscSFGetGraph(coarseCellSF, NULL, &numCoarseCells, NULL, &coarseCells));
30625f80ce2aSJacob Faibussowitsch       PetscCheck(numCoarseCells == Nq,PETSC_COMM_SELF,PETSC_ERR_PLIB,"Not all closure points located");
3063bd041c0cSMatthew G. Knepley       {
3064e8f14785SLisandro Dalcin         PetscHashIJKey key;
3065e8f14785SLisandro Dalcin         PetscBool      missing;
3066bd041c0cSMatthew G. Knepley 
3067bd041c0cSMatthew G. Knepley         for (i = 0; i < numFIndices; ++i) {
3068e8f14785SLisandro Dalcin           key.i = findices[i];
3069e8f14785SLisandro Dalcin           if (key.i >= 0) {
3070bd041c0cSMatthew G. Knepley             /* Get indices for coarse elements */
3071bd041c0cSMatthew G. Knepley             for (ccell = 0; ccell < numCoarseCells; ++ccell) {
30729566063dSJacob Faibussowitsch               PetscCall(DMPlexGetClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
3073bd041c0cSMatthew G. Knepley               for (c = 0; c < numCIndices; ++c) {
3074e8f14785SLisandro Dalcin                 key.j = cindices[c];
3075e8f14785SLisandro Dalcin                 if (key.j < 0) continue;
30769566063dSJacob Faibussowitsch                 PetscCall(PetscHSetIJQueryAdd(ht, key, &missing));
3077bd041c0cSMatthew G. Knepley                 if (missing) {
3078e8f14785SLisandro Dalcin                   if ((key.j >= rStart) && (key.j < rEnd)) ++dnz[key.i-rStart];
3079e8f14785SLisandro Dalcin                   else                                     ++onz[key.i-rStart];
3080bd041c0cSMatthew G. Knepley                 }
3081bd041c0cSMatthew G. Knepley               }
30829566063dSJacob Faibussowitsch               PetscCall(DMPlexRestoreClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
3083bd041c0cSMatthew G. Knepley             }
3084bd041c0cSMatthew G. Knepley           }
3085bd041c0cSMatthew G. Knepley         }
3086bd041c0cSMatthew G. Knepley       }
30879566063dSJacob Faibussowitsch       PetscCall(PetscSFDestroy(&coarseCellSF));
30889566063dSJacob Faibussowitsch       PetscCall(VecDestroy(&pointVec));
30899566063dSJacob Faibussowitsch       PetscCall(DMPlexRestoreClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
3090bd041c0cSMatthew G. Knepley     }
3091bd041c0cSMatthew G. Knepley   }
30929566063dSJacob Faibussowitsch   PetscCall(PetscHSetIJDestroy(&ht));
30939566063dSJacob Faibussowitsch   PetscCall(MatXAIJSetPreallocation(mass, 1, dnz, onz, NULL, NULL));
30949566063dSJacob Faibussowitsch   PetscCall(MatSetOption(mass, MAT_NEW_NONZERO_ALLOCATION_ERR,PETSC_TRUE));
30959566063dSJacob Faibussowitsch   PetscCall(PetscFree2(dnz,onz));
3096bd041c0cSMatthew G. Knepley   for (field = 0; field < Nf; ++field) {
3097bd041c0cSMatthew G. Knepley     PetscObject       obj;
3098bd041c0cSMatthew G. Knepley     PetscClassId      id;
3099ef0bb6c7SMatthew G. Knepley     PetscTabulation T, Tfine;
3100bd041c0cSMatthew G. Knepley     PetscQuadrature   quad;
3101bd041c0cSMatthew G. Knepley     const PetscReal  *qpoints, *qweights;
3102bd041c0cSMatthew G. Knepley     PetscInt          Nq, Nc, i, d;
3103bd041c0cSMatthew G. Knepley 
31049566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, field, &obj));
31059566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
3106ef0bb6c7SMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
31079566063dSJacob Faibussowitsch       PetscCall(PetscFEGetQuadrature((PetscFE) obj, &quad));
31089566063dSJacob Faibussowitsch       PetscCall(PetscFEGetCellTabulation((PetscFE) obj, 1, &Tfine));
31099566063dSJacob Faibussowitsch       PetscCall(PetscFECreateTabulation((PetscFE) obj, 1, 1, x, 0, &T));
3110ef0bb6c7SMatthew G. Knepley     } else {
31119566063dSJacob Faibussowitsch       PetscCall(PetscFVGetQuadrature((PetscFV) obj, &quad));
3112ef0bb6c7SMatthew G. Knepley     }
31139566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureGetData(quad, NULL, &Nc, &Nq, &qpoints, &qweights));
3114bd041c0cSMatthew G. Knepley     /* For each fine grid cell */
3115bd041c0cSMatthew G. Knepley     for (cell = cStart; cell < cEnd; ++cell) {
3116bd041c0cSMatthew G. Knepley       Vec                pointVec;
3117bd041c0cSMatthew G. Knepley       PetscScalar       *pV;
3118bd041c0cSMatthew G. Knepley       PetscSF            coarseCellSF = NULL;
3119bd041c0cSMatthew G. Knepley       const PetscSFNode *coarseCells;
3120bd041c0cSMatthew G. Knepley       PetscInt           numCoarseCells, cpdim, q, c, j;
3121bd041c0cSMatthew G. Knepley       PetscInt          *findices,   *cindices;
3122bd041c0cSMatthew G. Knepley       PetscInt           numFIndices, numCIndices;
3123bd041c0cSMatthew G. Knepley 
31249566063dSJacob Faibussowitsch       PetscCall(DMPlexGetClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
31259566063dSJacob Faibussowitsch       PetscCall(DMPlexComputeCellGeometryFEM(dmf, cell, NULL, v0, J, invJ, &detJ));
3126bd041c0cSMatthew G. Knepley       /* Get points from the quadrature */
31279566063dSJacob Faibussowitsch       PetscCall(VecCreateSeq(PETSC_COMM_SELF, Nq*dim, &pointVec));
31289566063dSJacob Faibussowitsch       PetscCall(VecSetBlockSize(pointVec, dim));
31299566063dSJacob Faibussowitsch       PetscCall(VecGetArray(pointVec, &pV));
3130bd041c0cSMatthew G. Knepley       for (q = 0; q < Nq; ++q) {
3131c330f8ffSToby Isaac         const PetscReal xi0[3] = {-1., -1., -1.};
3132c330f8ffSToby Isaac 
3133bd041c0cSMatthew G. Knepley         /* Transform point to real space */
3134c330f8ffSToby Isaac         CoordinatesRefToReal(dim, dim, xi0, v0, J, &qpoints[q*dim], x);
3135bd041c0cSMatthew G. Knepley         for (d = 0; d < dim; ++d) pV[q*dim+d] = x[d];
3136bd041c0cSMatthew G. Knepley       }
31379566063dSJacob Faibussowitsch       PetscCall(VecRestoreArray(pointVec, &pV));
3138bd041c0cSMatthew G. Knepley       /* Get set of coarse cells that overlap points (would like to group points by coarse cell) */
31399566063dSJacob Faibussowitsch       PetscCall(DMLocatePoints(dmc, pointVec, DM_POINTLOCATION_NEAREST, &coarseCellSF));
3140bd041c0cSMatthew G. Knepley       /* Update matrix */
31419566063dSJacob Faibussowitsch       PetscCall(PetscSFGetGraph(coarseCellSF, NULL, &numCoarseCells, NULL, &coarseCells));
31425f80ce2aSJacob Faibussowitsch       PetscCheck(numCoarseCells == Nq,PETSC_COMM_SELF,PETSC_ERR_PLIB,"Not all closure points located");
31439566063dSJacob Faibussowitsch       PetscCall(VecGetArray(pointVec, &pV));
3144bd041c0cSMatthew G. Knepley       for (ccell = 0; ccell < numCoarseCells; ++ccell) {
3145bd041c0cSMatthew G. Knepley         PetscReal pVReal[3];
3146c330f8ffSToby Isaac         const PetscReal xi0[3] = {-1., -1., -1.};
3147c330f8ffSToby Isaac 
31489566063dSJacob Faibussowitsch         PetscCall(DMPlexGetClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
3149bd041c0cSMatthew G. Knepley         /* Transform points from real space to coarse reference space */
31509566063dSJacob Faibussowitsch         PetscCall(DMPlexComputeCellGeometryFEM(dmc, coarseCells[ccell].index, NULL, v0c, Jc, invJc, &detJc));
3151bd041c0cSMatthew G. Knepley         for (d = 0; d < dim; ++d) pVReal[d] = PetscRealPart(pV[ccell*dim+d]);
3152c330f8ffSToby Isaac         CoordinatesRealToRef(dim, dim, xi0, v0c, invJc, pVReal, x);
3153bd041c0cSMatthew G. Knepley 
3154bd041c0cSMatthew G. Knepley         if (id == PETSCFE_CLASSID) {
3155bd041c0cSMatthew G. Knepley           PetscFE fe = (PetscFE) obj;
3156bd041c0cSMatthew G. Knepley 
3157bd041c0cSMatthew G. Knepley           /* Evaluate coarse basis on contained point */
31589566063dSJacob Faibussowitsch           PetscCall(PetscFEGetDimension(fe, &cpdim));
31599566063dSJacob Faibussowitsch           PetscCall(PetscFEComputeTabulation(fe, 1, x, 0, T));
3160bd041c0cSMatthew G. Knepley           /* Get elemMat entries by multiplying by weight */
3161bd041c0cSMatthew G. Knepley           for (i = 0; i < numFIndices; ++i) {
31629566063dSJacob Faibussowitsch             PetscCall(PetscArrayzero(elemMat, cpdim));
3163bd041c0cSMatthew G. Knepley             for (j = 0; j < cpdim; ++j) {
3164ef0bb6c7SMatthew 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;
3165bd041c0cSMatthew G. Knepley             }
3166bd041c0cSMatthew G. Knepley             /* Update interpolator */
31679566063dSJacob Faibussowitsch             if (mesh->printFEM > 1) PetscCall(DMPrintCellMatrix(cell, name, 1, numCIndices, elemMat));
31685f80ce2aSJacob Faibussowitsch             PetscCheck(numCIndices == cpdim,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Number of element matrix columns %D != %D", numCIndices, cpdim);
31699566063dSJacob Faibussowitsch             PetscCall(MatSetValues(mass, 1, &findices[i], numCIndices, cindices, elemMat, ADD_VALUES));
3170bd041c0cSMatthew G. Knepley           }
3171bd041c0cSMatthew G. Knepley         } else {
3172bd041c0cSMatthew G. Knepley           cpdim = 1;
3173bd041c0cSMatthew G. Knepley           for (i = 0; i < numFIndices; ++i) {
31749566063dSJacob Faibussowitsch             PetscCall(PetscArrayzero(elemMat, cpdim));
3175bd041c0cSMatthew G. Knepley             for (j = 0; j < cpdim; ++j) {
3176bd041c0cSMatthew G. Knepley               for (c = 0; c < Nc; ++c) elemMat[j] += 1.0*1.0*qweights[ccell*Nc + c]*detJ;
3177bd041c0cSMatthew G. Knepley             }
3178bd041c0cSMatthew G. Knepley             /* Update interpolator */
31799566063dSJacob Faibussowitsch             if (mesh->printFEM > 1) PetscCall(DMPrintCellMatrix(cell, name, 1, numCIndices, elemMat));
31809566063dSJacob Faibussowitsch             PetscCall(PetscPrintf(PETSC_COMM_SELF, "Nq: %D %D Nf: %D %D Nc: %D %D\n", ccell, Nq, i, numFIndices, j, numCIndices));
31815f80ce2aSJacob Faibussowitsch             PetscCheck(numCIndices == cpdim,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Number of element matrix columns %D != %D", numCIndices, cpdim);
31829566063dSJacob Faibussowitsch             PetscCall(MatSetValues(mass, 1, &findices[i], numCIndices, cindices, elemMat, ADD_VALUES));
3183bd041c0cSMatthew G. Knepley           }
3184bd041c0cSMatthew G. Knepley         }
31859566063dSJacob Faibussowitsch         PetscCall(DMPlexRestoreClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
3186bd041c0cSMatthew G. Knepley       }
31879566063dSJacob Faibussowitsch       PetscCall(VecRestoreArray(pointVec, &pV));
31889566063dSJacob Faibussowitsch       PetscCall(PetscSFDestroy(&coarseCellSF));
31899566063dSJacob Faibussowitsch       PetscCall(VecDestroy(&pointVec));
31909566063dSJacob Faibussowitsch       PetscCall(DMPlexRestoreClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
3191bd041c0cSMatthew G. Knepley     }
31929566063dSJacob Faibussowitsch     if (id == PETSCFE_CLASSID) PetscCall(PetscTabulationDestroy(&T));
3193bd041c0cSMatthew G. Knepley   }
31949566063dSJacob Faibussowitsch   PetscCall(PetscFree3(v0,J,invJ));
31959566063dSJacob Faibussowitsch   PetscCall(PetscFree3(v0c,Jc,invJc));
31969566063dSJacob Faibussowitsch   PetscCall(PetscFree(elemMat));
31979566063dSJacob Faibussowitsch   PetscCall(MatAssemblyBegin(mass, MAT_FINAL_ASSEMBLY));
31989566063dSJacob Faibussowitsch   PetscCall(MatAssemblyEnd(mass, MAT_FINAL_ASSEMBLY));
3199bd041c0cSMatthew G. Knepley   PetscFunctionReturn(0);
3200bd041c0cSMatthew G. Knepley }
3201bd041c0cSMatthew G. Knepley 
3202bd041c0cSMatthew G. Knepley /*@
320346fa42a0SMatthew G. Knepley   DMPlexComputeInjectorFEM - Compute a mapping from coarse unknowns to fine unknowns
320446fa42a0SMatthew G. Knepley 
320546fa42a0SMatthew G. Knepley   Input Parameters:
320646fa42a0SMatthew G. Knepley + dmc  - The coarse mesh
320746fa42a0SMatthew G. Knepley - dmf  - The fine mesh
320846fa42a0SMatthew G. Knepley - user - The user context
320946fa42a0SMatthew G. Knepley 
321046fa42a0SMatthew G. Knepley   Output Parameter:
321146fa42a0SMatthew G. Knepley . sc   - The mapping
321246fa42a0SMatthew G. Knepley 
321346fa42a0SMatthew G. Knepley   Level: developer
321446fa42a0SMatthew G. Knepley 
321546fa42a0SMatthew G. Knepley .seealso: DMPlexComputeInterpolatorNested(), DMPlexComputeJacobianFEM()
321646fa42a0SMatthew G. Knepley @*/
32177c927364SMatthew G. Knepley PetscErrorCode DMPlexComputeInjectorFEM(DM dmc, DM dmf, VecScatter *sc, void *user)
32187c927364SMatthew G. Knepley {
3219e9d4ef1bSMatthew G. Knepley   PetscDS        prob;
32207c927364SMatthew G. Knepley   PetscFE       *feRef;
322197c42addSMatthew G. Knepley   PetscFV       *fvRef;
32227c927364SMatthew G. Knepley   Vec            fv, cv;
32237c927364SMatthew G. Knepley   IS             fis, cis;
32247c927364SMatthew G. Knepley   PetscSection   fsection, fglobalSection, csection, cglobalSection;
32257c927364SMatthew G. Knepley   PetscInt      *cmap, *cellCIndices, *cellFIndices, *cindices, *findices;
3226485ad865SMatthew G. Knepley   PetscInt       cTotDim, fTotDim = 0, Nf, f, field, cStart, cEnd, c, dim, d, startC, endC, offsetC, offsetF, m;
32276f3d3cbcSMatthew G. Knepley   PetscBool     *needAvg;
32287c927364SMatthew G. Knepley 
32297c927364SMatthew G. Knepley   PetscFunctionBegin;
32309566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_InjectorFEM,dmc,dmf,0,0));
32319566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dmf, &dim));
32329566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dmf, &fsection));
32339566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dmf, &fglobalSection));
32349566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dmc, &csection));
32359566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dmc, &cglobalSection));
32369566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetNumFields(fsection, &Nf));
32379566063dSJacob Faibussowitsch   PetscCall(DMPlexGetSimplexOrBoxCells(dmc, 0, &cStart, &cEnd));
32389566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dmc, &prob));
32399566063dSJacob Faibussowitsch   PetscCall(PetscCalloc3(Nf,&feRef,Nf,&fvRef,Nf,&needAvg));
32407c927364SMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
324197c42addSMatthew G. Knepley     PetscObject  obj;
324297c42addSMatthew G. Knepley     PetscClassId id;
3243aa7890ccSMatthew G. Knepley     PetscInt     fNb = 0, Nc = 0;
32447c927364SMatthew G. Knepley 
32459566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, f, &obj));
32469566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
324797c42addSMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
324897c42addSMatthew G. Knepley       PetscFE    fe = (PetscFE) obj;
32496f3d3cbcSMatthew G. Knepley       PetscSpace sp;
32509b2fc754SMatthew G. Knepley       PetscInt   maxDegree;
325197c42addSMatthew G. Knepley 
32529566063dSJacob Faibussowitsch       PetscCall(PetscFERefine(fe, &feRef[f]));
32539566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDimension(feRef[f], &fNb));
32549566063dSJacob Faibussowitsch       PetscCall(PetscFEGetNumComponents(fe, &Nc));
32559566063dSJacob Faibussowitsch       PetscCall(PetscFEGetBasisSpace(fe, &sp));
32569566063dSJacob Faibussowitsch       PetscCall(PetscSpaceGetDegree(sp, NULL, &maxDegree));
32579b2fc754SMatthew G. Knepley       if (!maxDegree) needAvg[f] = PETSC_TRUE;
325897c42addSMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
325997c42addSMatthew G. Knepley       PetscFV        fv = (PetscFV) obj;
326097c42addSMatthew G. Knepley       PetscDualSpace Q;
326197c42addSMatthew G. Knepley 
32629566063dSJacob Faibussowitsch       PetscCall(PetscFVRefine(fv, &fvRef[f]));
32639566063dSJacob Faibussowitsch       PetscCall(PetscFVGetDualSpace(fvRef[f], &Q));
32649566063dSJacob Faibussowitsch       PetscCall(PetscDualSpaceGetDimension(Q, &fNb));
32659566063dSJacob Faibussowitsch       PetscCall(PetscFVGetNumComponents(fv, &Nc));
32666f3d3cbcSMatthew G. Knepley       needAvg[f] = PETSC_TRUE;
326797c42addSMatthew G. Knepley     }
3268d172c84bSMatthew G. Knepley     fTotDim += fNb;
32697c927364SMatthew G. Knepley   }
32709566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(prob, &cTotDim));
32719566063dSJacob Faibussowitsch   PetscCall(PetscMalloc1(cTotDim,&cmap));
32727c927364SMatthew G. Knepley   for (field = 0, offsetC = 0, offsetF = 0; field < Nf; ++field) {
32737c927364SMatthew G. Knepley     PetscFE        feC;
327497c42addSMatthew G. Knepley     PetscFV        fvC;
32757c927364SMatthew G. Knepley     PetscDualSpace QF, QC;
3276d172c84bSMatthew G. Knepley     PetscInt       order = -1, NcF, NcC, fpdim, cpdim;
32777c927364SMatthew G. Knepley 
327897c42addSMatthew G. Knepley     if (feRef[field]) {
32799566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(prob, field, (PetscObject *) &feC));
32809566063dSJacob Faibussowitsch       PetscCall(PetscFEGetNumComponents(feC, &NcC));
32819566063dSJacob Faibussowitsch       PetscCall(PetscFEGetNumComponents(feRef[field], &NcF));
32829566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDualSpace(feRef[field], &QF));
32839566063dSJacob Faibussowitsch       PetscCall(PetscDualSpaceGetOrder(QF, &order));
32849566063dSJacob Faibussowitsch       PetscCall(PetscDualSpaceGetDimension(QF, &fpdim));
32859566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDualSpace(feC, &QC));
32869566063dSJacob Faibussowitsch       PetscCall(PetscDualSpaceGetDimension(QC, &cpdim));
328797c42addSMatthew G. Knepley     } else {
32889566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(prob, field, (PetscObject *) &fvC));
32899566063dSJacob Faibussowitsch       PetscCall(PetscFVGetNumComponents(fvC, &NcC));
32909566063dSJacob Faibussowitsch       PetscCall(PetscFVGetNumComponents(fvRef[field], &NcF));
32919566063dSJacob Faibussowitsch       PetscCall(PetscFVGetDualSpace(fvRef[field], &QF));
32929566063dSJacob Faibussowitsch       PetscCall(PetscDualSpaceGetDimension(QF, &fpdim));
32939566063dSJacob Faibussowitsch       PetscCall(PetscFVGetDualSpace(fvC, &QC));
32949566063dSJacob Faibussowitsch       PetscCall(PetscDualSpaceGetDimension(QC, &cpdim));
329597c42addSMatthew G. Knepley     }
32965f80ce2aSJacob Faibussowitsch     PetscCheck(NcF == NcC,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of components in fine space field %D does not match coarse field %D", NcF, NcC);
32977c927364SMatthew G. Knepley     for (c = 0; c < cpdim; ++c) {
32987c927364SMatthew G. Knepley       PetscQuadrature  cfunc;
3299d172c84bSMatthew G. Knepley       const PetscReal *cqpoints, *cqweights;
3300d172c84bSMatthew G. Knepley       PetscInt         NqcC, NpC;
330197c42addSMatthew G. Knepley       PetscBool        found = PETSC_FALSE;
33027c927364SMatthew G. Knepley 
33039566063dSJacob Faibussowitsch       PetscCall(PetscDualSpaceGetFunctional(QC, c, &cfunc));
33049566063dSJacob Faibussowitsch       PetscCall(PetscQuadratureGetData(cfunc, NULL, &NqcC, &NpC, &cqpoints, &cqweights));
33055f80ce2aSJacob Faibussowitsch       PetscCheck(NqcC == NcC,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of quadrature components %D must match number of field components %D", NqcC, NcC);
33062c71b3e2SJacob Faibussowitsch       PetscCheckFalse(NpC != 1 && feRef[field],PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Do not know how to do injection for moments");
33077c927364SMatthew G. Knepley       for (f = 0; f < fpdim; ++f) {
33087c927364SMatthew G. Knepley         PetscQuadrature  ffunc;
3309d172c84bSMatthew G. Knepley         const PetscReal *fqpoints, *fqweights;
33107c927364SMatthew G. Knepley         PetscReal        sum = 0.0;
3311d172c84bSMatthew G. Knepley         PetscInt         NqcF, NpF;
33127c927364SMatthew G. Knepley 
33139566063dSJacob Faibussowitsch         PetscCall(PetscDualSpaceGetFunctional(QF, f, &ffunc));
33149566063dSJacob Faibussowitsch         PetscCall(PetscQuadratureGetData(ffunc, NULL, &NqcF, &NpF, &fqpoints, &fqweights));
33155f80ce2aSJacob Faibussowitsch         PetscCheck(NqcF == NcF,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of quadrature components %D must match number of field components %D", NqcF, NcF);
33167c927364SMatthew G. Knepley         if (NpC != NpF) continue;
33177c927364SMatthew G. Knepley         for (d = 0; d < dim; ++d) sum += PetscAbsReal(cqpoints[d] - fqpoints[d]);
33187c927364SMatthew G. Knepley         if (sum > 1.0e-9) continue;
3319d172c84bSMatthew G. Knepley         for (d = 0; d < NcC; ++d) sum += PetscAbsReal(cqweights[d]*fqweights[d]);
3320d172c84bSMatthew G. Knepley         if (sum < 1.0e-9) continue;
3321d172c84bSMatthew G. Knepley         cmap[offsetC+c] = offsetF+f;
332297c42addSMatthew G. Knepley         found = PETSC_TRUE;
33237c927364SMatthew G. Knepley         break;
33247c927364SMatthew G. Knepley       }
332597c42addSMatthew G. Knepley       if (!found) {
332697c42addSMatthew G. Knepley         /* TODO We really want the average here, but some asshole put VecScatter in the interface */
3327d172c84bSMatthew G. Knepley         if (fvRef[field] || (feRef[field] && order == 0)) {
3328d172c84bSMatthew G. Knepley           cmap[offsetC+c] = offsetF+0;
332997c42addSMatthew G. Knepley         } else SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Could not locate matching functional for injection");
333097c42addSMatthew G. Knepley       }
33317c927364SMatthew G. Knepley     }
3332d172c84bSMatthew G. Knepley     offsetC += cpdim;
3333d172c84bSMatthew G. Knepley     offsetF += fpdim;
33347c927364SMatthew G. Knepley   }
33359566063dSJacob Faibussowitsch   for (f = 0; f < Nf; ++f) {PetscCall(PetscFEDestroy(&feRef[f]));PetscCall(PetscFVDestroy(&fvRef[f]));}
33369566063dSJacob Faibussowitsch   PetscCall(PetscFree3(feRef,fvRef,needAvg));
33377c927364SMatthew G. Knepley 
33389566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalVector(dmf, &fv));
33399566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalVector(dmc, &cv));
33409566063dSJacob Faibussowitsch   PetscCall(VecGetOwnershipRange(cv, &startC, &endC));
33419566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetConstrainedStorageSize(cglobalSection, &m));
33429566063dSJacob Faibussowitsch   PetscCall(PetscMalloc2(cTotDim,&cellCIndices,fTotDim,&cellFIndices));
33439566063dSJacob Faibussowitsch   PetscCall(PetscMalloc1(m,&cindices));
33449566063dSJacob Faibussowitsch   PetscCall(PetscMalloc1(m,&findices));
33457c927364SMatthew G. Knepley   for (d = 0; d < m; ++d) cindices[d] = findices[d] = -1;
33467c927364SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
33479566063dSJacob Faibussowitsch     PetscCall(DMPlexMatGetClosureIndicesRefined(dmf, fsection, fglobalSection, dmc, csection, cglobalSection, c, cellCIndices, cellFIndices));
33487c927364SMatthew G. Knepley     for (d = 0; d < cTotDim; ++d) {
33490bd915a7SMatthew G. Knepley       if ((cellCIndices[d] < startC) || (cellCIndices[d] >= endC)) continue;
33502c71b3e2SJacob Faibussowitsch       PetscCheckFalse((findices[cellCIndices[d]-startC] >= 0) && (findices[cellCIndices[d]-startC] != cellFIndices[cmap[d]]),PETSC_COMM_SELF, PETSC_ERR_PLIB, "Coarse dof %D maps to both %D and %D", cindices[cellCIndices[d]-startC], findices[cellCIndices[d]-startC], cellFIndices[cmap[d]]);
33517c927364SMatthew G. Knepley       cindices[cellCIndices[d]-startC] = cellCIndices[d];
33527c927364SMatthew G. Knepley       findices[cellCIndices[d]-startC] = cellFIndices[cmap[d]];
33537c927364SMatthew G. Knepley     }
33547c927364SMatthew G. Knepley   }
33559566063dSJacob Faibussowitsch   PetscCall(PetscFree(cmap));
33569566063dSJacob Faibussowitsch   PetscCall(PetscFree2(cellCIndices,cellFIndices));
33577c927364SMatthew G. Knepley 
33589566063dSJacob Faibussowitsch   PetscCall(ISCreateGeneral(PETSC_COMM_SELF, m, cindices, PETSC_OWN_POINTER, &cis));
33599566063dSJacob Faibussowitsch   PetscCall(ISCreateGeneral(PETSC_COMM_SELF, m, findices, PETSC_OWN_POINTER, &fis));
33609566063dSJacob Faibussowitsch   PetscCall(VecScatterCreate(cv, cis, fv, fis, sc));
33619566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&cis));
33629566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&fis));
33639566063dSJacob Faibussowitsch   PetscCall(DMRestoreGlobalVector(dmf, &fv));
33649566063dSJacob Faibussowitsch   PetscCall(DMRestoreGlobalVector(dmc, &cv));
33659566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_InjectorFEM,dmc,dmf,0,0));
3366cb1e1211SMatthew G Knepley   PetscFunctionReturn(0);
3367cb1e1211SMatthew G Knepley }
3368a1cf66bbSMatthew G. Knepley 
33692f856554SMatthew G. Knepley /*@C
33702f856554SMatthew G. Knepley   DMPlexGetCellFields - Retrieve the field values values for a chunk of cells
33712f856554SMatthew G. Knepley 
33722f856554SMatthew G. Knepley   Input Parameters:
33732f856554SMatthew G. Knepley + dm     - The DM
33742f856554SMatthew G. Knepley . cellIS - The cells to include
33752f856554SMatthew G. Knepley . locX   - A local vector with the solution fields
33762f856554SMatthew G. Knepley . locX_t - A local vector with solution field time derivatives, or NULL
33772f856554SMatthew G. Knepley - locA   - A local vector with auxiliary fields, or NULL
33782f856554SMatthew G. Knepley 
33792f856554SMatthew G. Knepley   Output Parameters:
33802f856554SMatthew G. Knepley + u   - The field coefficients
33812f856554SMatthew G. Knepley . u_t - The fields derivative coefficients
33822f856554SMatthew G. Knepley - a   - The auxiliary field coefficients
33832f856554SMatthew G. Knepley 
33842f856554SMatthew G. Knepley   Level: developer
33852f856554SMatthew G. Knepley 
33862f856554SMatthew G. Knepley .seealso: DMPlexGetFaceFields()
33872f856554SMatthew G. Knepley @*/
33882f856554SMatthew G. Knepley PetscErrorCode DMPlexGetCellFields(DM dm, IS cellIS, Vec locX, Vec locX_t, Vec locA, PetscScalar **u, PetscScalar **u_t, PetscScalar **a)
33892f856554SMatthew G. Knepley {
33902f856554SMatthew G. Knepley   DM              plex, plexA = NULL;
3391a6e0b375SMatthew G. Knepley   DMEnclosureType encAux;
33922f856554SMatthew G. Knepley   PetscSection    section, sectionAux;
33932f856554SMatthew G. Knepley   PetscDS         prob;
33942f856554SMatthew G. Knepley   const PetscInt *cells;
33952f856554SMatthew G. Knepley   PetscInt        cStart, cEnd, numCells, totDim, totDimAux, c;
33962f856554SMatthew G. Knepley 
33972f856554SMatthew G. Knepley   PetscFunctionBegin;
33982f856554SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
3399064a246eSJacob Faibussowitsch   PetscValidHeaderSpecific(locX, VEC_CLASSID, 3);
3400064a246eSJacob Faibussowitsch   if (locX_t) {PetscValidHeaderSpecific(locX_t, VEC_CLASSID, 4);}
3401064a246eSJacob Faibussowitsch   if (locA)   {PetscValidHeaderSpecific(locA, VEC_CLASSID, 5);}
3402064a246eSJacob Faibussowitsch   PetscValidPointer(u, 6);
3403064a246eSJacob Faibussowitsch   PetscValidPointer(u_t, 7);
3404064a246eSJacob Faibussowitsch   PetscValidPointer(a, 8);
34059566063dSJacob Faibussowitsch   PetscCall(DMPlexConvertPlex(dm, &plex, PETSC_FALSE));
34069566063dSJacob Faibussowitsch   PetscCall(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
34079566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
34089566063dSJacob Faibussowitsch   PetscCall(DMGetCellDS(dm, cells ? cells[cStart] : cStart, &prob));
34099566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(prob, &totDim));
34102f856554SMatthew G. Knepley   if (locA) {
34112f856554SMatthew G. Knepley     DM      dmAux;
34122f856554SMatthew G. Knepley     PetscDS probAux;
34132f856554SMatthew G. Knepley 
34149566063dSJacob Faibussowitsch     PetscCall(VecGetDM(locA, &dmAux));
34159566063dSJacob Faibussowitsch     PetscCall(DMGetEnclosureRelation(dmAux, dm, &encAux));
34169566063dSJacob Faibussowitsch     PetscCall(DMPlexConvertPlex(dmAux, &plexA, PETSC_FALSE));
34179566063dSJacob Faibussowitsch     PetscCall(DMGetLocalSection(dmAux, &sectionAux));
34189566063dSJacob Faibussowitsch     PetscCall(DMGetDS(dmAux, &probAux));
34199566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalDimension(probAux, &totDimAux));
34202f856554SMatthew G. Knepley   }
34212f856554SMatthew G. Knepley   numCells = cEnd - cStart;
34229566063dSJacob Faibussowitsch   PetscCall(DMGetWorkArray(dm, numCells*totDim, MPIU_SCALAR, u));
34239566063dSJacob Faibussowitsch   if (locX_t) PetscCall(DMGetWorkArray(dm, numCells*totDim, MPIU_SCALAR, u_t)); else {*u_t = NULL;}
34249566063dSJacob Faibussowitsch   if (locA)   PetscCall(DMGetWorkArray(dm, numCells*totDimAux, MPIU_SCALAR, a)); else {*a = NULL;}
34252f856554SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
34262f856554SMatthew G. Knepley     const PetscInt cell = cells ? cells[c] : c;
34272f856554SMatthew G. Knepley     const PetscInt cind = c - cStart;
34282f856554SMatthew G. Knepley     PetscScalar   *x = NULL, *x_t = NULL, *ul = *u, *ul_t = *u_t, *al = *a;
34292f856554SMatthew G. Knepley     PetscInt       i;
34302f856554SMatthew G. Knepley 
34319566063dSJacob Faibussowitsch     PetscCall(DMPlexVecGetClosure(plex, section, locX, cell, NULL, &x));
34322f856554SMatthew G. Knepley     for (i = 0; i < totDim; ++i) ul[cind*totDim+i] = x[i];
34339566063dSJacob Faibussowitsch     PetscCall(DMPlexVecRestoreClosure(plex, section, locX, cell, NULL, &x));
34342f856554SMatthew G. Knepley     if (locX_t) {
34359566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(plex, section, locX_t, cell, NULL, &x_t));
34362f856554SMatthew G. Knepley       for (i = 0; i < totDim; ++i) ul_t[cind*totDim+i] = x_t[i];
34379566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(plex, section, locX_t, cell, NULL, &x_t));
34382f856554SMatthew G. Knepley     }
34392f856554SMatthew G. Knepley     if (locA) {
34402f856554SMatthew G. Knepley       PetscInt subcell;
34419566063dSJacob Faibussowitsch       PetscCall(DMGetEnclosurePoint(plexA, dm, encAux, cell, &subcell));
34429566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(plexA, sectionAux, locA, subcell, NULL, &x));
34432f856554SMatthew G. Knepley       for (i = 0; i < totDimAux; ++i) al[cind*totDimAux+i] = x[i];
34449566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(plexA, sectionAux, locA, subcell, NULL, &x));
34452f856554SMatthew G. Knepley     }
34462f856554SMatthew G. Knepley   }
34479566063dSJacob Faibussowitsch   PetscCall(DMDestroy(&plex));
34489566063dSJacob Faibussowitsch   if (locA) PetscCall(DMDestroy(&plexA));
34499566063dSJacob Faibussowitsch   PetscCall(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
34502f856554SMatthew G. Knepley   PetscFunctionReturn(0);
34512f856554SMatthew G. Knepley }
34522f856554SMatthew G. Knepley 
34532f856554SMatthew G. Knepley /*@C
34542f856554SMatthew G. Knepley   DMPlexRestoreCellFields - Restore the field values values for a chunk of cells
34552f856554SMatthew G. Knepley 
34562f856554SMatthew G. Knepley   Input Parameters:
34572f856554SMatthew G. Knepley + dm     - The DM
34582f856554SMatthew G. Knepley . cellIS - The cells to include
34592f856554SMatthew G. Knepley . locX   - A local vector with the solution fields
34602f856554SMatthew G. Knepley . locX_t - A local vector with solution field time derivatives, or NULL
34612f856554SMatthew G. Knepley - locA   - A local vector with auxiliary fields, or NULL
34622f856554SMatthew G. Knepley 
34632f856554SMatthew G. Knepley   Output Parameters:
34642f856554SMatthew G. Knepley + u   - The field coefficients
34652f856554SMatthew G. Knepley . u_t - The fields derivative coefficients
34662f856554SMatthew G. Knepley - a   - The auxiliary field coefficients
34672f856554SMatthew G. Knepley 
34682f856554SMatthew G. Knepley   Level: developer
34692f856554SMatthew G. Knepley 
34702f856554SMatthew G. Knepley .seealso: DMPlexGetFaceFields()
34712f856554SMatthew G. Knepley @*/
34722f856554SMatthew G. Knepley PetscErrorCode DMPlexRestoreCellFields(DM dm, IS cellIS, Vec locX, Vec locX_t, Vec locA, PetscScalar **u, PetscScalar **u_t, PetscScalar **a)
34732f856554SMatthew G. Knepley {
34742f856554SMatthew G. Knepley   PetscFunctionBegin;
34759566063dSJacob Faibussowitsch   PetscCall(DMRestoreWorkArray(dm, 0, MPIU_SCALAR, u));
34769566063dSJacob Faibussowitsch   if (locX_t) PetscCall(DMRestoreWorkArray(dm, 0, MPIU_SCALAR, u_t));
34779566063dSJacob Faibussowitsch   if (locA)   PetscCall(DMRestoreWorkArray(dm, 0, MPIU_SCALAR, a));
34782f856554SMatthew G. Knepley   PetscFunctionReturn(0);
34792f856554SMatthew G. Knepley }
34802f856554SMatthew G. Knepley 
3481faff4f7fSMatthew G. Knepley /*
3482faff4f7fSMatthew G. Knepley   Get the auxiliary field vectors for the negative side (s = 0) and positive side (s = 1) of the interfaace
3483faff4f7fSMatthew G. Knepley */
3484148442b3SMatthew G. Knepley static PetscErrorCode DMPlexGetHybridAuxFields(DM dm, DM dmAux[], PetscDS dsAux[], IS cellIS, Vec locA[], PetscScalar *a[])
34856528b96dSMatthew G. Knepley {
348604c51a94SMatthew G. Knepley   DM              plexA[2];
3487148442b3SMatthew G. Knepley   DMEnclosureType encAux[2];
348804c51a94SMatthew G. Knepley   PetscSection    sectionAux[2];
34896528b96dSMatthew G. Knepley   const PetscInt *cells;
3490148442b3SMatthew G. Knepley   PetscInt        cStart, cEnd, numCells, c, s, totDimAux[2];
34916528b96dSMatthew G. Knepley 
34926528b96dSMatthew G. Knepley   PetscFunctionBegin;
3493148442b3SMatthew G. Knepley   PetscValidPointer(locA, 5);
349404c51a94SMatthew G. Knepley   if (!locA[0] || !locA[1]) PetscFunctionReturn(0);
3495148442b3SMatthew G. Knepley   PetscValidPointer(dmAux, 2);
3496148442b3SMatthew G. Knepley   PetscValidPointer(dsAux, 3);
3497148442b3SMatthew G. Knepley   PetscValidPointer(a, 6);
34989566063dSJacob Faibussowitsch   PetscCall(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
34996528b96dSMatthew G. Knepley   numCells = cEnd - cStart;
3500148442b3SMatthew G. Knepley   for (s = 0; s < 2; ++s) {
3501148442b3SMatthew G. Knepley     PetscValidHeaderSpecific(dmAux[s], DM_CLASSID, 2);
3502148442b3SMatthew G. Knepley     PetscValidHeaderSpecific(dsAux[s], PETSCDS_CLASSID, 3);
3503148442b3SMatthew G. Knepley     PetscValidHeaderSpecific(locA[s], VEC_CLASSID, 5);
35049566063dSJacob Faibussowitsch     PetscCall(DMPlexConvertPlex(dmAux[s], &plexA[s], PETSC_FALSE));
35059566063dSJacob Faibussowitsch     PetscCall(DMGetEnclosureRelation(dmAux[s], dm, &encAux[s]));
35069566063dSJacob Faibussowitsch     PetscCall(DMGetLocalSection(dmAux[s], &sectionAux[s]));
35079566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalDimension(dsAux[s], &totDimAux[s]));
35089566063dSJacob Faibussowitsch     PetscCall(DMGetWorkArray(dmAux[s], numCells*totDimAux[s], MPIU_SCALAR, &a[s]));
350904c51a94SMatthew G. Knepley   }
3510148442b3SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
35116528b96dSMatthew G. Knepley     const PetscInt  cell = cells ? cells[c] : c;
35126528b96dSMatthew G. Knepley     const PetscInt  cind = c - cStart;
35136528b96dSMatthew G. Knepley     const PetscInt *cone, *ornt;
35146528b96dSMatthew G. Knepley 
35159566063dSJacob Faibussowitsch     PetscCall(DMPlexGetCone(dm, cell, &cone));
35169566063dSJacob Faibussowitsch     PetscCall(DMPlexGetConeOrientation(dm, cell, &ornt));
35172c71b3e2SJacob Faibussowitsch     PetscCheckFalse(ornt[0],PETSC_COMM_SELF, PETSC_ERR_SUP, "Face %D in hybrid cell %D has orientation %D != 0", cone[0], cell, ornt[0]);
3518148442b3SMatthew G. Knepley     for (s = 0; s < 2; ++s) {
35195fedec97SMatthew G. Knepley       const PetscInt *support;
3520148442b3SMatthew G. Knepley       PetscScalar    *x = NULL, *al = a[s];
3521148442b3SMatthew G. Knepley       const PetscInt  tdA = totDimAux[s];
35225fedec97SMatthew G. Knepley       PetscInt        ssize, scell;
3523148442b3SMatthew G. Knepley       PetscInt        subface, Na, i;
35246528b96dSMatthew G. Knepley 
35259566063dSJacob Faibussowitsch       PetscCall(DMPlexGetSupport(dm, cone[s], &support));
35269566063dSJacob Faibussowitsch       PetscCall(DMPlexGetSupportSize(dm, cone[s], &ssize));
35272c71b3e2SJacob Faibussowitsch       PetscCheckFalse(ssize != 2,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Face %D from cell %D has support size %D != 2", cone[s], cell, ssize);
35285fedec97SMatthew G. Knepley       if      (support[0] == cell) scell = support[1];
35295fedec97SMatthew G. Knepley       else if (support[1] == cell) scell = support[0];
353098921bdaSJacob Faibussowitsch       else SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Face %D does not have cell %D in its support", cone[s], cell);
35315fedec97SMatthew G. Knepley 
35329566063dSJacob Faibussowitsch       PetscCall(DMGetEnclosurePoint(plexA[s], dm, encAux[s], scell, &subface));
35339566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(plexA[s], sectionAux[s], locA[s], subface, &Na, &x));
35346528b96dSMatthew G. Knepley       for (i = 0; i < Na; ++i) al[cind*tdA+i] = x[i];
35359566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(plexA[s], sectionAux[s], locA[s], subface, &Na, &x));
35366528b96dSMatthew G. Knepley     }
35376528b96dSMatthew G. Knepley   }
35389566063dSJacob Faibussowitsch   for (s = 0; s < 2; ++s) PetscCall(DMDestroy(&plexA[s]));
35399566063dSJacob Faibussowitsch   PetscCall(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
35406528b96dSMatthew G. Knepley   PetscFunctionReturn(0);
35416528b96dSMatthew G. Knepley }
35426528b96dSMatthew G. Knepley 
354304c51a94SMatthew G. Knepley static PetscErrorCode DMPlexRestoreHybridAuxFields(DM dmAux[], PetscDS dsAux[], IS cellIS, Vec locA[], PetscScalar *a[])
35446528b96dSMatthew G. Knepley {
35456528b96dSMatthew G. Knepley   PetscFunctionBegin;
354604c51a94SMatthew G. Knepley   if (!locA[0] || !locA[1]) PetscFunctionReturn(0);
35479566063dSJacob Faibussowitsch   PetscCall(DMRestoreWorkArray(dmAux[0], 0, MPIU_SCALAR, &a[0]));
35489566063dSJacob Faibussowitsch   PetscCall(DMRestoreWorkArray(dmAux[1], 0, MPIU_SCALAR, &a[1]));
35496528b96dSMatthew G. Knepley   PetscFunctionReturn(0);
35506528b96dSMatthew G. Knepley }
35516528b96dSMatthew G. Knepley 
35522f856554SMatthew G. Knepley /*@C
35532f856554SMatthew G. Knepley   DMPlexGetFaceFields - Retrieve the field values values for a chunk of faces
35542f856554SMatthew G. Knepley 
35552f856554SMatthew G. Knepley   Input Parameters:
35562f856554SMatthew G. Knepley + dm     - The DM
35572f856554SMatthew G. Knepley . fStart - The first face to include
35582f856554SMatthew G. Knepley . fEnd   - The first face to exclude
35592f856554SMatthew G. Knepley . locX   - A local vector with the solution fields
35602f856554SMatthew G. Knepley . locX_t - A local vector with solution field time derivatives, or NULL
35612f856554SMatthew G. Knepley . faceGeometry - A local vector with face geometry
35622f856554SMatthew G. Knepley . cellGeometry - A local vector with cell geometry
35632f856554SMatthew G. Knepley - locaGrad - A local vector with field gradients, or NULL
35642f856554SMatthew G. Knepley 
35652f856554SMatthew G. Knepley   Output Parameters:
35662f856554SMatthew G. Knepley + Nface - The number of faces with field values
35672f856554SMatthew G. Knepley . uL - The field values at the left side of the face
35682f856554SMatthew G. Knepley - uR - The field values at the right side of the face
35692f856554SMatthew G. Knepley 
35702f856554SMatthew G. Knepley   Level: developer
35712f856554SMatthew G. Knepley 
35722f856554SMatthew G. Knepley .seealso: DMPlexGetCellFields()
35732f856554SMatthew G. Knepley @*/
35742f856554SMatthew 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)
35752f856554SMatthew G. Knepley {
35762f856554SMatthew G. Knepley   DM                 dmFace, dmCell, dmGrad = NULL;
35772f856554SMatthew G. Knepley   PetscSection       section;
35782f856554SMatthew G. Knepley   PetscDS            prob;
35792f856554SMatthew G. Knepley   DMLabel            ghostLabel;
35802f856554SMatthew G. Knepley   const PetscScalar *facegeom, *cellgeom, *x, *lgrad;
35812f856554SMatthew G. Knepley   PetscBool         *isFE;
35822f856554SMatthew G. Knepley   PetscInt           dim, Nf, f, Nc, numFaces = fEnd - fStart, iface, face;
35832f856554SMatthew G. Knepley 
35842f856554SMatthew G. Knepley   PetscFunctionBegin;
35852f856554SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
35862f856554SMatthew G. Knepley   PetscValidHeaderSpecific(locX, VEC_CLASSID, 4);
35872f856554SMatthew G. Knepley   if (locX_t) {PetscValidHeaderSpecific(locX_t, VEC_CLASSID, 5);}
35882f856554SMatthew G. Knepley   PetscValidHeaderSpecific(faceGeometry, VEC_CLASSID, 6);
35892f856554SMatthew G. Knepley   PetscValidHeaderSpecific(cellGeometry, VEC_CLASSID, 7);
35902f856554SMatthew G. Knepley   if (locGrad) {PetscValidHeaderSpecific(locGrad, VEC_CLASSID, 8);}
3591064a246eSJacob Faibussowitsch   PetscValidPointer(uL, 10);
3592064a246eSJacob Faibussowitsch   PetscValidPointer(uR, 11);
35939566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
35949566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dm, &prob));
35959566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
35969566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumFields(prob, &Nf));
35979566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalComponents(prob, &Nc));
35989566063dSJacob Faibussowitsch   PetscCall(PetscMalloc1(Nf, &isFE));
35992f856554SMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
36002f856554SMatthew G. Knepley     PetscObject  obj;
36012f856554SMatthew G. Knepley     PetscClassId id;
36022f856554SMatthew G. Knepley 
36039566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, f, &obj));
36049566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
36052f856554SMatthew G. Knepley     if (id == PETSCFE_CLASSID)      {isFE[f] = PETSC_TRUE;}
36062f856554SMatthew G. Knepley     else if (id == PETSCFV_CLASSID) {isFE[f] = PETSC_FALSE;}
36072f856554SMatthew G. Knepley     else                            {isFE[f] = PETSC_FALSE;}
36082f856554SMatthew G. Knepley   }
36099566063dSJacob Faibussowitsch   PetscCall(DMGetLabel(dm, "ghost", &ghostLabel));
36109566063dSJacob Faibussowitsch   PetscCall(VecGetArrayRead(locX, &x));
36119566063dSJacob Faibussowitsch   PetscCall(VecGetDM(faceGeometry, &dmFace));
36129566063dSJacob Faibussowitsch   PetscCall(VecGetArrayRead(faceGeometry, &facegeom));
36139566063dSJacob Faibussowitsch   PetscCall(VecGetDM(cellGeometry, &dmCell));
36149566063dSJacob Faibussowitsch   PetscCall(VecGetArrayRead(cellGeometry, &cellgeom));
36152f856554SMatthew G. Knepley   if (locGrad) {
36169566063dSJacob Faibussowitsch     PetscCall(VecGetDM(locGrad, &dmGrad));
36179566063dSJacob Faibussowitsch     PetscCall(VecGetArrayRead(locGrad, &lgrad));
36182f856554SMatthew G. Knepley   }
36199566063dSJacob Faibussowitsch   PetscCall(DMGetWorkArray(dm, numFaces*Nc, MPIU_SCALAR, uL));
36209566063dSJacob Faibussowitsch   PetscCall(DMGetWorkArray(dm, numFaces*Nc, MPIU_SCALAR, uR));
36212f856554SMatthew G. Knepley   /* Right now just eat the extra work for FE (could make a cell loop) */
36222f856554SMatthew G. Knepley   for (face = fStart, iface = 0; face < fEnd; ++face) {
36232f856554SMatthew G. Knepley     const PetscInt        *cells;
36242f856554SMatthew G. Knepley     PetscFVFaceGeom       *fg;
36252f856554SMatthew G. Knepley     PetscFVCellGeom       *cgL, *cgR;
36262f856554SMatthew G. Knepley     PetscScalar           *xL, *xR, *gL, *gR;
36272f856554SMatthew G. Knepley     PetscScalar           *uLl = *uL, *uRl = *uR;
36282f856554SMatthew G. Knepley     PetscInt               ghost, nsupp, nchild;
36292f856554SMatthew G. Knepley 
36309566063dSJacob Faibussowitsch     PetscCall(DMLabelGetValue(ghostLabel, face, &ghost));
36319566063dSJacob Faibussowitsch     PetscCall(DMPlexGetSupportSize(dm, face, &nsupp));
36329566063dSJacob Faibussowitsch     PetscCall(DMPlexGetTreeChildren(dm, face, &nchild, NULL));
36332f856554SMatthew G. Knepley     if (ghost >= 0 || nsupp > 2 || nchild > 0) continue;
36349566063dSJacob Faibussowitsch     PetscCall(DMPlexPointLocalRead(dmFace, face, facegeom, &fg));
36359566063dSJacob Faibussowitsch     PetscCall(DMPlexGetSupport(dm, face, &cells));
36369566063dSJacob Faibussowitsch     PetscCall(DMPlexPointLocalRead(dmCell, cells[0], cellgeom, &cgL));
36379566063dSJacob Faibussowitsch     PetscCall(DMPlexPointLocalRead(dmCell, cells[1], cellgeom, &cgR));
36382f856554SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
36392f856554SMatthew G. Knepley       PetscInt off;
36402f856554SMatthew G. Knepley 
36419566063dSJacob Faibussowitsch       PetscCall(PetscDSGetComponentOffset(prob, f, &off));
36422f856554SMatthew G. Knepley       if (isFE[f]) {
36432f856554SMatthew G. Knepley         const PetscInt *cone;
36442f856554SMatthew G. Knepley         PetscInt        comp, coneSizeL, coneSizeR, faceLocL, faceLocR, ldof, rdof, d;
36452f856554SMatthew G. Knepley 
36462f856554SMatthew G. Knepley         xL = xR = NULL;
36479566063dSJacob Faibussowitsch         PetscCall(PetscSectionGetFieldComponents(section, f, &comp));
36489566063dSJacob Faibussowitsch         PetscCall(DMPlexVecGetClosure(dm, section, locX, cells[0], &ldof, (PetscScalar **) &xL));
36499566063dSJacob Faibussowitsch         PetscCall(DMPlexVecGetClosure(dm, section, locX, cells[1], &rdof, (PetscScalar **) &xR));
36509566063dSJacob Faibussowitsch         PetscCall(DMPlexGetCone(dm, cells[0], &cone));
36519566063dSJacob Faibussowitsch         PetscCall(DMPlexGetConeSize(dm, cells[0], &coneSizeL));
36522f856554SMatthew G. Knepley         for (faceLocL = 0; faceLocL < coneSizeL; ++faceLocL) if (cone[faceLocL] == face) break;
36539566063dSJacob Faibussowitsch         PetscCall(DMPlexGetCone(dm, cells[1], &cone));
36549566063dSJacob Faibussowitsch         PetscCall(DMPlexGetConeSize(dm, cells[1], &coneSizeR));
36552f856554SMatthew G. Knepley         for (faceLocR = 0; faceLocR < coneSizeR; ++faceLocR) if (cone[faceLocR] == face) break;
36562c71b3e2SJacob Faibussowitsch         PetscCheckFalse(faceLocL == coneSizeL && faceLocR == coneSizeR,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Could not find face %D in cone of cell %D or cell %D", face, cells[0], cells[1]);
36572f856554SMatthew G. Knepley         /* Check that FEM field has values in the right cell (sometimes its an FV ghost cell) */
36582f856554SMatthew G. Knepley         /* TODO: this is a hack that might not be right for nonconforming */
36592f856554SMatthew G. Knepley         if (faceLocL < coneSizeL) {
36609566063dSJacob Faibussowitsch           PetscCall(PetscFEEvaluateFaceFields_Internal(prob, f, faceLocL, xL, &uLl[iface*Nc+off]));
36619566063dSJacob Faibussowitsch           if (rdof == ldof && faceLocR < coneSizeR) PetscCall(PetscFEEvaluateFaceFields_Internal(prob, f, faceLocR, xR, &uRl[iface*Nc+off]));
36622f856554SMatthew G. Knepley           else              {for (d = 0; d < comp; ++d) uRl[iface*Nc+off+d] = uLl[iface*Nc+off+d];}
36632f856554SMatthew G. Knepley         }
36642f856554SMatthew G. Knepley         else {
36659566063dSJacob Faibussowitsch           PetscCall(PetscFEEvaluateFaceFields_Internal(prob, f, faceLocR, xR, &uRl[iface*Nc+off]));
36669566063dSJacob Faibussowitsch           PetscCall(PetscSectionGetFieldComponents(section, f, &comp));
36672f856554SMatthew G. Knepley           for (d = 0; d < comp; ++d) uLl[iface*Nc+off+d] = uRl[iface*Nc+off+d];
36682f856554SMatthew G. Knepley         }
36699566063dSJacob Faibussowitsch         PetscCall(DMPlexVecRestoreClosure(dm, section, locX, cells[0], &ldof, (PetscScalar **) &xL));
36709566063dSJacob Faibussowitsch         PetscCall(DMPlexVecRestoreClosure(dm, section, locX, cells[1], &rdof, (PetscScalar **) &xR));
36712f856554SMatthew G. Knepley       } else {
36722f856554SMatthew G. Knepley         PetscFV  fv;
36732f856554SMatthew G. Knepley         PetscInt numComp, c;
36742f856554SMatthew G. Knepley 
36759566063dSJacob Faibussowitsch         PetscCall(PetscDSGetDiscretization(prob, f, (PetscObject *) &fv));
36769566063dSJacob Faibussowitsch         PetscCall(PetscFVGetNumComponents(fv, &numComp));
36779566063dSJacob Faibussowitsch         PetscCall(DMPlexPointLocalFieldRead(dm, cells[0], f, x, &xL));
36789566063dSJacob Faibussowitsch         PetscCall(DMPlexPointLocalFieldRead(dm, cells[1], f, x, &xR));
36792f856554SMatthew G. Knepley         if (dmGrad) {
36802f856554SMatthew G. Knepley           PetscReal dxL[3], dxR[3];
36812f856554SMatthew G. Knepley 
36829566063dSJacob Faibussowitsch           PetscCall(DMPlexPointLocalRead(dmGrad, cells[0], lgrad, &gL));
36839566063dSJacob Faibussowitsch           PetscCall(DMPlexPointLocalRead(dmGrad, cells[1], lgrad, &gR));
36842f856554SMatthew G. Knepley           DMPlex_WaxpyD_Internal(dim, -1, cgL->centroid, fg->centroid, dxL);
36852f856554SMatthew G. Knepley           DMPlex_WaxpyD_Internal(dim, -1, cgR->centroid, fg->centroid, dxR);
36862f856554SMatthew G. Knepley           for (c = 0; c < numComp; ++c) {
36872f856554SMatthew G. Knepley             uLl[iface*Nc+off+c] = xL[c] + DMPlex_DotD_Internal(dim, &gL[c*dim], dxL);
36882f856554SMatthew G. Knepley             uRl[iface*Nc+off+c] = xR[c] + DMPlex_DotD_Internal(dim, &gR[c*dim], dxR);
36892f856554SMatthew G. Knepley           }
36902f856554SMatthew G. Knepley         } else {
36912f856554SMatthew G. Knepley           for (c = 0; c < numComp; ++c) {
36922f856554SMatthew G. Knepley             uLl[iface*Nc+off+c] = xL[c];
36932f856554SMatthew G. Knepley             uRl[iface*Nc+off+c] = xR[c];
36942f856554SMatthew G. Knepley           }
36952f856554SMatthew G. Knepley         }
36962f856554SMatthew G. Knepley       }
36972f856554SMatthew G. Knepley     }
36982f856554SMatthew G. Knepley     ++iface;
36992f856554SMatthew G. Knepley   }
37002f856554SMatthew G. Knepley   *Nface = iface;
37019566063dSJacob Faibussowitsch   PetscCall(VecRestoreArrayRead(locX, &x));
37029566063dSJacob Faibussowitsch   PetscCall(VecRestoreArrayRead(faceGeometry, &facegeom));
37039566063dSJacob Faibussowitsch   PetscCall(VecRestoreArrayRead(cellGeometry, &cellgeom));
37042f856554SMatthew G. Knepley   if (locGrad) {
37059566063dSJacob Faibussowitsch     PetscCall(VecRestoreArrayRead(locGrad, &lgrad));
37062f856554SMatthew G. Knepley   }
37079566063dSJacob Faibussowitsch   PetscCall(PetscFree(isFE));
37082f856554SMatthew G. Knepley   PetscFunctionReturn(0);
37092f856554SMatthew G. Knepley }
37102f856554SMatthew G. Knepley 
37112f856554SMatthew G. Knepley /*@C
37122f856554SMatthew G. Knepley   DMPlexRestoreFaceFields - Restore the field values values for a chunk of faces
37132f856554SMatthew G. Knepley 
37142f856554SMatthew G. Knepley   Input Parameters:
37152f856554SMatthew G. Knepley + dm     - The DM
37162f856554SMatthew G. Knepley . fStart - The first face to include
37172f856554SMatthew G. Knepley . fEnd   - The first face to exclude
37182f856554SMatthew G. Knepley . locX   - A local vector with the solution fields
37192f856554SMatthew G. Knepley . locX_t - A local vector with solution field time derivatives, or NULL
37202f856554SMatthew G. Knepley . faceGeometry - A local vector with face geometry
37212f856554SMatthew G. Knepley . cellGeometry - A local vector with cell geometry
37222f856554SMatthew G. Knepley - locaGrad - A local vector with field gradients, or NULL
37232f856554SMatthew G. Knepley 
37242f856554SMatthew G. Knepley   Output Parameters:
37252f856554SMatthew G. Knepley + Nface - The number of faces with field values
37262f856554SMatthew G. Knepley . uL - The field values at the left side of the face
37272f856554SMatthew G. Knepley - uR - The field values at the right side of the face
37282f856554SMatthew G. Knepley 
37292f856554SMatthew G. Knepley   Level: developer
37302f856554SMatthew G. Knepley 
37312f856554SMatthew G. Knepley .seealso: DMPlexGetFaceFields()
37322f856554SMatthew G. Knepley @*/
37332f856554SMatthew 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)
37342f856554SMatthew G. Knepley {
37352f856554SMatthew G. Knepley   PetscFunctionBegin;
37369566063dSJacob Faibussowitsch   PetscCall(DMRestoreWorkArray(dm, 0, MPIU_SCALAR, uL));
37379566063dSJacob Faibussowitsch   PetscCall(DMRestoreWorkArray(dm, 0, MPIU_SCALAR, uR));
37382f856554SMatthew G. Knepley   PetscFunctionReturn(0);
37392f856554SMatthew G. Knepley }
37402f856554SMatthew G. Knepley 
37412f856554SMatthew G. Knepley /*@C
37422f856554SMatthew G. Knepley   DMPlexGetFaceGeometry - Retrieve the geometric values for a chunk of faces
37432f856554SMatthew G. Knepley 
37442f856554SMatthew G. Knepley   Input Parameters:
37452f856554SMatthew G. Knepley + dm     - The DM
37462f856554SMatthew G. Knepley . fStart - The first face to include
37472f856554SMatthew G. Knepley . fEnd   - The first face to exclude
37482f856554SMatthew G. Knepley . faceGeometry - A local vector with face geometry
37492f856554SMatthew G. Knepley - cellGeometry - A local vector with cell geometry
37502f856554SMatthew G. Knepley 
37512f856554SMatthew G. Knepley   Output Parameters:
37522f856554SMatthew G. Knepley + Nface - The number of faces with field values
37532f856554SMatthew G. Knepley . fgeom - The extract the face centroid and normal
37542f856554SMatthew G. Knepley - vol   - The cell volume
37552f856554SMatthew G. Knepley 
37562f856554SMatthew G. Knepley   Level: developer
37572f856554SMatthew G. Knepley 
37582f856554SMatthew G. Knepley .seealso: DMPlexGetCellFields()
37592f856554SMatthew G. Knepley @*/
37602f856554SMatthew G. Knepley PetscErrorCode DMPlexGetFaceGeometry(DM dm, PetscInt fStart, PetscInt fEnd, Vec faceGeometry, Vec cellGeometry, PetscInt *Nface, PetscFVFaceGeom **fgeom, PetscReal **vol)
37612f856554SMatthew G. Knepley {
37622f856554SMatthew G. Knepley   DM                 dmFace, dmCell;
37632f856554SMatthew G. Knepley   DMLabel            ghostLabel;
37642f856554SMatthew G. Knepley   const PetscScalar *facegeom, *cellgeom;
37652f856554SMatthew G. Knepley   PetscInt           dim, numFaces = fEnd - fStart, iface, face;
37662f856554SMatthew G. Knepley 
37672f856554SMatthew G. Knepley   PetscFunctionBegin;
37682f856554SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
37692f856554SMatthew G. Knepley   PetscValidHeaderSpecific(faceGeometry, VEC_CLASSID, 4);
37702f856554SMatthew G. Knepley   PetscValidHeaderSpecific(cellGeometry, VEC_CLASSID, 5);
3771064a246eSJacob Faibussowitsch   PetscValidPointer(fgeom, 7);
3772064a246eSJacob Faibussowitsch   PetscValidPointer(vol, 8);
37739566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
37749566063dSJacob Faibussowitsch   PetscCall(DMGetLabel(dm, "ghost", &ghostLabel));
37759566063dSJacob Faibussowitsch   PetscCall(VecGetDM(faceGeometry, &dmFace));
37769566063dSJacob Faibussowitsch   PetscCall(VecGetArrayRead(faceGeometry, &facegeom));
37779566063dSJacob Faibussowitsch   PetscCall(VecGetDM(cellGeometry, &dmCell));
37789566063dSJacob Faibussowitsch   PetscCall(VecGetArrayRead(cellGeometry, &cellgeom));
37799566063dSJacob Faibussowitsch   PetscCall(PetscMalloc1(numFaces, fgeom));
37809566063dSJacob Faibussowitsch   PetscCall(DMGetWorkArray(dm, numFaces*2, MPIU_SCALAR, vol));
37812f856554SMatthew G. Knepley   for (face = fStart, iface = 0; face < fEnd; ++face) {
37822f856554SMatthew G. Knepley     const PetscInt        *cells;
37832f856554SMatthew G. Knepley     PetscFVFaceGeom       *fg;
37842f856554SMatthew G. Knepley     PetscFVCellGeom       *cgL, *cgR;
37852f856554SMatthew G. Knepley     PetscFVFaceGeom       *fgeoml = *fgeom;
37862f856554SMatthew G. Knepley     PetscReal             *voll   = *vol;
37872f856554SMatthew G. Knepley     PetscInt               ghost, d, nchild, nsupp;
37882f856554SMatthew G. Knepley 
37899566063dSJacob Faibussowitsch     PetscCall(DMLabelGetValue(ghostLabel, face, &ghost));
37909566063dSJacob Faibussowitsch     PetscCall(DMPlexGetSupportSize(dm, face, &nsupp));
37919566063dSJacob Faibussowitsch     PetscCall(DMPlexGetTreeChildren(dm, face, &nchild, NULL));
37922f856554SMatthew G. Knepley     if (ghost >= 0 || nsupp > 2 || nchild > 0) continue;
37939566063dSJacob Faibussowitsch     PetscCall(DMPlexPointLocalRead(dmFace, face, facegeom, &fg));
37949566063dSJacob Faibussowitsch     PetscCall(DMPlexGetSupport(dm, face, &cells));
37959566063dSJacob Faibussowitsch     PetscCall(DMPlexPointLocalRead(dmCell, cells[0], cellgeom, &cgL));
37969566063dSJacob Faibussowitsch     PetscCall(DMPlexPointLocalRead(dmCell, cells[1], cellgeom, &cgR));
37972f856554SMatthew G. Knepley     for (d = 0; d < dim; ++d) {
37982f856554SMatthew G. Knepley       fgeoml[iface].centroid[d] = fg->centroid[d];
37992f856554SMatthew G. Knepley       fgeoml[iface].normal[d]   = fg->normal[d];
38002f856554SMatthew G. Knepley     }
38012f856554SMatthew G. Knepley     voll[iface*2+0] = cgL->volume;
38022f856554SMatthew G. Knepley     voll[iface*2+1] = cgR->volume;
38032f856554SMatthew G. Knepley     ++iface;
38042f856554SMatthew G. Knepley   }
38052f856554SMatthew G. Knepley   *Nface = iface;
38069566063dSJacob Faibussowitsch   PetscCall(VecRestoreArrayRead(faceGeometry, &facegeom));
38079566063dSJacob Faibussowitsch   PetscCall(VecRestoreArrayRead(cellGeometry, &cellgeom));
38082f856554SMatthew G. Knepley   PetscFunctionReturn(0);
38092f856554SMatthew G. Knepley }
38102f856554SMatthew G. Knepley 
38112f856554SMatthew G. Knepley /*@C
38122f856554SMatthew G. Knepley   DMPlexRestoreFaceGeometry - Restore the field values values for a chunk of faces
38132f856554SMatthew G. Knepley 
38142f856554SMatthew G. Knepley   Input Parameters:
38152f856554SMatthew G. Knepley + dm     - The DM
38162f856554SMatthew G. Knepley . fStart - The first face to include
38172f856554SMatthew G. Knepley . fEnd   - The first face to exclude
38182f856554SMatthew G. Knepley . faceGeometry - A local vector with face geometry
38192f856554SMatthew G. Knepley - cellGeometry - A local vector with cell geometry
38202f856554SMatthew G. Knepley 
38212f856554SMatthew G. Knepley   Output Parameters:
38222f856554SMatthew G. Knepley + Nface - The number of faces with field values
38232f856554SMatthew G. Knepley . fgeom - The extract the face centroid and normal
38242f856554SMatthew G. Knepley - vol   - The cell volume
38252f856554SMatthew G. Knepley 
38262f856554SMatthew G. Knepley   Level: developer
38272f856554SMatthew G. Knepley 
38282f856554SMatthew G. Knepley .seealso: DMPlexGetFaceFields()
38292f856554SMatthew G. Knepley @*/
38302f856554SMatthew G. Knepley PetscErrorCode DMPlexRestoreFaceGeometry(DM dm, PetscInt fStart, PetscInt fEnd, Vec faceGeometry, Vec cellGeometry, PetscInt *Nface, PetscFVFaceGeom **fgeom, PetscReal **vol)
38312f856554SMatthew G. Knepley {
38322f856554SMatthew G. Knepley   PetscFunctionBegin;
38339566063dSJacob Faibussowitsch   PetscCall(PetscFree(*fgeom));
38349566063dSJacob Faibussowitsch   PetscCall(DMRestoreWorkArray(dm, 0, MPIU_REAL, vol));
38352f856554SMatthew G. Knepley   PetscFunctionReturn(0);
38362f856554SMatthew G. Knepley }
38372f856554SMatthew G. Knepley 
3838a1cf66bbSMatthew G. Knepley PetscErrorCode DMSNESGetFEGeom(DMField coordField, IS pointIS, PetscQuadrature quad, PetscBool faceData, PetscFEGeom **geom)
3839a1cf66bbSMatthew G. Knepley {
3840a1cf66bbSMatthew G. Knepley   char            composeStr[33] = {0};
3841a1cf66bbSMatthew G. Knepley   PetscObjectId   id;
3842a1cf66bbSMatthew G. Knepley   PetscContainer  container;
3843a1cf66bbSMatthew G. Knepley 
3844a1cf66bbSMatthew G. Knepley   PetscFunctionBegin;
38459566063dSJacob Faibussowitsch   PetscCall(PetscObjectGetId((PetscObject)quad,&id));
38469566063dSJacob Faibussowitsch   PetscCall(PetscSNPrintf(composeStr, 32, "DMSNESGetFEGeom_%x\n", id));
38479566063dSJacob Faibussowitsch   PetscCall(PetscObjectQuery((PetscObject) pointIS, composeStr, (PetscObject *) &container));
3848a1cf66bbSMatthew G. Knepley   if (container) {
38499566063dSJacob Faibussowitsch     PetscCall(PetscContainerGetPointer(container, (void **) geom));
3850a1cf66bbSMatthew G. Knepley   } else {
38519566063dSJacob Faibussowitsch     PetscCall(DMFieldCreateFEGeom(coordField, pointIS, quad, faceData, geom));
38529566063dSJacob Faibussowitsch     PetscCall(PetscContainerCreate(PETSC_COMM_SELF,&container));
38539566063dSJacob Faibussowitsch     PetscCall(PetscContainerSetPointer(container, (void *) *geom));
38549566063dSJacob Faibussowitsch     PetscCall(PetscContainerSetUserDestroy(container, PetscContainerUserDestroy_PetscFEGeom));
38559566063dSJacob Faibussowitsch     PetscCall(PetscObjectCompose((PetscObject) pointIS, composeStr, (PetscObject) container));
38569566063dSJacob Faibussowitsch     PetscCall(PetscContainerDestroy(&container));
3857a1cf66bbSMatthew G. Knepley   }
3858a1cf66bbSMatthew G. Knepley   PetscFunctionReturn(0);
3859a1cf66bbSMatthew G. Knepley }
3860a1cf66bbSMatthew G. Knepley 
3861a1cf66bbSMatthew G. Knepley PetscErrorCode DMSNESRestoreFEGeom(DMField coordField, IS pointIS, PetscQuadrature quad, PetscBool faceData, PetscFEGeom **geom)
3862a1cf66bbSMatthew G. Knepley {
3863a1cf66bbSMatthew G. Knepley   PetscFunctionBegin;
3864a1cf66bbSMatthew G. Knepley   *geom = NULL;
3865a1cf66bbSMatthew G. Knepley   PetscFunctionReturn(0);
3866a1cf66bbSMatthew G. Knepley }
3867a1cf66bbSMatthew G. Knepley 
386892d50984SMatthew G. Knepley PetscErrorCode DMPlexComputeResidual_Patch_Internal(DM dm, PetscSection section, IS cellIS, PetscReal t, Vec locX, Vec locX_t, Vec locF, void *user)
386992d50984SMatthew G. Knepley {
387092d50984SMatthew G. Knepley   DM_Plex         *mesh       = (DM_Plex *) dm->data;
387192d50984SMatthew G. Knepley   const char      *name       = "Residual";
387292d50984SMatthew G. Knepley   DM               dmAux      = NULL;
387392d50984SMatthew G. Knepley   DMLabel          ghostLabel = NULL;
387492d50984SMatthew G. Knepley   PetscDS          prob       = NULL;
387592d50984SMatthew G. Knepley   PetscDS          probAux    = NULL;
387692d50984SMatthew G. Knepley   PetscBool        useFEM     = PETSC_FALSE;
387792d50984SMatthew G. Knepley   PetscBool        isImplicit = (locX_t || t == PETSC_MIN_REAL) ? PETSC_TRUE : PETSC_FALSE;
387892d50984SMatthew G. Knepley   DMField          coordField = NULL;
3879c0006e53SPatrick Farrell   Vec              locA;
3880c0006e53SPatrick Farrell   PetscScalar     *u = NULL, *u_t, *a, *uL = NULL, *uR = NULL;
388192d50984SMatthew G. Knepley   IS               chunkIS;
388292d50984SMatthew G. Knepley   const PetscInt  *cells;
388392d50984SMatthew G. Knepley   PetscInt         cStart, cEnd, numCells;
3884364207b6SKarl Rupp   PetscInt         Nf, f, totDim, totDimAux, numChunks, cellChunkSize, chunk, fStart, fEnd;
388592d50984SMatthew G. Knepley   PetscInt         maxDegree = PETSC_MAX_INT;
388606ad1575SMatthew G. Knepley   PetscFormKey key;
388792d50984SMatthew G. Knepley   PetscQuadrature  affineQuad = NULL, *quads = NULL;
388892d50984SMatthew G. Knepley   PetscFEGeom     *affineGeom = NULL, **geoms = NULL;
388992d50984SMatthew G. Knepley 
389092d50984SMatthew G. Knepley   PetscFunctionBegin;
38919566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_ResidualFEM,dm,0,0,0));
389292d50984SMatthew G. Knepley   /* FEM+FVM */
389392d50984SMatthew G. Knepley   /* 1: Get sizes from dm and dmAux */
38949566063dSJacob Faibussowitsch   PetscCall(DMGetLabel(dm, "ghost", &ghostLabel));
38959566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dm, &prob));
38969566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumFields(prob, &Nf));
38979566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(prob, &totDim));
38989566063dSJacob Faibussowitsch   PetscCall(DMGetAuxiliaryVec(dm, NULL, 0, 0, &locA));
389992d50984SMatthew G. Knepley   if (locA) {
39009566063dSJacob Faibussowitsch     PetscCall(VecGetDM(locA, &dmAux));
39019566063dSJacob Faibussowitsch     PetscCall(DMGetDS(dmAux, &probAux));
39029566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalDimension(probAux, &totDimAux));
390392d50984SMatthew G. Knepley   }
390492d50984SMatthew G. Knepley   /* 2: Get geometric data */
390592d50984SMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
390692d50984SMatthew G. Knepley     PetscObject  obj;
390792d50984SMatthew G. Knepley     PetscClassId id;
390892d50984SMatthew G. Knepley     PetscBool    fimp;
390992d50984SMatthew G. Knepley 
39109566063dSJacob Faibussowitsch     PetscCall(PetscDSGetImplicit(prob, f, &fimp));
391192d50984SMatthew G. Knepley     if (isImplicit != fimp) continue;
39129566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, f, &obj));
39139566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
391492d50984SMatthew G. Knepley     if (id == PETSCFE_CLASSID) {useFEM = PETSC_TRUE;}
39155f80ce2aSJacob Faibussowitsch     PetscCheck(id != PETSCFV_CLASSID,PETSC_COMM_SELF,PETSC_ERR_ARG_WRONG,"Use of FVM with PCPATCH not yet implemented");
391692d50984SMatthew G. Knepley   }
391792d50984SMatthew G. Knepley   if (useFEM) {
39189566063dSJacob Faibussowitsch     PetscCall(DMGetCoordinateField(dm, &coordField));
39199566063dSJacob Faibussowitsch     PetscCall(DMFieldGetDegree(coordField,cellIS,NULL,&maxDegree));
392092d50984SMatthew G. Knepley     if (maxDegree <= 1) {
39219566063dSJacob Faibussowitsch       PetscCall(DMFieldCreateDefaultQuadrature(coordField,cellIS,&affineQuad));
392292d50984SMatthew G. Knepley       if (affineQuad) {
39239566063dSJacob Faibussowitsch         PetscCall(DMSNESGetFEGeom(coordField,cellIS,affineQuad,PETSC_FALSE,&affineGeom));
392492d50984SMatthew G. Knepley       }
392592d50984SMatthew G. Knepley     } else {
39269566063dSJacob Faibussowitsch       PetscCall(PetscCalloc2(Nf,&quads,Nf,&geoms));
392792d50984SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
392892d50984SMatthew G. Knepley         PetscObject  obj;
392992d50984SMatthew G. Knepley         PetscClassId id;
393092d50984SMatthew G. Knepley         PetscBool    fimp;
393192d50984SMatthew G. Knepley 
39329566063dSJacob Faibussowitsch         PetscCall(PetscDSGetImplicit(prob, f, &fimp));
393392d50984SMatthew G. Knepley         if (isImplicit != fimp) continue;
39349566063dSJacob Faibussowitsch         PetscCall(PetscDSGetDiscretization(prob, f, &obj));
39359566063dSJacob Faibussowitsch         PetscCall(PetscObjectGetClassId(obj, &id));
393692d50984SMatthew G. Knepley         if (id == PETSCFE_CLASSID) {
393792d50984SMatthew G. Knepley           PetscFE fe = (PetscFE) obj;
393892d50984SMatthew G. Knepley 
39399566063dSJacob Faibussowitsch           PetscCall(PetscFEGetQuadrature(fe, &quads[f]));
39409566063dSJacob Faibussowitsch           PetscCall(PetscObjectReference((PetscObject)quads[f]));
39419566063dSJacob Faibussowitsch           PetscCall(DMSNESGetFEGeom(coordField,cellIS,quads[f],PETSC_FALSE,&geoms[f]));
394292d50984SMatthew G. Knepley         }
394392d50984SMatthew G. Knepley       }
394492d50984SMatthew G. Knepley     }
394592d50984SMatthew G. Knepley   }
394692d50984SMatthew G. Knepley   /* Loop over chunks */
39479566063dSJacob Faibussowitsch   PetscCall(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
39489566063dSJacob Faibussowitsch   PetscCall(DMPlexGetHeightStratum(dm, 1, &fStart, &fEnd));
39499566063dSJacob Faibussowitsch   if (useFEM) PetscCall(ISCreate(PETSC_COMM_SELF, &chunkIS));
395092d50984SMatthew G. Knepley   numCells      = cEnd - cStart;
395192d50984SMatthew G. Knepley   numChunks     = 1;
395292d50984SMatthew G. Knepley   cellChunkSize = numCells/numChunks;
395392d50984SMatthew G. Knepley   numChunks     = PetscMin(1,numCells);
39546528b96dSMatthew G. Knepley   key.label     = NULL;
39556528b96dSMatthew G. Knepley   key.value     = 0;
395606ad1575SMatthew G. Knepley   key.part      = 0;
395792d50984SMatthew G. Knepley   for (chunk = 0; chunk < numChunks; ++chunk) {
3958c0006e53SPatrick Farrell     PetscScalar     *elemVec, *fluxL = NULL, *fluxR = NULL;
3959c0006e53SPatrick Farrell     PetscReal       *vol = NULL;
3960c0006e53SPatrick Farrell     PetscFVFaceGeom *fgeom = NULL;
396192d50984SMatthew G. Knepley     PetscInt         cS = cStart+chunk*cellChunkSize, cE = PetscMin(cS+cellChunkSize, cEnd), numCells = cE - cS, c;
3962c0006e53SPatrick Farrell     PetscInt         numFaces = 0;
396392d50984SMatthew G. Knepley 
396492d50984SMatthew G. Knepley     /* Extract field coefficients */
396592d50984SMatthew G. Knepley     if (useFEM) {
39669566063dSJacob Faibussowitsch       PetscCall(ISGetPointSubrange(chunkIS, cS, cE, cells));
39679566063dSJacob Faibussowitsch       PetscCall(DMPlexGetCellFields(dm, chunkIS, locX, locX_t, locA, &u, &u_t, &a));
39689566063dSJacob Faibussowitsch       PetscCall(DMGetWorkArray(dm, numCells*totDim, MPIU_SCALAR, &elemVec));
39699566063dSJacob Faibussowitsch       PetscCall(PetscArrayzero(elemVec, numCells*totDim));
397092d50984SMatthew G. Knepley     }
397192d50984SMatthew 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 */
397292d50984SMatthew G. Knepley     /* Loop over fields */
397392d50984SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
397492d50984SMatthew G. Knepley       PetscObject  obj;
397592d50984SMatthew G. Knepley       PetscClassId id;
397692d50984SMatthew G. Knepley       PetscBool    fimp;
397792d50984SMatthew G. Knepley       PetscInt     numChunks, numBatches, batchSize, numBlocks, blockSize, Ne, Nr, offset;
397892d50984SMatthew G. Knepley 
39796528b96dSMatthew G. Knepley       key.field = f;
39809566063dSJacob Faibussowitsch       PetscCall(PetscDSGetImplicit(prob, f, &fimp));
398192d50984SMatthew G. Knepley       if (isImplicit != fimp) continue;
39829566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(prob, f, &obj));
39839566063dSJacob Faibussowitsch       PetscCall(PetscObjectGetClassId(obj, &id));
398492d50984SMatthew G. Knepley       if (id == PETSCFE_CLASSID) {
398592d50984SMatthew G. Knepley         PetscFE         fe = (PetscFE) obj;
398692d50984SMatthew G. Knepley         PetscFEGeom    *geom = affineGeom ? affineGeom : geoms[f];
398792d50984SMatthew G. Knepley         PetscFEGeom    *chunkGeom = NULL;
398892d50984SMatthew G. Knepley         PetscQuadrature quad = affineQuad ? affineQuad : quads[f];
398992d50984SMatthew G. Knepley         PetscInt        Nq, Nb;
399092d50984SMatthew G. Knepley 
39919566063dSJacob Faibussowitsch         PetscCall(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
39929566063dSJacob Faibussowitsch         PetscCall(PetscQuadratureGetData(quad, NULL, NULL, &Nq, NULL, NULL));
39939566063dSJacob Faibussowitsch         PetscCall(PetscFEGetDimension(fe, &Nb));
399492d50984SMatthew G. Knepley         blockSize = Nb;
399592d50984SMatthew G. Knepley         batchSize = numBlocks * blockSize;
39969566063dSJacob Faibussowitsch         PetscCall(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
399792d50984SMatthew G. Knepley         numChunks = numCells / (numBatches*batchSize);
399892d50984SMatthew G. Knepley         Ne        = numChunks*numBatches*batchSize;
399992d50984SMatthew G. Knepley         Nr        = numCells % (numBatches*batchSize);
400092d50984SMatthew G. Knepley         offset    = numCells - Nr;
400192d50984SMatthew G. Knepley         /* Integrate FE residual to get elemVec (need fields at quadrature points) */
400292d50984SMatthew 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) */
40039566063dSJacob Faibussowitsch         PetscCall(PetscFEGeomGetChunk(geom,0,offset,&chunkGeom));
40049566063dSJacob Faibussowitsch         PetscCall(PetscFEIntegrateResidual(prob, key, Ne, chunkGeom, u, u_t, probAux, a, t, elemVec));
40059566063dSJacob Faibussowitsch         PetscCall(PetscFEGeomGetChunk(geom,offset,numCells,&chunkGeom));
40069566063dSJacob 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]));
40079566063dSJacob Faibussowitsch         PetscCall(PetscFEGeomRestoreChunk(geom,offset,numCells,&chunkGeom));
400892d50984SMatthew G. Knepley       } else if (id == PETSCFV_CLASSID) {
400992d50984SMatthew G. Knepley         PetscFV fv = (PetscFV) obj;
401092d50984SMatthew G. Knepley 
401192d50984SMatthew G. Knepley         Ne = numFaces;
401292d50984SMatthew G. Knepley         /* Riemann solve over faces (need fields at face centroids) */
401392d50984SMatthew G. Knepley         /*   We need to evaluate FE fields at those coordinates */
40149566063dSJacob Faibussowitsch         PetscCall(PetscFVIntegrateRHSFunction(fv, prob, f, Ne, fgeom, vol, uL, uR, fluxL, fluxR));
401598921bdaSJacob Faibussowitsch       } else SETERRQ(PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", f);
401692d50984SMatthew G. Knepley     }
401792d50984SMatthew G. Knepley     /* Loop over domain */
401892d50984SMatthew G. Knepley     if (useFEM) {
401992d50984SMatthew G. Knepley       /* Add elemVec to locX */
402092d50984SMatthew G. Knepley       for (c = cS; c < cE; ++c) {
402192d50984SMatthew G. Knepley         const PetscInt cell = cells ? cells[c] : c;
402292d50984SMatthew G. Knepley         const PetscInt cind = c - cStart;
402392d50984SMatthew G. Knepley 
40249566063dSJacob Faibussowitsch         if (mesh->printFEM > 1) PetscCall(DMPrintCellVector(cell, name, totDim, &elemVec[cind*totDim]));
402592d50984SMatthew G. Knepley         if (ghostLabel) {
402692d50984SMatthew G. Knepley           PetscInt ghostVal;
402792d50984SMatthew G. Knepley 
40289566063dSJacob Faibussowitsch           PetscCall(DMLabelGetValue(ghostLabel,cell,&ghostVal));
402992d50984SMatthew G. Knepley           if (ghostVal > 0) continue;
403092d50984SMatthew G. Knepley         }
40319566063dSJacob Faibussowitsch         PetscCall(DMPlexVecSetClosure(dm, section, locF, cell, &elemVec[cind*totDim], ADD_ALL_VALUES));
403292d50984SMatthew G. Knepley       }
403392d50984SMatthew G. Knepley     }
403492d50984SMatthew G. Knepley     /* Handle time derivative */
403592d50984SMatthew G. Knepley     if (locX_t) {
403692d50984SMatthew G. Knepley       PetscScalar *x_t, *fa;
403792d50984SMatthew G. Knepley 
40389566063dSJacob Faibussowitsch       PetscCall(VecGetArray(locF, &fa));
40399566063dSJacob Faibussowitsch       PetscCall(VecGetArray(locX_t, &x_t));
404092d50984SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
404192d50984SMatthew G. Knepley         PetscFV      fv;
404292d50984SMatthew G. Knepley         PetscObject  obj;
404392d50984SMatthew G. Knepley         PetscClassId id;
404492d50984SMatthew G. Knepley         PetscInt     pdim, d;
404592d50984SMatthew G. Knepley 
40469566063dSJacob Faibussowitsch         PetscCall(PetscDSGetDiscretization(prob, f, &obj));
40479566063dSJacob Faibussowitsch         PetscCall(PetscObjectGetClassId(obj, &id));
404892d50984SMatthew G. Knepley         if (id != PETSCFV_CLASSID) continue;
404992d50984SMatthew G. Knepley         fv   = (PetscFV) obj;
40509566063dSJacob Faibussowitsch         PetscCall(PetscFVGetNumComponents(fv, &pdim));
405192d50984SMatthew G. Knepley         for (c = cS; c < cE; ++c) {
405292d50984SMatthew G. Knepley           const PetscInt cell = cells ? cells[c] : c;
405392d50984SMatthew G. Knepley           PetscScalar   *u_t, *r;
405492d50984SMatthew G. Knepley 
405592d50984SMatthew G. Knepley           if (ghostLabel) {
405692d50984SMatthew G. Knepley             PetscInt ghostVal;
405792d50984SMatthew G. Knepley 
40589566063dSJacob Faibussowitsch             PetscCall(DMLabelGetValue(ghostLabel, cell, &ghostVal));
405992d50984SMatthew G. Knepley             if (ghostVal > 0) continue;
406092d50984SMatthew G. Knepley           }
40619566063dSJacob Faibussowitsch           PetscCall(DMPlexPointLocalFieldRead(dm, cell, f, x_t, &u_t));
40629566063dSJacob Faibussowitsch           PetscCall(DMPlexPointLocalFieldRef(dm, cell, f, fa, &r));
406392d50984SMatthew G. Knepley           for (d = 0; d < pdim; ++d) r[d] += u_t[d];
406492d50984SMatthew G. Knepley         }
406592d50984SMatthew G. Knepley       }
40669566063dSJacob Faibussowitsch       PetscCall(VecRestoreArray(locX_t, &x_t));
40679566063dSJacob Faibussowitsch       PetscCall(VecRestoreArray(locF, &fa));
406892d50984SMatthew G. Knepley     }
406992d50984SMatthew G. Knepley     if (useFEM) {
40709566063dSJacob Faibussowitsch       PetscCall(DMPlexRestoreCellFields(dm, chunkIS, locX, locX_t, locA, &u, &u_t, &a));
40719566063dSJacob Faibussowitsch       PetscCall(DMRestoreWorkArray(dm, numCells*totDim, MPIU_SCALAR, &elemVec));
407292d50984SMatthew G. Knepley     }
407392d50984SMatthew G. Knepley   }
40749566063dSJacob Faibussowitsch   if (useFEM) PetscCall(ISDestroy(&chunkIS));
40759566063dSJacob Faibussowitsch   PetscCall(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
407692d50984SMatthew G. Knepley   /* TODO Could include boundary residual here (see DMPlexComputeResidual_Internal) */
407792d50984SMatthew G. Knepley   if (useFEM) {
407892d50984SMatthew G. Knepley     if (maxDegree <= 1) {
40799566063dSJacob Faibussowitsch       PetscCall(DMSNESRestoreFEGeom(coordField,cellIS,affineQuad,PETSC_FALSE,&affineGeom));
40809566063dSJacob Faibussowitsch       PetscCall(PetscQuadratureDestroy(&affineQuad));
408192d50984SMatthew G. Knepley     } else {
408292d50984SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
40839566063dSJacob Faibussowitsch         PetscCall(DMSNESRestoreFEGeom(coordField,cellIS,quads[f],PETSC_FALSE,&geoms[f]));
40849566063dSJacob Faibussowitsch         PetscCall(PetscQuadratureDestroy(&quads[f]));
408592d50984SMatthew G. Knepley       }
40869566063dSJacob Faibussowitsch       PetscCall(PetscFree2(quads,geoms));
408792d50984SMatthew G. Knepley     }
408892d50984SMatthew G. Knepley   }
40899566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_ResidualFEM,dm,0,0,0));
409092d50984SMatthew G. Knepley   PetscFunctionReturn(0);
409192d50984SMatthew G. Knepley }
409292d50984SMatthew G. Knepley 
4093a1cf66bbSMatthew G. Knepley /*
4094a1cf66bbSMatthew 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
4095a1cf66bbSMatthew G. Knepley 
4096a1cf66bbSMatthew G. Knepley   X   - The local solution vector
4097a5b23f4aSJose E. Roman   X_t - The local solution time derivative vector, or NULL
4098a1cf66bbSMatthew G. Knepley */
4099a1cf66bbSMatthew G. Knepley PetscErrorCode DMPlexComputeJacobian_Patch_Internal(DM dm, PetscSection section, PetscSection globalSection, IS cellIS,
4100a1cf66bbSMatthew G. Knepley                                                     PetscReal t, PetscReal X_tShift, Vec X, Vec X_t, Mat Jac, Mat JacP, void *ctx)
4101a1cf66bbSMatthew G. Knepley {
4102a1cf66bbSMatthew G. Knepley   DM_Plex         *mesh  = (DM_Plex *) dm->data;
4103a1cf66bbSMatthew G. Knepley   const char      *name = "Jacobian", *nameP = "JacobianPre";
4104a1cf66bbSMatthew G. Knepley   DM               dmAux = NULL;
4105a1cf66bbSMatthew G. Knepley   PetscDS          prob,   probAux = NULL;
4106a1cf66bbSMatthew G. Knepley   PetscSection     sectionAux = NULL;
4107a1cf66bbSMatthew G. Knepley   Vec              A;
4108a1cf66bbSMatthew G. Knepley   DMField          coordField;
4109a1cf66bbSMatthew G. Knepley   PetscFEGeom     *cgeomFEM;
4110a1cf66bbSMatthew G. Knepley   PetscQuadrature  qGeom = NULL;
4111a1cf66bbSMatthew G. Knepley   Mat              J = Jac, JP = JacP;
4112a1cf66bbSMatthew G. Knepley   PetscScalar     *work, *u = NULL, *u_t = NULL, *a = NULL, *elemMat = NULL, *elemMatP = NULL, *elemMatD = NULL;
4113e432b41dSStefano Zampini   PetscBool        hasJac, hasPrec, hasDyn, assembleJac, *isFE, hasFV = PETSC_FALSE;
4114a1cf66bbSMatthew G. Knepley   const PetscInt  *cells;
411506ad1575SMatthew G. Knepley   PetscFormKey key;
41169b2fc754SMatthew G. Knepley   PetscInt         Nf, fieldI, fieldJ, maxDegree, numCells, cStart, cEnd, numChunks, chunkSize, chunk, totDim, totDimAux = 0, sz, wsz, off = 0, offCell = 0;
4117a1cf66bbSMatthew G. Knepley 
4118a1cf66bbSMatthew G. Knepley   PetscFunctionBegin;
41199566063dSJacob Faibussowitsch   PetscCall(ISGetLocalSize(cellIS, &numCells));
41209566063dSJacob Faibussowitsch   PetscCall(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
41219566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_JacobianFEM,dm,0,0,0));
41229566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dm, &prob));
41239566063dSJacob Faibussowitsch   PetscCall(DMGetAuxiliaryVec(dm, NULL, 0, 0, &A));
41249a2a23afSMatthew G. Knepley   if (A) {
41259566063dSJacob Faibussowitsch     PetscCall(VecGetDM(A, &dmAux));
41269566063dSJacob Faibussowitsch     PetscCall(DMGetLocalSection(dmAux, &sectionAux));
41279566063dSJacob Faibussowitsch     PetscCall(DMGetDS(dmAux, &probAux));
4128a1cf66bbSMatthew G. Knepley   }
4129a1cf66bbSMatthew G. Knepley   /* Get flags */
41309566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumFields(prob, &Nf));
41319566063dSJacob Faibussowitsch   PetscCall(DMGetWorkArray(dm, Nf, MPIU_BOOL, &isFE));
4132a1cf66bbSMatthew G. Knepley   for (fieldI = 0; fieldI < Nf; ++fieldI) {
4133a1cf66bbSMatthew G. Knepley     PetscObject  disc;
4134a1cf66bbSMatthew G. Knepley     PetscClassId id;
41359566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, fieldI, &disc));
41369566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(disc, &id));
4137a1cf66bbSMatthew G. Knepley     if (id == PETSCFE_CLASSID)      {isFE[fieldI] = PETSC_TRUE;}
4138a1cf66bbSMatthew G. Knepley     else if (id == PETSCFV_CLASSID) {hasFV = PETSC_TRUE; isFE[fieldI] = PETSC_FALSE;}
4139a1cf66bbSMatthew G. Knepley   }
41409566063dSJacob Faibussowitsch   PetscCall(PetscDSHasJacobian(prob, &hasJac));
41419566063dSJacob Faibussowitsch   PetscCall(PetscDSHasJacobianPreconditioner(prob, &hasPrec));
41429566063dSJacob Faibussowitsch   PetscCall(PetscDSHasDynamicJacobian(prob, &hasDyn));
4143a1cf66bbSMatthew G. Knepley   assembleJac = hasJac && hasPrec && (Jac != JacP) ? PETSC_TRUE : PETSC_FALSE;
4144a1cf66bbSMatthew G. Knepley   hasDyn      = hasDyn && (X_tShift != 0.0) ? PETSC_TRUE : PETSC_FALSE;
41459566063dSJacob Faibussowitsch   if (hasFV) PetscCall(MatSetOption(JP, MAT_IGNORE_ZERO_ENTRIES, PETSC_TRUE)); /* No allocated space for FV stuff, so ignore the zero entries */
41469566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(prob, &totDim));
41479566063dSJacob Faibussowitsch   if (probAux) PetscCall(PetscDSGetTotalDimension(probAux, &totDimAux));
4148a1cf66bbSMatthew G. Knepley   /* Compute batch sizes */
4149a1cf66bbSMatthew G. Knepley   if (isFE[0]) {
4150a1cf66bbSMatthew G. Knepley     PetscFE         fe;
4151a1cf66bbSMatthew G. Knepley     PetscQuadrature q;
4152a1cf66bbSMatthew G. Knepley     PetscInt        numQuadPoints, numBatches, batchSize, numBlocks, blockSize, Nb;
4153a1cf66bbSMatthew G. Knepley 
41549566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, 0, (PetscObject *) &fe));
41559566063dSJacob Faibussowitsch     PetscCall(PetscFEGetQuadrature(fe, &q));
41569566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureGetData(q, NULL, NULL, &numQuadPoints, NULL, NULL));
41579566063dSJacob Faibussowitsch     PetscCall(PetscFEGetDimension(fe, &Nb));
41589566063dSJacob Faibussowitsch     PetscCall(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
4159a1cf66bbSMatthew G. Knepley     blockSize = Nb*numQuadPoints;
4160a1cf66bbSMatthew G. Knepley     batchSize = numBlocks  * blockSize;
4161a1cf66bbSMatthew G. Knepley     chunkSize = numBatches * batchSize;
4162a1cf66bbSMatthew G. Knepley     numChunks = numCells / chunkSize + numCells % chunkSize;
41639566063dSJacob Faibussowitsch     PetscCall(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
4164a1cf66bbSMatthew G. Knepley   } else {
4165a1cf66bbSMatthew G. Knepley     chunkSize = numCells;
4166a1cf66bbSMatthew G. Knepley     numChunks = 1;
4167a1cf66bbSMatthew G. Knepley   }
4168a1cf66bbSMatthew G. Knepley   /* Get work space */
4169a1cf66bbSMatthew 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;
41709566063dSJacob Faibussowitsch   PetscCall(DMGetWorkArray(dm, wsz, MPIU_SCALAR, &work));
41719566063dSJacob Faibussowitsch   PetscCall(PetscArrayzero(work, wsz));
4172a1cf66bbSMatthew G. Knepley   off      = 0;
4173a1cf66bbSMatthew G. Knepley   u        = X       ? (sz = chunkSize*totDim,        off += sz, work+off-sz) : NULL;
4174a1cf66bbSMatthew G. Knepley   u_t      = X_t     ? (sz = chunkSize*totDim,        off += sz, work+off-sz) : NULL;
4175a1cf66bbSMatthew G. Knepley   a        = dmAux   ? (sz = chunkSize*totDimAux,     off += sz, work+off-sz) : NULL;
4176a1cf66bbSMatthew G. Knepley   elemMat  = hasJac  ? (sz = chunkSize*totDim*totDim, off += sz, work+off-sz) : NULL;
4177a1cf66bbSMatthew G. Knepley   elemMatP = hasPrec ? (sz = chunkSize*totDim*totDim, off += sz, work+off-sz) : NULL;
4178a1cf66bbSMatthew G. Knepley   elemMatD = hasDyn  ? (sz = chunkSize*totDim*totDim, off += sz, work+off-sz) : NULL;
41795f80ce2aSJacob Faibussowitsch   PetscCheck(off == wsz,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Error is workspace size %D should be %D", off, wsz);
4180a1cf66bbSMatthew G. Knepley   /* Setup geometry */
41819566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateField(dm, &coordField));
41829566063dSJacob Faibussowitsch   PetscCall(DMFieldGetDegree(coordField, cellIS, NULL, &maxDegree));
41839566063dSJacob Faibussowitsch   if (maxDegree <= 1) PetscCall(DMFieldCreateDefaultQuadrature(coordField, cellIS, &qGeom));
4184a1cf66bbSMatthew G. Knepley   if (!qGeom) {
4185a1cf66bbSMatthew G. Knepley     PetscFE fe;
4186a1cf66bbSMatthew G. Knepley 
41879566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, 0, (PetscObject *) &fe));
41889566063dSJacob Faibussowitsch     PetscCall(PetscFEGetQuadrature(fe, &qGeom));
41899566063dSJacob Faibussowitsch     PetscCall(PetscObjectReference((PetscObject) qGeom));
4190a1cf66bbSMatthew G. Knepley   }
41919566063dSJacob Faibussowitsch   PetscCall(DMSNESGetFEGeom(coordField, cellIS, qGeom, PETSC_FALSE, &cgeomFEM));
4192a1cf66bbSMatthew G. Knepley   /* Compute volume integrals */
41939566063dSJacob Faibussowitsch   if (assembleJac) PetscCall(MatZeroEntries(J));
41949566063dSJacob Faibussowitsch   PetscCall(MatZeroEntries(JP));
41956528b96dSMatthew G. Knepley   key.label = NULL;
41966528b96dSMatthew G. Knepley   key.value = 0;
419706ad1575SMatthew G. Knepley   key.part  = 0;
4198a1cf66bbSMatthew G. Knepley   for (chunk = 0; chunk < numChunks; ++chunk, offCell += chunkSize) {
4199a1cf66bbSMatthew G. Knepley     const PetscInt   Ncell = PetscMin(chunkSize, numCells - offCell);
4200a1cf66bbSMatthew G. Knepley     PetscInt         c;
4201a1cf66bbSMatthew G. Knepley 
4202a1cf66bbSMatthew G. Knepley     /* Extract values */
4203a1cf66bbSMatthew G. Knepley     for (c = 0; c < Ncell; ++c) {
4204a1cf66bbSMatthew G. Knepley       const PetscInt cell = cells ? cells[c+offCell] : c+offCell;
4205a1cf66bbSMatthew G. Knepley       PetscScalar   *x = NULL,  *x_t = NULL;
4206a1cf66bbSMatthew G. Knepley       PetscInt       i;
4207a1cf66bbSMatthew G. Knepley 
4208a1cf66bbSMatthew G. Knepley       if (X) {
42099566063dSJacob Faibussowitsch         PetscCall(DMPlexVecGetClosure(dm, section, X, cell, NULL, &x));
4210a1cf66bbSMatthew G. Knepley         for (i = 0; i < totDim; ++i) u[c*totDim+i] = x[i];
42119566063dSJacob Faibussowitsch         PetscCall(DMPlexVecRestoreClosure(dm, section, X, cell, NULL, &x));
4212a1cf66bbSMatthew G. Knepley       }
4213a1cf66bbSMatthew G. Knepley       if (X_t) {
42149566063dSJacob Faibussowitsch         PetscCall(DMPlexVecGetClosure(dm, section, X_t, cell, NULL, &x_t));
4215a1cf66bbSMatthew G. Knepley         for (i = 0; i < totDim; ++i) u_t[c*totDim+i] = x_t[i];
42169566063dSJacob Faibussowitsch         PetscCall(DMPlexVecRestoreClosure(dm, section, X_t, cell, NULL, &x_t));
4217a1cf66bbSMatthew G. Knepley       }
4218a1cf66bbSMatthew G. Knepley       if (dmAux) {
42199566063dSJacob Faibussowitsch         PetscCall(DMPlexVecGetClosure(dmAux, sectionAux, A, cell, NULL, &x));
4220a1cf66bbSMatthew G. Knepley         for (i = 0; i < totDimAux; ++i) a[c*totDimAux+i] = x[i];
42219566063dSJacob Faibussowitsch         PetscCall(DMPlexVecRestoreClosure(dmAux, sectionAux, A, cell, NULL, &x));
4222a1cf66bbSMatthew G. Knepley       }
4223a1cf66bbSMatthew G. Knepley     }
4224a1cf66bbSMatthew G. Knepley     for (fieldI = 0; fieldI < Nf; ++fieldI) {
4225a1cf66bbSMatthew G. Knepley       PetscFE fe;
42269566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(prob, fieldI, (PetscObject *) &fe));
4227a1cf66bbSMatthew G. Knepley       for (fieldJ = 0; fieldJ < Nf; ++fieldJ) {
42286528b96dSMatthew G. Knepley         key.field = fieldI*Nf + fieldJ;
42299566063dSJacob Faibussowitsch         if (hasJac)  PetscCall(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN,     key, Ncell, cgeomFEM, u, u_t, probAux, a, t, X_tShift, elemMat));
42309566063dSJacob Faibussowitsch         if (hasPrec) PetscCall(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN_PRE, key, Ncell, cgeomFEM, u, u_t, probAux, a, t, X_tShift, elemMatP));
42319566063dSJacob Faibussowitsch         if (hasDyn)  PetscCall(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN_DYN, key, Ncell, cgeomFEM, u, u_t, probAux, a, t, X_tShift, elemMatD));
4232a1cf66bbSMatthew G. Knepley       }
4233a1cf66bbSMatthew G. Knepley       /* For finite volume, add the identity */
4234a1cf66bbSMatthew G. Knepley       if (!isFE[fieldI]) {
4235a1cf66bbSMatthew G. Knepley         PetscFV  fv;
4236a1cf66bbSMatthew G. Knepley         PetscInt eOffset = 0, Nc, fc, foff;
4237a1cf66bbSMatthew G. Knepley 
42389566063dSJacob Faibussowitsch         PetscCall(PetscDSGetFieldOffset(prob, fieldI, &foff));
42399566063dSJacob Faibussowitsch         PetscCall(PetscDSGetDiscretization(prob, fieldI, (PetscObject *) &fv));
42409566063dSJacob Faibussowitsch         PetscCall(PetscFVGetNumComponents(fv, &Nc));
4241a1cf66bbSMatthew G. Knepley         for (c = 0; c < chunkSize; ++c, eOffset += totDim*totDim) {
4242a1cf66bbSMatthew G. Knepley           for (fc = 0; fc < Nc; ++fc) {
4243a1cf66bbSMatthew G. Knepley             const PetscInt i = foff + fc;
4244a1cf66bbSMatthew G. Knepley             if (hasJac)  {elemMat [eOffset+i*totDim+i] = 1.0;}
4245a1cf66bbSMatthew G. Knepley             if (hasPrec) {elemMatP[eOffset+i*totDim+i] = 1.0;}
4246a1cf66bbSMatthew G. Knepley           }
4247a1cf66bbSMatthew G. Knepley         }
4248a1cf66bbSMatthew G. Knepley       }
4249a1cf66bbSMatthew G. Knepley     }
4250a1cf66bbSMatthew G. Knepley     /*   Add contribution from X_t */
4251a1cf66bbSMatthew G. Knepley     if (hasDyn) {for (c = 0; c < chunkSize*totDim*totDim; ++c) elemMat[c] += X_tShift*elemMatD[c];}
4252a1cf66bbSMatthew G. Knepley     /* Insert values into matrix */
4253a1cf66bbSMatthew G. Knepley     for (c = 0; c < Ncell; ++c) {
4254a1cf66bbSMatthew G. Knepley       const PetscInt cell = cells ? cells[c+offCell] : c+offCell;
4255a1cf66bbSMatthew G. Knepley       if (mesh->printFEM > 1) {
42569566063dSJacob Faibussowitsch         if (hasJac)  PetscCall(DMPrintCellMatrix(cell, name,  totDim, totDim, &elemMat[(c-cStart)*totDim*totDim]));
42579566063dSJacob Faibussowitsch         if (hasPrec) PetscCall(DMPrintCellMatrix(cell, nameP, totDim, totDim, &elemMatP[(c-cStart)*totDim*totDim]));
4258a1cf66bbSMatthew G. Knepley       }
42599566063dSJacob Faibussowitsch       if (assembleJac) PetscCall(DMPlexMatSetClosure(dm, section, globalSection, Jac, cell, &elemMat[(c-cStart)*totDim*totDim], ADD_VALUES));
42609566063dSJacob Faibussowitsch       PetscCall(DMPlexMatSetClosure(dm, section, globalSection, JP, cell, &elemMat[(c-cStart)*totDim*totDim], ADD_VALUES));
4261a1cf66bbSMatthew G. Knepley     }
4262a1cf66bbSMatthew G. Knepley   }
4263a1cf66bbSMatthew G. Knepley   /* Cleanup */
42649566063dSJacob Faibussowitsch   PetscCall(DMSNESRestoreFEGeom(coordField, cellIS, qGeom, PETSC_FALSE, &cgeomFEM));
42659566063dSJacob Faibussowitsch   PetscCall(PetscQuadratureDestroy(&qGeom));
42669566063dSJacob Faibussowitsch   if (hasFV) PetscCall(MatSetOption(JacP, MAT_IGNORE_ZERO_ENTRIES, PETSC_FALSE));
42679566063dSJacob Faibussowitsch   PetscCall(DMRestoreWorkArray(dm, Nf, MPIU_BOOL, &isFE));
42689566063dSJacob 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));
4269a1cf66bbSMatthew G. Knepley   /* Compute boundary integrals */
42709566063dSJacob Faibussowitsch   /* PetscCall(DMPlexComputeBdJacobian_Internal(dm, X, X_t, t, X_tShift, Jac, JacP, ctx)); */
4271a1cf66bbSMatthew G. Knepley   /* Assemble matrix */
42729566063dSJacob Faibussowitsch   if (assembleJac) {PetscCall(MatAssemblyBegin(Jac, MAT_FINAL_ASSEMBLY));PetscCall(MatAssemblyEnd(Jac, MAT_FINAL_ASSEMBLY));}
42739566063dSJacob Faibussowitsch   PetscCall(MatAssemblyBegin(JacP, MAT_FINAL_ASSEMBLY));PetscCall(MatAssemblyEnd(JacP, MAT_FINAL_ASSEMBLY));
42749566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_JacobianFEM,dm,0,0,0));
4275a1cf66bbSMatthew G. Knepley   PetscFunctionReturn(0);
4276a1cf66bbSMatthew G. Knepley }
42773e9753d6SMatthew G. Knepley 
42783e9753d6SMatthew G. Knepley /******** FEM Assembly Function ********/
42793e9753d6SMatthew G. Knepley 
42803e9753d6SMatthew G. Knepley static PetscErrorCode DMConvertPlex_Internal(DM dm, DM *plex, PetscBool copy)
42813e9753d6SMatthew G. Knepley {
42823e9753d6SMatthew G. Knepley   PetscBool      isPlex;
42833e9753d6SMatthew G. Knepley 
42843e9753d6SMatthew G. Knepley   PetscFunctionBegin;
42859566063dSJacob Faibussowitsch   PetscCall(PetscObjectTypeCompare((PetscObject) dm, DMPLEX, &isPlex));
42863e9753d6SMatthew G. Knepley   if (isPlex) {
42873e9753d6SMatthew G. Knepley     *plex = dm;
42889566063dSJacob Faibussowitsch     PetscCall(PetscObjectReference((PetscObject) dm));
42893e9753d6SMatthew G. Knepley   } else {
42909566063dSJacob Faibussowitsch     PetscCall(PetscObjectQuery((PetscObject) dm, "dm_plex", (PetscObject *) plex));
42913e9753d6SMatthew G. Knepley     if (!*plex) {
42929566063dSJacob Faibussowitsch       PetscCall(DMConvert(dm,DMPLEX,plex));
42939566063dSJacob Faibussowitsch       PetscCall(PetscObjectCompose((PetscObject) dm, "dm_plex", (PetscObject) *plex));
42943e9753d6SMatthew G. Knepley       if (copy) {
42959566063dSJacob Faibussowitsch         PetscCall(DMCopyAuxiliaryVec(dm, *plex));
42963e9753d6SMatthew G. Knepley       }
42973e9753d6SMatthew G. Knepley     } else {
42989566063dSJacob Faibussowitsch       PetscCall(PetscObjectReference((PetscObject) *plex));
42993e9753d6SMatthew G. Knepley     }
43003e9753d6SMatthew G. Knepley   }
43013e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
43023e9753d6SMatthew G. Knepley }
43033e9753d6SMatthew G. Knepley 
43043e9753d6SMatthew G. Knepley /*@
43053e9753d6SMatthew G. Knepley   DMPlexGetGeometryFVM - Return precomputed geometric data
43063e9753d6SMatthew G. Knepley 
43073e9753d6SMatthew G. Knepley   Collective on DM
43083e9753d6SMatthew G. Knepley 
43093e9753d6SMatthew G. Knepley   Input Parameter:
43103e9753d6SMatthew G. Knepley . dm - The DM
43113e9753d6SMatthew G. Knepley 
43123e9753d6SMatthew G. Knepley   Output Parameters:
43133e9753d6SMatthew G. Knepley + facegeom - The values precomputed from face geometry
43143e9753d6SMatthew G. Knepley . cellgeom - The values precomputed from cell geometry
43153e9753d6SMatthew G. Knepley - minRadius - The minimum radius over the mesh of an inscribed sphere in a cell
43163e9753d6SMatthew G. Knepley 
43173e9753d6SMatthew G. Knepley   Level: developer
43183e9753d6SMatthew G. Knepley 
4319446c23c1SPierre Jolivet .seealso: DMTSSetRHSFunctionLocal()
43203e9753d6SMatthew G. Knepley @*/
43213e9753d6SMatthew G. Knepley PetscErrorCode DMPlexGetGeometryFVM(DM dm, Vec *facegeom, Vec *cellgeom, PetscReal *minRadius)
43223e9753d6SMatthew G. Knepley {
43233e9753d6SMatthew G. Knepley   DM             plex;
43243e9753d6SMatthew G. Knepley 
43253e9753d6SMatthew G. Knepley   PetscFunctionBegin;
43263e9753d6SMatthew G. Knepley   PetscValidHeaderSpecific(dm,DM_CLASSID,1);
43279566063dSJacob Faibussowitsch   PetscCall(DMConvertPlex_Internal(dm,&plex,PETSC_TRUE));
43289566063dSJacob Faibussowitsch   PetscCall(DMPlexGetDataFVM(plex, NULL, cellgeom, facegeom, NULL));
43299566063dSJacob Faibussowitsch   if (minRadius) PetscCall(DMPlexGetMinRadius(plex, minRadius));
43309566063dSJacob Faibussowitsch   PetscCall(DMDestroy(&plex));
43313e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
43323e9753d6SMatthew G. Knepley }
43333e9753d6SMatthew G. Knepley 
43343e9753d6SMatthew G. Knepley /*@
43353e9753d6SMatthew G. Knepley   DMPlexGetGradientDM - Return gradient data layout
43363e9753d6SMatthew G. Knepley 
43373e9753d6SMatthew G. Knepley   Collective on DM
43383e9753d6SMatthew G. Knepley 
43393e9753d6SMatthew G. Knepley   Input Parameters:
43403e9753d6SMatthew G. Knepley + dm - The DM
43413e9753d6SMatthew G. Knepley - fv - The PetscFV
43423e9753d6SMatthew G. Knepley 
43433e9753d6SMatthew G. Knepley   Output Parameter:
43443e9753d6SMatthew G. Knepley . dmGrad - The layout for gradient values
43453e9753d6SMatthew G. Knepley 
43463e9753d6SMatthew G. Knepley   Level: developer
43473e9753d6SMatthew G. Knepley 
4348446c23c1SPierre Jolivet .seealso: DMPlexGetGeometryFVM()
43493e9753d6SMatthew G. Knepley @*/
43503e9753d6SMatthew G. Knepley PetscErrorCode DMPlexGetGradientDM(DM dm, PetscFV fv, DM *dmGrad)
43513e9753d6SMatthew G. Knepley {
43523e9753d6SMatthew G. Knepley   DM             plex;
43533e9753d6SMatthew G. Knepley   PetscBool      computeGradients;
43543e9753d6SMatthew G. Knepley 
43553e9753d6SMatthew G. Knepley   PetscFunctionBegin;
43563e9753d6SMatthew G. Knepley   PetscValidHeaderSpecific(dm,DM_CLASSID,1);
43573e9753d6SMatthew G. Knepley   PetscValidHeaderSpecific(fv,PETSCFV_CLASSID,2);
43583e9753d6SMatthew G. Knepley   PetscValidPointer(dmGrad,3);
43599566063dSJacob Faibussowitsch   PetscCall(PetscFVGetComputeGradients(fv, &computeGradients));
43603e9753d6SMatthew G. Knepley   if (!computeGradients) {*dmGrad = NULL; PetscFunctionReturn(0);}
43619566063dSJacob Faibussowitsch   PetscCall(DMConvertPlex_Internal(dm,&plex,PETSC_TRUE));
43629566063dSJacob Faibussowitsch   PetscCall(DMPlexGetDataFVM(plex, fv, NULL, NULL, dmGrad));
43639566063dSJacob Faibussowitsch   PetscCall(DMDestroy(&plex));
43643e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
43653e9753d6SMatthew G. Knepley }
43663e9753d6SMatthew G. Knepley 
43670c290148SMatthew 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)
43683e9753d6SMatthew G. Knepley {
43693e9753d6SMatthew G. Knepley   DM_Plex         *mesh = (DM_Plex *) dm->data;
43703e9753d6SMatthew G. Knepley   DM               plex = NULL, plexA = NULL;
43713e9753d6SMatthew G. Knepley   DMEnclosureType  encAux;
43723e9753d6SMatthew G. Knepley   PetscDS          prob, probAux = NULL;
43733e9753d6SMatthew G. Knepley   PetscSection     section, sectionAux = NULL;
43743e9753d6SMatthew G. Knepley   Vec              locA = NULL;
43753e9753d6SMatthew G. Knepley   PetscScalar     *u = NULL, *u_t = NULL, *a = NULL, *elemVec = NULL;
43763e9753d6SMatthew G. Knepley   PetscInt         totDim, totDimAux = 0;
43773e9753d6SMatthew G. Knepley 
43783e9753d6SMatthew G. Knepley   PetscFunctionBegin;
43799566063dSJacob Faibussowitsch   PetscCall(DMConvert(dm, DMPLEX, &plex));
43809566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
43819566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dm, &prob));
43829566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(prob, &totDim));
43839566063dSJacob Faibussowitsch   PetscCall(DMGetAuxiliaryVec(dm, key.label, key.value, key.part, &locA));
43843e9753d6SMatthew G. Knepley   if (locA) {
43853e9753d6SMatthew G. Knepley     DM dmAux;
43863e9753d6SMatthew G. Knepley 
43879566063dSJacob Faibussowitsch     PetscCall(VecGetDM(locA, &dmAux));
43889566063dSJacob Faibussowitsch     PetscCall(DMGetEnclosureRelation(dmAux, dm, &encAux));
43899566063dSJacob Faibussowitsch     PetscCall(DMConvert(dmAux, DMPLEX, &plexA));
43909566063dSJacob Faibussowitsch     PetscCall(DMGetDS(plexA, &probAux));
43919566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalDimension(probAux, &totDimAux));
43929566063dSJacob Faibussowitsch     PetscCall(DMGetLocalSection(plexA, &sectionAux));
43933e9753d6SMatthew G. Knepley   }
43940c290148SMatthew G. Knepley   {
43953e9753d6SMatthew G. Knepley     PetscFEGeom     *fgeom;
43963e9753d6SMatthew G. Knepley     PetscInt         maxDegree;
43973e9753d6SMatthew G. Knepley     PetscQuadrature  qGeom = NULL;
43983e9753d6SMatthew G. Knepley     IS               pointIS;
43993e9753d6SMatthew G. Knepley     const PetscInt  *points;
44003e9753d6SMatthew G. Knepley     PetscInt         numFaces, face, Nq;
44013e9753d6SMatthew G. Knepley 
44029566063dSJacob Faibussowitsch     PetscCall(DMLabelGetStratumIS(key.label, key.value, &pointIS));
44030c290148SMatthew G. Knepley     if (!pointIS) goto end; /* No points with that id on this process */
44043e9753d6SMatthew G. Knepley     {
44053e9753d6SMatthew G. Knepley       IS isectIS;
44063e9753d6SMatthew G. Knepley 
44073e9753d6SMatthew G. Knepley       /* TODO: Special cases of ISIntersect where it is quick to check a priori if one is a superset of the other */
44089566063dSJacob Faibussowitsch       PetscCall(ISIntersect_Caching_Internal(facetIS,pointIS,&isectIS));
44099566063dSJacob Faibussowitsch       PetscCall(ISDestroy(&pointIS));
44103e9753d6SMatthew G. Knepley       pointIS = isectIS;
44113e9753d6SMatthew G. Knepley     }
44129566063dSJacob Faibussowitsch     PetscCall(ISGetLocalSize(pointIS,&numFaces));
44139566063dSJacob Faibussowitsch     PetscCall(ISGetIndices(pointIS,&points));
44149566063dSJacob Faibussowitsch     PetscCall(PetscMalloc4(numFaces*totDim, &u, locX_t ? numFaces*totDim : 0, &u_t, numFaces*totDim, &elemVec, locA ? numFaces*totDimAux : 0, &a));
44159566063dSJacob Faibussowitsch     PetscCall(DMFieldGetDegree(coordField,pointIS,NULL,&maxDegree));
44163e9753d6SMatthew G. Knepley     if (maxDegree <= 1) {
44179566063dSJacob Faibussowitsch       PetscCall(DMFieldCreateDefaultQuadrature(coordField,pointIS,&qGeom));
44183e9753d6SMatthew G. Knepley     }
44193e9753d6SMatthew G. Knepley     if (!qGeom) {
44203e9753d6SMatthew G. Knepley       PetscFE fe;
44213e9753d6SMatthew G. Knepley 
44229566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(prob, key.field, (PetscObject *) &fe));
44239566063dSJacob Faibussowitsch       PetscCall(PetscFEGetFaceQuadrature(fe, &qGeom));
44249566063dSJacob Faibussowitsch       PetscCall(PetscObjectReference((PetscObject)qGeom));
44253e9753d6SMatthew G. Knepley     }
44269566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureGetData(qGeom, NULL, NULL, &Nq, NULL, NULL));
44279566063dSJacob Faibussowitsch     PetscCall(DMSNESGetFEGeom(coordField,pointIS,qGeom,PETSC_TRUE,&fgeom));
44283e9753d6SMatthew G. Knepley     for (face = 0; face < numFaces; ++face) {
4429f15274beSMatthew Knepley       const PetscInt point = points[face], *support;
44303e9753d6SMatthew G. Knepley       PetscScalar   *x     = NULL;
4431f15274beSMatthew Knepley       PetscInt       i;
44323e9753d6SMatthew G. Knepley 
44339566063dSJacob Faibussowitsch       PetscCall(DMPlexGetSupport(dm, point, &support));
44349566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(plex, section, locX, support[0], NULL, &x));
44353e9753d6SMatthew G. Knepley       for (i = 0; i < totDim; ++i) u[face*totDim+i] = x[i];
44369566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(plex, section, locX, support[0], NULL, &x));
44373e9753d6SMatthew G. Knepley       if (locX_t) {
44389566063dSJacob Faibussowitsch         PetscCall(DMPlexVecGetClosure(plex, section, locX_t, support[0], NULL, &x));
44393e9753d6SMatthew G. Knepley         for (i = 0; i < totDim; ++i) u_t[face*totDim+i] = x[i];
44409566063dSJacob Faibussowitsch         PetscCall(DMPlexVecRestoreClosure(plex, section, locX_t, support[0], NULL, &x));
44413e9753d6SMatthew G. Knepley       }
44423e9753d6SMatthew G. Knepley       if (locA) {
44433e9753d6SMatthew G. Knepley         PetscInt subp;
44443e9753d6SMatthew G. Knepley 
44459566063dSJacob Faibussowitsch         PetscCall(DMGetEnclosurePoint(plexA, dm, encAux, support[0], &subp));
44469566063dSJacob Faibussowitsch         PetscCall(DMPlexVecGetClosure(plexA, sectionAux, locA, subp, NULL, &x));
44473e9753d6SMatthew G. Knepley         for (i = 0; i < totDimAux; ++i) a[face*totDimAux+i] = x[i];
44489566063dSJacob Faibussowitsch         PetscCall(DMPlexVecRestoreClosure(plexA, sectionAux, locA, subp, NULL, &x));
44493e9753d6SMatthew G. Knepley       }
44503e9753d6SMatthew G. Knepley     }
44519566063dSJacob Faibussowitsch     PetscCall(PetscArrayzero(elemVec, numFaces*totDim));
44523e9753d6SMatthew G. Knepley     {
44533e9753d6SMatthew G. Knepley       PetscFE         fe;
44543e9753d6SMatthew G. Knepley       PetscInt        Nb;
44553e9753d6SMatthew G. Knepley       PetscFEGeom     *chunkGeom = NULL;
44563e9753d6SMatthew G. Knepley       /* Conforming batches */
44573e9753d6SMatthew G. Knepley       PetscInt        numChunks, numBatches, numBlocks, Ne, blockSize, batchSize;
44583e9753d6SMatthew G. Knepley       /* Remainder */
44593e9753d6SMatthew G. Knepley       PetscInt        Nr, offset;
44603e9753d6SMatthew G. Knepley 
44619566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(prob, key.field, (PetscObject *) &fe));
44629566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDimension(fe, &Nb));
44639566063dSJacob Faibussowitsch       PetscCall(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
44643e9753d6SMatthew G. Knepley       /* TODO: documentation is unclear about what is going on with these numbers: how should Nb / Nq factor in ? */
44653e9753d6SMatthew G. Knepley       blockSize = Nb;
44663e9753d6SMatthew G. Knepley       batchSize = numBlocks * blockSize;
44679566063dSJacob Faibussowitsch       PetscCall(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
44683e9753d6SMatthew G. Knepley       numChunks = numFaces / (numBatches*batchSize);
44693e9753d6SMatthew G. Knepley       Ne        = numChunks*numBatches*batchSize;
44703e9753d6SMatthew G. Knepley       Nr        = numFaces % (numBatches*batchSize);
44713e9753d6SMatthew G. Knepley       offset    = numFaces - Nr;
44729566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomGetChunk(fgeom,0,offset,&chunkGeom));
44739566063dSJacob Faibussowitsch       PetscCall(PetscFEIntegrateBdResidual(prob, wf, key, Ne, chunkGeom, u, u_t, probAux, a, t, elemVec));
44749566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomRestoreChunk(fgeom, 0, offset, &chunkGeom));
44759566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomGetChunk(fgeom,offset,numFaces,&chunkGeom));
44769566063dSJacob 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]));
44779566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomRestoreChunk(fgeom,offset,numFaces,&chunkGeom));
44783e9753d6SMatthew G. Knepley     }
44793e9753d6SMatthew G. Knepley     for (face = 0; face < numFaces; ++face) {
44803e9753d6SMatthew G. Knepley       const PetscInt point = points[face], *support;
44813e9753d6SMatthew G. Knepley 
44829566063dSJacob Faibussowitsch       if (mesh->printFEM > 1) PetscCall(DMPrintCellVector(point, "BdResidual", totDim, &elemVec[face*totDim]));
44839566063dSJacob Faibussowitsch       PetscCall(DMPlexGetSupport(plex, point, &support));
44849566063dSJacob Faibussowitsch       PetscCall(DMPlexVecSetClosure(plex, NULL, locF, support[0], &elemVec[face*totDim], ADD_ALL_VALUES));
44853e9753d6SMatthew G. Knepley     }
44869566063dSJacob Faibussowitsch     PetscCall(DMSNESRestoreFEGeom(coordField,pointIS,qGeom,PETSC_TRUE,&fgeom));
44879566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureDestroy(&qGeom));
44889566063dSJacob Faibussowitsch     PetscCall(ISRestoreIndices(pointIS, &points));
44899566063dSJacob Faibussowitsch     PetscCall(ISDestroy(&pointIS));
44909566063dSJacob Faibussowitsch     PetscCall(PetscFree4(u, u_t, elemVec, a));
44913e9753d6SMatthew G. Knepley   }
44920c290148SMatthew G. Knepley   end:
44939566063dSJacob Faibussowitsch   PetscCall(DMDestroy(&plex));
44949566063dSJacob Faibussowitsch   PetscCall(DMDestroy(&plexA));
44953e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
44963e9753d6SMatthew G. Knepley }
44973e9753d6SMatthew G. Knepley 
44980c290148SMatthew G. Knepley PetscErrorCode DMPlexComputeBdResidualSingle(DM dm, PetscReal t, PetscWeakForm wf, PetscFormKey key, Vec locX, Vec locX_t, Vec locF)
44993e9753d6SMatthew G. Knepley {
45003e9753d6SMatthew G. Knepley   DMField        coordField;
45013e9753d6SMatthew G. Knepley   DMLabel        depthLabel;
45023e9753d6SMatthew G. Knepley   IS             facetIS;
45033e9753d6SMatthew G. Knepley   PetscInt       dim;
45043e9753d6SMatthew G. Knepley 
45053e9753d6SMatthew G. Knepley   PetscFunctionBegin;
45069566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
45079566063dSJacob Faibussowitsch   PetscCall(DMPlexGetDepthLabel(dm, &depthLabel));
45089566063dSJacob Faibussowitsch   PetscCall(DMLabelGetStratumIS(depthLabel, dim-1, &facetIS));
45099566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateField(dm, &coordField));
45109566063dSJacob Faibussowitsch   PetscCall(DMPlexComputeBdResidual_Single_Internal(dm, t, wf, key, locX, locX_t, locF, coordField, facetIS));
45119566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&facetIS));
45123e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
45133e9753d6SMatthew G. Knepley }
45143e9753d6SMatthew G. Knepley 
45153e9753d6SMatthew G. Knepley PetscErrorCode DMPlexComputeBdResidual_Internal(DM dm, Vec locX, Vec locX_t, PetscReal t, Vec locF, void *user)
45163e9753d6SMatthew G. Knepley {
45173e9753d6SMatthew G. Knepley   PetscDS        prob;
45183e9753d6SMatthew G. Knepley   PetscInt       numBd, bd;
45193e9753d6SMatthew G. Knepley   DMField        coordField = NULL;
45203e9753d6SMatthew G. Knepley   IS             facetIS    = NULL;
45213e9753d6SMatthew G. Knepley   DMLabel        depthLabel;
45223e9753d6SMatthew G. Knepley   PetscInt       dim;
45233e9753d6SMatthew G. Knepley 
45243e9753d6SMatthew G. Knepley   PetscFunctionBegin;
45259566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dm, &prob));
45269566063dSJacob Faibussowitsch   PetscCall(DMPlexGetDepthLabel(dm, &depthLabel));
45279566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
45289566063dSJacob Faibussowitsch   PetscCall(DMLabelGetStratumIS(depthLabel,dim - 1,&facetIS));
45299566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumBoundary(prob, &numBd));
45303e9753d6SMatthew G. Knepley   for (bd = 0; bd < numBd; ++bd) {
453145480ffeSMatthew G. Knepley     PetscWeakForm           wf;
45323e9753d6SMatthew G. Knepley     DMBoundaryConditionType type;
45333e9753d6SMatthew G. Knepley     DMLabel                 label;
45343e9753d6SMatthew G. Knepley     const PetscInt         *values;
45350c290148SMatthew G. Knepley     PetscInt                field, numValues, v;
45363e9753d6SMatthew G. Knepley     PetscObject             obj;
45373e9753d6SMatthew G. Knepley     PetscClassId            id;
45380c290148SMatthew G. Knepley     PetscFormKey            key;
45393e9753d6SMatthew G. Knepley 
45409566063dSJacob Faibussowitsch     PetscCall(PetscDSGetBoundary(prob, bd, &wf, &type, NULL, &label, &numValues, &values, &field, NULL, NULL, NULL, NULL, NULL));
45419566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, field, &obj));
45429566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
45433e9753d6SMatthew G. Knepley     if ((id != PETSCFE_CLASSID) || (type & DM_BC_ESSENTIAL)) continue;
45443e9753d6SMatthew G. Knepley     if (!facetIS) {
45453e9753d6SMatthew G. Knepley       DMLabel  depthLabel;
45463e9753d6SMatthew G. Knepley       PetscInt dim;
45473e9753d6SMatthew G. Knepley 
45489566063dSJacob Faibussowitsch       PetscCall(DMPlexGetDepthLabel(dm, &depthLabel));
45499566063dSJacob Faibussowitsch       PetscCall(DMGetDimension(dm, &dim));
45509566063dSJacob Faibussowitsch       PetscCall(DMLabelGetStratumIS(depthLabel, dim - 1, &facetIS));
45513e9753d6SMatthew G. Knepley     }
45529566063dSJacob Faibussowitsch     PetscCall(DMGetCoordinateField(dm, &coordField));
45530c290148SMatthew G. Knepley     for (v = 0; v < numValues; ++v) {
45540c290148SMatthew G. Knepley       key.label = label;
45550c290148SMatthew G. Knepley       key.value = values[v];
45560c290148SMatthew G. Knepley       key.field = field;
45570c290148SMatthew G. Knepley       key.part  = 0;
45589566063dSJacob Faibussowitsch       PetscCall(DMPlexComputeBdResidual_Single_Internal(dm, t, wf, key, locX, locX_t, locF, coordField, facetIS));
45590c290148SMatthew G. Knepley     }
45603e9753d6SMatthew G. Knepley   }
45619566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&facetIS));
45623e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
45633e9753d6SMatthew G. Knepley }
45643e9753d6SMatthew G. Knepley 
456506ad1575SMatthew G. Knepley PetscErrorCode DMPlexComputeResidual_Internal(DM dm, PetscFormKey key, IS cellIS, PetscReal time, Vec locX, Vec locX_t, PetscReal t, Vec locF, void *user)
45663e9753d6SMatthew G. Knepley {
45673e9753d6SMatthew G. Knepley   DM_Plex         *mesh       = (DM_Plex *) dm->data;
45683e9753d6SMatthew G. Knepley   const char      *name       = "Residual";
45693e9753d6SMatthew G. Knepley   DM               dmAux      = NULL;
45703e9753d6SMatthew G. Knepley   DM               dmGrad     = NULL;
45713e9753d6SMatthew G. Knepley   DMLabel          ghostLabel = NULL;
45726528b96dSMatthew G. Knepley   PetscDS          ds         = NULL;
45736528b96dSMatthew G. Knepley   PetscDS          dsAux      = NULL;
45743e9753d6SMatthew G. Knepley   PetscSection     section    = NULL;
45753e9753d6SMatthew G. Knepley   PetscBool        useFEM     = PETSC_FALSE;
45763e9753d6SMatthew G. Knepley   PetscBool        useFVM     = PETSC_FALSE;
45773e9753d6SMatthew G. Knepley   PetscBool        isImplicit = (locX_t || time == PETSC_MIN_REAL) ? PETSC_TRUE : PETSC_FALSE;
45783e9753d6SMatthew G. Knepley   PetscFV          fvm        = NULL;
45793e9753d6SMatthew G. Knepley   PetscFVCellGeom *cgeomFVM   = NULL;
45803e9753d6SMatthew G. Knepley   PetscFVFaceGeom *fgeomFVM   = NULL;
45813e9753d6SMatthew G. Knepley   DMField          coordField = NULL;
45823e9753d6SMatthew G. Knepley   Vec              locA, cellGeometryFVM = NULL, faceGeometryFVM = NULL, grad, locGrad = NULL;
45833e9753d6SMatthew G. Knepley   PetscScalar     *u = NULL, *u_t, *a, *uL, *uR;
45843e9753d6SMatthew G. Knepley   IS               chunkIS;
45853e9753d6SMatthew G. Knepley   const PetscInt  *cells;
45863e9753d6SMatthew G. Knepley   PetscInt         cStart, cEnd, numCells;
45873e9753d6SMatthew G. Knepley   PetscInt         Nf, f, totDim, totDimAux, numChunks, cellChunkSize, faceChunkSize, chunk, fStart, fEnd;
45883e9753d6SMatthew G. Knepley   PetscInt         maxDegree = PETSC_MAX_INT;
45893e9753d6SMatthew G. Knepley   PetscQuadrature  affineQuad = NULL, *quads = NULL;
45903e9753d6SMatthew G. Knepley   PetscFEGeom     *affineGeom = NULL, **geoms = NULL;
45913e9753d6SMatthew G. Knepley 
45923e9753d6SMatthew G. Knepley   PetscFunctionBegin;
45939566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_ResidualFEM,dm,0,0,0));
45943e9753d6SMatthew G. Knepley   /* TODO The places where we have to use isFE are probably the member functions for the PetscDisc class */
45953e9753d6SMatthew G. Knepley   /* TODO The FVM geometry is over-manipulated. Make the precalc functions return exactly what we need */
45963e9753d6SMatthew G. Knepley   /* FEM+FVM */
45979566063dSJacob Faibussowitsch   PetscCall(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
45989566063dSJacob Faibussowitsch   PetscCall(DMPlexGetHeightStratum(dm, 1, &fStart, &fEnd));
45993e9753d6SMatthew G. Knepley   /* 1: Get sizes from dm and dmAux */
46009566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
46019566063dSJacob Faibussowitsch   PetscCall(DMGetLabel(dm, "ghost", &ghostLabel));
46029566063dSJacob Faibussowitsch   PetscCall(DMGetCellDS(dm, cells ? cells[cStart] : cStart, &ds));
46039566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumFields(ds, &Nf));
46049566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(ds, &totDim));
46059566063dSJacob Faibussowitsch   PetscCall(DMGetAuxiliaryVec(dm, key.label, key.value, key.part, &locA));
46063e9753d6SMatthew G. Knepley   if (locA) {
46073e9753d6SMatthew G. Knepley     PetscInt subcell;
46089566063dSJacob Faibussowitsch     PetscCall(VecGetDM(locA, &dmAux));
46099566063dSJacob Faibussowitsch     PetscCall(DMGetEnclosurePoint(dmAux, dm, DM_ENC_UNKNOWN, cStart, &subcell));
46109566063dSJacob Faibussowitsch     PetscCall(DMGetCellDS(dmAux, subcell, &dsAux));
46119566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalDimension(dsAux, &totDimAux));
46123e9753d6SMatthew G. Knepley   }
46133e9753d6SMatthew G. Knepley   /* 2: Get geometric data */
46143e9753d6SMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
46153e9753d6SMatthew G. Knepley     PetscObject  obj;
46163e9753d6SMatthew G. Knepley     PetscClassId id;
46173e9753d6SMatthew G. Knepley     PetscBool    fimp;
46183e9753d6SMatthew G. Knepley 
46199566063dSJacob Faibussowitsch     PetscCall(PetscDSGetImplicit(ds, f, &fimp));
46203e9753d6SMatthew G. Knepley     if (isImplicit != fimp) continue;
46219566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(ds, f, &obj));
46229566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
46233e9753d6SMatthew G. Knepley     if (id == PETSCFE_CLASSID) {useFEM = PETSC_TRUE;}
46243e9753d6SMatthew G. Knepley     if (id == PETSCFV_CLASSID) {useFVM = PETSC_TRUE; fvm = (PetscFV) obj;}
46253e9753d6SMatthew G. Knepley   }
46263e9753d6SMatthew G. Knepley   if (useFEM) {
46279566063dSJacob Faibussowitsch     PetscCall(DMGetCoordinateField(dm, &coordField));
46289566063dSJacob Faibussowitsch     PetscCall(DMFieldGetDegree(coordField,cellIS,NULL,&maxDegree));
46293e9753d6SMatthew G. Knepley     if (maxDegree <= 1) {
46309566063dSJacob Faibussowitsch       PetscCall(DMFieldCreateDefaultQuadrature(coordField,cellIS,&affineQuad));
46313e9753d6SMatthew G. Knepley       if (affineQuad) {
46329566063dSJacob Faibussowitsch         PetscCall(DMSNESGetFEGeom(coordField,cellIS,affineQuad,PETSC_FALSE,&affineGeom));
46333e9753d6SMatthew G. Knepley       }
46343e9753d6SMatthew G. Knepley     } else {
46359566063dSJacob Faibussowitsch       PetscCall(PetscCalloc2(Nf,&quads,Nf,&geoms));
46363e9753d6SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
46373e9753d6SMatthew G. Knepley         PetscObject  obj;
46383e9753d6SMatthew G. Knepley         PetscClassId id;
46393e9753d6SMatthew G. Knepley         PetscBool    fimp;
46403e9753d6SMatthew G. Knepley 
46419566063dSJacob Faibussowitsch         PetscCall(PetscDSGetImplicit(ds, f, &fimp));
46423e9753d6SMatthew G. Knepley         if (isImplicit != fimp) continue;
46439566063dSJacob Faibussowitsch         PetscCall(PetscDSGetDiscretization(ds, f, &obj));
46449566063dSJacob Faibussowitsch         PetscCall(PetscObjectGetClassId(obj, &id));
46453e9753d6SMatthew G. Knepley         if (id == PETSCFE_CLASSID) {
46463e9753d6SMatthew G. Knepley           PetscFE fe = (PetscFE) obj;
46473e9753d6SMatthew G. Knepley 
46489566063dSJacob Faibussowitsch           PetscCall(PetscFEGetQuadrature(fe, &quads[f]));
46499566063dSJacob Faibussowitsch           PetscCall(PetscObjectReference((PetscObject)quads[f]));
46509566063dSJacob Faibussowitsch           PetscCall(DMSNESGetFEGeom(coordField,cellIS,quads[f],PETSC_FALSE,&geoms[f]));
46513e9753d6SMatthew G. Knepley         }
46523e9753d6SMatthew G. Knepley       }
46533e9753d6SMatthew G. Knepley     }
46543e9753d6SMatthew G. Knepley   }
46553e9753d6SMatthew G. Knepley   if (useFVM) {
46569566063dSJacob Faibussowitsch     PetscCall(DMPlexGetGeometryFVM(dm, &faceGeometryFVM, &cellGeometryFVM, NULL));
46579566063dSJacob Faibussowitsch     PetscCall(VecGetArrayRead(faceGeometryFVM, (const PetscScalar **) &fgeomFVM));
46589566063dSJacob Faibussowitsch     PetscCall(VecGetArrayRead(cellGeometryFVM, (const PetscScalar **) &cgeomFVM));
46593e9753d6SMatthew G. Knepley     /* Reconstruct and limit cell gradients */
46609566063dSJacob Faibussowitsch     PetscCall(DMPlexGetGradientDM(dm, fvm, &dmGrad));
46613e9753d6SMatthew G. Knepley     if (dmGrad) {
46629566063dSJacob Faibussowitsch       PetscCall(DMPlexGetHeightStratum(dm, 1, &fStart, &fEnd));
46639566063dSJacob Faibussowitsch       PetscCall(DMGetGlobalVector(dmGrad, &grad));
46649566063dSJacob Faibussowitsch       PetscCall(DMPlexReconstructGradients_Internal(dm, fvm, fStart, fEnd, faceGeometryFVM, cellGeometryFVM, locX, grad));
46653e9753d6SMatthew G. Knepley       /* Communicate gradient values */
46669566063dSJacob Faibussowitsch       PetscCall(DMGetLocalVector(dmGrad, &locGrad));
46679566063dSJacob Faibussowitsch       PetscCall(DMGlobalToLocalBegin(dmGrad, grad, INSERT_VALUES, locGrad));
46689566063dSJacob Faibussowitsch       PetscCall(DMGlobalToLocalEnd(dmGrad, grad, INSERT_VALUES, locGrad));
46699566063dSJacob Faibussowitsch       PetscCall(DMRestoreGlobalVector(dmGrad, &grad));
46703e9753d6SMatthew G. Knepley     }
46713e9753d6SMatthew G. Knepley     /* Handle non-essential (e.g. outflow) boundary values */
46729566063dSJacob Faibussowitsch     PetscCall(DMPlexInsertBoundaryValues(dm, PETSC_FALSE, locX, time, faceGeometryFVM, cellGeometryFVM, locGrad));
46733e9753d6SMatthew G. Knepley   }
46743e9753d6SMatthew G. Knepley   /* Loop over chunks */
46759566063dSJacob Faibussowitsch   if (useFEM) PetscCall(ISCreate(PETSC_COMM_SELF, &chunkIS));
46763e9753d6SMatthew G. Knepley   numCells      = cEnd - cStart;
46773e9753d6SMatthew G. Knepley   numChunks     = 1;
46783e9753d6SMatthew G. Knepley   cellChunkSize = numCells/numChunks;
46793e9753d6SMatthew G. Knepley   faceChunkSize = (fEnd - fStart)/numChunks;
46803e9753d6SMatthew G. Knepley   numChunks     = PetscMin(1,numCells);
46813e9753d6SMatthew G. Knepley   for (chunk = 0; chunk < numChunks; ++chunk) {
46823e9753d6SMatthew G. Knepley     PetscScalar     *elemVec, *fluxL, *fluxR;
46833e9753d6SMatthew G. Knepley     PetscReal       *vol;
46843e9753d6SMatthew G. Knepley     PetscFVFaceGeom *fgeom;
46853e9753d6SMatthew G. Knepley     PetscInt         cS = cStart+chunk*cellChunkSize, cE = PetscMin(cS+cellChunkSize, cEnd), numCells = cE - cS, c;
46863e9753d6SMatthew G. Knepley     PetscInt         fS = fStart+chunk*faceChunkSize, fE = PetscMin(fS+faceChunkSize, fEnd), numFaces = 0, face;
46873e9753d6SMatthew G. Knepley 
46883e9753d6SMatthew G. Knepley     /* Extract field coefficients */
46893e9753d6SMatthew G. Knepley     if (useFEM) {
46909566063dSJacob Faibussowitsch       PetscCall(ISGetPointSubrange(chunkIS, cS, cE, cells));
46919566063dSJacob Faibussowitsch       PetscCall(DMPlexGetCellFields(dm, chunkIS, locX, locX_t, locA, &u, &u_t, &a));
46929566063dSJacob Faibussowitsch       PetscCall(DMGetWorkArray(dm, numCells*totDim, MPIU_SCALAR, &elemVec));
46939566063dSJacob Faibussowitsch       PetscCall(PetscArrayzero(elemVec, numCells*totDim));
46943e9753d6SMatthew G. Knepley     }
46953e9753d6SMatthew G. Knepley     if (useFVM) {
46969566063dSJacob Faibussowitsch       PetscCall(DMPlexGetFaceFields(dm, fS, fE, locX, locX_t, faceGeometryFVM, cellGeometryFVM, locGrad, &numFaces, &uL, &uR));
46979566063dSJacob Faibussowitsch       PetscCall(DMPlexGetFaceGeometry(dm, fS, fE, faceGeometryFVM, cellGeometryFVM, &numFaces, &fgeom, &vol));
46989566063dSJacob Faibussowitsch       PetscCall(DMGetWorkArray(dm, numFaces*totDim, MPIU_SCALAR, &fluxL));
46999566063dSJacob Faibussowitsch       PetscCall(DMGetWorkArray(dm, numFaces*totDim, MPIU_SCALAR, &fluxR));
47009566063dSJacob Faibussowitsch       PetscCall(PetscArrayzero(fluxL, numFaces*totDim));
47019566063dSJacob Faibussowitsch       PetscCall(PetscArrayzero(fluxR, numFaces*totDim));
47023e9753d6SMatthew G. Knepley     }
47033e9753d6SMatthew 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 */
47043e9753d6SMatthew G. Knepley     /* Loop over fields */
47053e9753d6SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
47063e9753d6SMatthew G. Knepley       PetscObject  obj;
47073e9753d6SMatthew G. Knepley       PetscClassId id;
47083e9753d6SMatthew G. Knepley       PetscBool    fimp;
47093e9753d6SMatthew G. Knepley       PetscInt     numChunks, numBatches, batchSize, numBlocks, blockSize, Ne, Nr, offset;
47103e9753d6SMatthew G. Knepley 
47116528b96dSMatthew G. Knepley       key.field = f;
47129566063dSJacob Faibussowitsch       PetscCall(PetscDSGetImplicit(ds, f, &fimp));
47133e9753d6SMatthew G. Knepley       if (isImplicit != fimp) continue;
47149566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(ds, f, &obj));
47159566063dSJacob Faibussowitsch       PetscCall(PetscObjectGetClassId(obj, &id));
47163e9753d6SMatthew G. Knepley       if (id == PETSCFE_CLASSID) {
47173e9753d6SMatthew G. Knepley         PetscFE         fe = (PetscFE) obj;
47183e9753d6SMatthew G. Knepley         PetscFEGeom    *geom = affineGeom ? affineGeom : geoms[f];
47193e9753d6SMatthew G. Knepley         PetscFEGeom    *chunkGeom = NULL;
47203e9753d6SMatthew G. Knepley         PetscQuadrature quad = affineQuad ? affineQuad : quads[f];
47213e9753d6SMatthew G. Knepley         PetscInt        Nq, Nb;
47223e9753d6SMatthew G. Knepley 
47239566063dSJacob Faibussowitsch         PetscCall(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
47249566063dSJacob Faibussowitsch         PetscCall(PetscQuadratureGetData(quad, NULL, NULL, &Nq, NULL, NULL));
47259566063dSJacob Faibussowitsch         PetscCall(PetscFEGetDimension(fe, &Nb));
47263e9753d6SMatthew G. Knepley         blockSize = Nb;
47273e9753d6SMatthew G. Knepley         batchSize = numBlocks * blockSize;
47289566063dSJacob Faibussowitsch         PetscCall(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
47293e9753d6SMatthew G. Knepley         numChunks = numCells / (numBatches*batchSize);
47303e9753d6SMatthew G. Knepley         Ne        = numChunks*numBatches*batchSize;
47313e9753d6SMatthew G. Knepley         Nr        = numCells % (numBatches*batchSize);
47323e9753d6SMatthew G. Knepley         offset    = numCells - Nr;
47333e9753d6SMatthew G. Knepley         /* Integrate FE residual to get elemVec (need fields at quadrature points) */
47343e9753d6SMatthew 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) */
47359566063dSJacob Faibussowitsch         PetscCall(PetscFEGeomGetChunk(geom,0,offset,&chunkGeom));
47369566063dSJacob Faibussowitsch         PetscCall(PetscFEIntegrateResidual(ds, key, Ne, chunkGeom, u, u_t, dsAux, a, t, elemVec));
47379566063dSJacob Faibussowitsch         PetscCall(PetscFEGeomGetChunk(geom,offset,numCells,&chunkGeom));
47389566063dSJacob 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]));
47399566063dSJacob Faibussowitsch         PetscCall(PetscFEGeomRestoreChunk(geom,offset,numCells,&chunkGeom));
47403e9753d6SMatthew G. Knepley       } else if (id == PETSCFV_CLASSID) {
47413e9753d6SMatthew G. Knepley         PetscFV fv = (PetscFV) obj;
47423e9753d6SMatthew G. Knepley 
47433e9753d6SMatthew G. Knepley         Ne = numFaces;
47443e9753d6SMatthew G. Knepley         /* Riemann solve over faces (need fields at face centroids) */
47453e9753d6SMatthew G. Knepley         /*   We need to evaluate FE fields at those coordinates */
47469566063dSJacob Faibussowitsch         PetscCall(PetscFVIntegrateRHSFunction(fv, ds, f, Ne, fgeom, vol, uL, uR, fluxL, fluxR));
474798921bdaSJacob Faibussowitsch       } else SETERRQ(PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", f);
47483e9753d6SMatthew G. Knepley     }
47493e9753d6SMatthew G. Knepley     /* Loop over domain */
47503e9753d6SMatthew G. Knepley     if (useFEM) {
47513e9753d6SMatthew G. Knepley       /* Add elemVec to locX */
47523e9753d6SMatthew G. Knepley       for (c = cS; c < cE; ++c) {
47533e9753d6SMatthew G. Knepley         const PetscInt cell = cells ? cells[c] : c;
47543e9753d6SMatthew G. Knepley         const PetscInt cind = c - cStart;
47553e9753d6SMatthew G. Knepley 
47569566063dSJacob Faibussowitsch         if (mesh->printFEM > 1) PetscCall(DMPrintCellVector(cell, name, totDim, &elemVec[cind*totDim]));
47573e9753d6SMatthew G. Knepley         if (ghostLabel) {
47583e9753d6SMatthew G. Knepley           PetscInt ghostVal;
47593e9753d6SMatthew G. Knepley 
47609566063dSJacob Faibussowitsch           PetscCall(DMLabelGetValue(ghostLabel,cell,&ghostVal));
47613e9753d6SMatthew G. Knepley           if (ghostVal > 0) continue;
47623e9753d6SMatthew G. Knepley         }
47639566063dSJacob Faibussowitsch         PetscCall(DMPlexVecSetClosure(dm, section, locF, cell, &elemVec[cind*totDim], ADD_ALL_VALUES));
47643e9753d6SMatthew G. Knepley       }
47653e9753d6SMatthew G. Knepley     }
47663e9753d6SMatthew G. Knepley     if (useFVM) {
47673e9753d6SMatthew G. Knepley       PetscScalar *fa;
47683e9753d6SMatthew G. Knepley       PetscInt     iface;
47693e9753d6SMatthew G. Knepley 
47709566063dSJacob Faibussowitsch       PetscCall(VecGetArray(locF, &fa));
47713e9753d6SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
47723e9753d6SMatthew G. Knepley         PetscFV      fv;
47733e9753d6SMatthew G. Knepley         PetscObject  obj;
47743e9753d6SMatthew G. Knepley         PetscClassId id;
47753e9753d6SMatthew G. Knepley         PetscInt     foff, pdim;
47763e9753d6SMatthew G. Knepley 
47779566063dSJacob Faibussowitsch         PetscCall(PetscDSGetDiscretization(ds, f, &obj));
47789566063dSJacob Faibussowitsch         PetscCall(PetscDSGetFieldOffset(ds, f, &foff));
47799566063dSJacob Faibussowitsch         PetscCall(PetscObjectGetClassId(obj, &id));
47803e9753d6SMatthew G. Knepley         if (id != PETSCFV_CLASSID) continue;
47813e9753d6SMatthew G. Knepley         fv   = (PetscFV) obj;
47829566063dSJacob Faibussowitsch         PetscCall(PetscFVGetNumComponents(fv, &pdim));
47833e9753d6SMatthew G. Knepley         /* Accumulate fluxes to cells */
47843e9753d6SMatthew G. Knepley         for (face = fS, iface = 0; face < fE; ++face) {
47853e9753d6SMatthew G. Knepley           const PetscInt *scells;
47863e9753d6SMatthew G. Knepley           PetscScalar    *fL = NULL, *fR = NULL;
47873e9753d6SMatthew G. Knepley           PetscInt        ghost, d, nsupp, nchild;
47883e9753d6SMatthew G. Knepley 
47899566063dSJacob Faibussowitsch           PetscCall(DMLabelGetValue(ghostLabel, face, &ghost));
47909566063dSJacob Faibussowitsch           PetscCall(DMPlexGetSupportSize(dm, face, &nsupp));
47919566063dSJacob Faibussowitsch           PetscCall(DMPlexGetTreeChildren(dm, face, &nchild, NULL));
47923e9753d6SMatthew G. Knepley           if (ghost >= 0 || nsupp > 2 || nchild > 0) continue;
47939566063dSJacob Faibussowitsch           PetscCall(DMPlexGetSupport(dm, face, &scells));
47949566063dSJacob Faibussowitsch           PetscCall(DMLabelGetValue(ghostLabel,scells[0],&ghost));
47959566063dSJacob Faibussowitsch           if (ghost <= 0) PetscCall(DMPlexPointLocalFieldRef(dm, scells[0], f, fa, &fL));
47969566063dSJacob Faibussowitsch           PetscCall(DMLabelGetValue(ghostLabel,scells[1],&ghost));
47979566063dSJacob Faibussowitsch           if (ghost <= 0) PetscCall(DMPlexPointLocalFieldRef(dm, scells[1], f, fa, &fR));
47983e9753d6SMatthew G. Knepley           for (d = 0; d < pdim; ++d) {
47993e9753d6SMatthew G. Knepley             if (fL) fL[d] -= fluxL[iface*totDim+foff+d];
48003e9753d6SMatthew G. Knepley             if (fR) fR[d] += fluxR[iface*totDim+foff+d];
48013e9753d6SMatthew G. Knepley           }
48023e9753d6SMatthew G. Knepley           ++iface;
48033e9753d6SMatthew G. Knepley         }
48043e9753d6SMatthew G. Knepley       }
48059566063dSJacob Faibussowitsch       PetscCall(VecRestoreArray(locF, &fa));
48063e9753d6SMatthew G. Knepley     }
48073e9753d6SMatthew G. Knepley     /* Handle time derivative */
48083e9753d6SMatthew G. Knepley     if (locX_t) {
48093e9753d6SMatthew G. Knepley       PetscScalar *x_t, *fa;
48103e9753d6SMatthew G. Knepley 
48119566063dSJacob Faibussowitsch       PetscCall(VecGetArray(locF, &fa));
48129566063dSJacob Faibussowitsch       PetscCall(VecGetArray(locX_t, &x_t));
48133e9753d6SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
48143e9753d6SMatthew G. Knepley         PetscFV      fv;
48153e9753d6SMatthew G. Knepley         PetscObject  obj;
48163e9753d6SMatthew G. Knepley         PetscClassId id;
48173e9753d6SMatthew G. Knepley         PetscInt     pdim, d;
48183e9753d6SMatthew G. Knepley 
48199566063dSJacob Faibussowitsch         PetscCall(PetscDSGetDiscretization(ds, f, &obj));
48209566063dSJacob Faibussowitsch         PetscCall(PetscObjectGetClassId(obj, &id));
48213e9753d6SMatthew G. Knepley         if (id != PETSCFV_CLASSID) continue;
48223e9753d6SMatthew G. Knepley         fv   = (PetscFV) obj;
48239566063dSJacob Faibussowitsch         PetscCall(PetscFVGetNumComponents(fv, &pdim));
48243e9753d6SMatthew G. Knepley         for (c = cS; c < cE; ++c) {
48253e9753d6SMatthew G. Knepley           const PetscInt cell = cells ? cells[c] : c;
48263e9753d6SMatthew G. Knepley           PetscScalar   *u_t, *r;
48273e9753d6SMatthew G. Knepley 
48283e9753d6SMatthew G. Knepley           if (ghostLabel) {
48293e9753d6SMatthew G. Knepley             PetscInt ghostVal;
48303e9753d6SMatthew G. Knepley 
48319566063dSJacob Faibussowitsch             PetscCall(DMLabelGetValue(ghostLabel, cell, &ghostVal));
48323e9753d6SMatthew G. Knepley             if (ghostVal > 0) continue;
48333e9753d6SMatthew G. Knepley           }
48349566063dSJacob Faibussowitsch           PetscCall(DMPlexPointLocalFieldRead(dm, cell, f, x_t, &u_t));
48359566063dSJacob Faibussowitsch           PetscCall(DMPlexPointLocalFieldRef(dm, cell, f, fa, &r));
48363e9753d6SMatthew G. Knepley           for (d = 0; d < pdim; ++d) r[d] += u_t[d];
48373e9753d6SMatthew G. Knepley         }
48383e9753d6SMatthew G. Knepley       }
48399566063dSJacob Faibussowitsch       PetscCall(VecRestoreArray(locX_t, &x_t));
48409566063dSJacob Faibussowitsch       PetscCall(VecRestoreArray(locF, &fa));
48413e9753d6SMatthew G. Knepley     }
48423e9753d6SMatthew G. Knepley     if (useFEM) {
48439566063dSJacob Faibussowitsch       PetscCall(DMPlexRestoreCellFields(dm, chunkIS, locX, locX_t, locA, &u, &u_t, &a));
48449566063dSJacob Faibussowitsch       PetscCall(DMRestoreWorkArray(dm, numCells*totDim, MPIU_SCALAR, &elemVec));
48453e9753d6SMatthew G. Knepley     }
48463e9753d6SMatthew G. Knepley     if (useFVM) {
48479566063dSJacob Faibussowitsch       PetscCall(DMPlexRestoreFaceFields(dm, fS, fE, locX, locX_t, faceGeometryFVM, cellGeometryFVM, locGrad, &numFaces, &uL, &uR));
48489566063dSJacob Faibussowitsch       PetscCall(DMPlexRestoreFaceGeometry(dm, fS, fE, faceGeometryFVM, cellGeometryFVM, &numFaces, &fgeom, &vol));
48499566063dSJacob Faibussowitsch       PetscCall(DMRestoreWorkArray(dm, numFaces*totDim, MPIU_SCALAR, &fluxL));
48509566063dSJacob Faibussowitsch       PetscCall(DMRestoreWorkArray(dm, numFaces*totDim, MPIU_SCALAR, &fluxR));
48519566063dSJacob Faibussowitsch       if (dmGrad) PetscCall(DMRestoreLocalVector(dmGrad, &locGrad));
48523e9753d6SMatthew G. Knepley     }
48533e9753d6SMatthew G. Knepley   }
48549566063dSJacob Faibussowitsch   if (useFEM) PetscCall(ISDestroy(&chunkIS));
48559566063dSJacob Faibussowitsch   PetscCall(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
48563e9753d6SMatthew G. Knepley 
48573e9753d6SMatthew G. Knepley   if (useFEM) {
48589566063dSJacob Faibussowitsch     PetscCall(DMPlexComputeBdResidual_Internal(dm, locX, locX_t, t, locF, user));
48593e9753d6SMatthew G. Knepley 
48603e9753d6SMatthew G. Knepley     if (maxDegree <= 1) {
48619566063dSJacob Faibussowitsch       PetscCall(DMSNESRestoreFEGeom(coordField,cellIS,affineQuad,PETSC_FALSE,&affineGeom));
48629566063dSJacob Faibussowitsch       PetscCall(PetscQuadratureDestroy(&affineQuad));
48633e9753d6SMatthew G. Knepley     } else {
48643e9753d6SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
48659566063dSJacob Faibussowitsch         PetscCall(DMSNESRestoreFEGeom(coordField,cellIS,quads[f],PETSC_FALSE,&geoms[f]));
48669566063dSJacob Faibussowitsch         PetscCall(PetscQuadratureDestroy(&quads[f]));
48673e9753d6SMatthew G. Knepley       }
48689566063dSJacob Faibussowitsch       PetscCall(PetscFree2(quads,geoms));
48693e9753d6SMatthew G. Knepley     }
48703e9753d6SMatthew G. Knepley   }
48713e9753d6SMatthew G. Knepley 
48723e9753d6SMatthew G. Knepley   /* FEM */
48733e9753d6SMatthew G. Knepley   /* 1: Get sizes from dm and dmAux */
48743e9753d6SMatthew G. Knepley   /* 2: Get geometric data */
48753e9753d6SMatthew G. Knepley   /* 3: Handle boundary values */
48763e9753d6SMatthew G. Knepley   /* 4: Loop over domain */
48773e9753d6SMatthew G. Knepley   /*   Extract coefficients */
48783e9753d6SMatthew G. Knepley   /* Loop over fields */
48793e9753d6SMatthew G. Knepley   /*   Set tiling for FE*/
48803e9753d6SMatthew G. Knepley   /*   Integrate FE residual to get elemVec */
48813e9753d6SMatthew G. Knepley   /*     Loop over subdomain */
48823e9753d6SMatthew G. Knepley   /*       Loop over quad points */
48833e9753d6SMatthew G. Knepley   /*         Transform coords to real space */
48843e9753d6SMatthew G. Knepley   /*         Evaluate field and aux fields at point */
48853e9753d6SMatthew G. Knepley   /*         Evaluate residual at point */
48863e9753d6SMatthew G. Knepley   /*         Transform residual to real space */
48873e9753d6SMatthew G. Knepley   /*       Add residual to elemVec */
48883e9753d6SMatthew G. Knepley   /* Loop over domain */
48893e9753d6SMatthew G. Knepley   /*   Add elemVec to locX */
48903e9753d6SMatthew G. Knepley 
48913e9753d6SMatthew G. Knepley   /* FVM */
48923e9753d6SMatthew G. Knepley   /* Get geometric data */
48933e9753d6SMatthew G. Knepley   /* If using gradients */
48943e9753d6SMatthew G. Knepley   /*   Compute gradient data */
48953e9753d6SMatthew G. Knepley   /*   Loop over domain faces */
48963e9753d6SMatthew G. Knepley   /*     Count computational faces */
48973e9753d6SMatthew G. Knepley   /*     Reconstruct cell gradient */
48983e9753d6SMatthew G. Knepley   /*   Loop over domain cells */
48993e9753d6SMatthew G. Knepley   /*     Limit cell gradients */
49003e9753d6SMatthew G. Knepley   /* Handle boundary values */
49013e9753d6SMatthew G. Knepley   /* Loop over domain faces */
49023e9753d6SMatthew G. Knepley   /*   Read out field, centroid, normal, volume for each side of face */
49033e9753d6SMatthew G. Knepley   /* Riemann solve over faces */
49043e9753d6SMatthew G. Knepley   /* Loop over domain faces */
49053e9753d6SMatthew G. Knepley   /*   Accumulate fluxes to cells */
49063e9753d6SMatthew G. Knepley   /* TODO Change printFEM to printDisc here */
49073e9753d6SMatthew G. Knepley   if (mesh->printFEM) {
49083e9753d6SMatthew G. Knepley     Vec         locFbc;
49093e9753d6SMatthew G. Knepley     PetscInt    pStart, pEnd, p, maxDof;
49103e9753d6SMatthew G. Knepley     PetscScalar *zeroes;
49113e9753d6SMatthew G. Knepley 
49129566063dSJacob Faibussowitsch     PetscCall(VecDuplicate(locF,&locFbc));
49139566063dSJacob Faibussowitsch     PetscCall(VecCopy(locF,locFbc));
49149566063dSJacob Faibussowitsch     PetscCall(PetscSectionGetChart(section,&pStart,&pEnd));
49159566063dSJacob Faibussowitsch     PetscCall(PetscSectionGetMaxDof(section,&maxDof));
49169566063dSJacob Faibussowitsch     PetscCall(PetscCalloc1(maxDof,&zeroes));
49173e9753d6SMatthew G. Knepley     for (p = pStart; p < pEnd; p++) {
49189566063dSJacob Faibussowitsch       PetscCall(VecSetValuesSection(locFbc,section,p,zeroes,INSERT_BC_VALUES));
49193e9753d6SMatthew G. Knepley     }
49209566063dSJacob Faibussowitsch     PetscCall(PetscFree(zeroes));
49219566063dSJacob Faibussowitsch     PetscCall(DMPrintLocalVec(dm, name, mesh->printTol, locFbc));
49229566063dSJacob Faibussowitsch     PetscCall(VecDestroy(&locFbc));
49233e9753d6SMatthew G. Knepley   }
49249566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_ResidualFEM,dm,0,0,0));
49253e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
49263e9753d6SMatthew G. Knepley }
49273e9753d6SMatthew G. Knepley 
49286528b96dSMatthew G. Knepley /*
49296528b96dSMatthew G. Knepley   1) Allow multiple kernels for BdResidual for hybrid DS
49306528b96dSMatthew G. Knepley 
49316528b96dSMatthew G. Knepley   DONE 2) Get out dsAux for either side at the same time as cohesive cell dsAux
49326528b96dSMatthew G. Knepley 
49336528b96dSMatthew G. Knepley   DONE 3) Change DMGetCellFields() to get different aux data a[] for each side
49346528b96dSMatthew G. Knepley      - I think I just need to replace a[] with the closure from each face
49356528b96dSMatthew G. Knepley 
49366528b96dSMatthew G. Knepley   4) Run both kernels for each non-hybrid field with correct dsAux, and then hybrid field as before
49376528b96dSMatthew G. Knepley */
493806ad1575SMatthew 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)
49393e9753d6SMatthew G. Knepley {
49403e9753d6SMatthew G. Knepley   DM_Plex         *mesh       = (DM_Plex *) dm->data;
49413e9753d6SMatthew G. Knepley   const char      *name       = "Hybrid Residual";
494204c51a94SMatthew G. Knepley   DM               dmAux[3]   = {NULL, NULL, NULL};
49433e9753d6SMatthew G. Knepley   DMLabel          ghostLabel = NULL;
49446528b96dSMatthew G. Knepley   PetscDS          ds         = NULL;
49456528b96dSMatthew G. Knepley   PetscDS          dsAux[3]   = {NULL, NULL, NULL};
494604c51a94SMatthew G. Knepley   Vec              locA[3]    = {NULL, NULL, NULL};
49473e9753d6SMatthew G. Knepley   PetscSection     section    = NULL;
49483e9753d6SMatthew G. Knepley   DMField          coordField = NULL;
49496528b96dSMatthew G. Knepley   PetscScalar     *u = NULL, *u_t, *a[3];
49503e9753d6SMatthew G. Knepley   PetscScalar     *elemVec;
49513e9753d6SMatthew G. Knepley   IS               chunkIS;
49523e9753d6SMatthew G. Knepley   const PetscInt  *cells;
49533e9753d6SMatthew G. Knepley   PetscInt        *faces;
49543e9753d6SMatthew G. Knepley   PetscInt         cStart, cEnd, numCells;
49556528b96dSMatthew G. Knepley   PetscInt         Nf, f, totDim, totDimAux[3], numChunks, cellChunkSize, chunk;
49563e9753d6SMatthew G. Knepley   PetscInt         maxDegree = PETSC_MAX_INT;
49573e9753d6SMatthew G. Knepley   PetscQuadrature  affineQuad = NULL, *quads = NULL;
49583e9753d6SMatthew G. Knepley   PetscFEGeom     *affineGeom = NULL, **geoms = NULL;
49593e9753d6SMatthew G. Knepley 
49603e9753d6SMatthew G. Knepley   PetscFunctionBegin;
49615fedec97SMatthew G. Knepley   if ((key[0].label == key[1].label) && (key[0].value == key[1].value) && (key[0].part == key[1].part)) {
49625fedec97SMatthew G. Knepley     const char *name;
49639566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetName((PetscObject) key[0].label, &name));
496498921bdaSJacob Faibussowitsch     SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Form keys for each side of a cohesive surface must be different (%s, %D, %D)", name, key[0].value, key[0].part);
49655fedec97SMatthew G. Knepley   }
49669566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_ResidualFEM,dm,0,0,0));
49673e9753d6SMatthew G. Knepley   /* TODO The places where we have to use isFE are probably the member functions for the PetscDisc class */
49683e9753d6SMatthew G. Knepley   /* FEM */
49699566063dSJacob Faibussowitsch   PetscCall(ISGetLocalSize(cellIS, &numCells));
49709566063dSJacob Faibussowitsch   PetscCall(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
49713e9753d6SMatthew G. Knepley   /* 1: Get sizes from dm and dmAux */
49729566063dSJacob Faibussowitsch   PetscCall(DMGetSection(dm, &section));
49739566063dSJacob Faibussowitsch   PetscCall(DMGetLabel(dm, "ghost", &ghostLabel));
49749566063dSJacob Faibussowitsch   PetscCall(DMGetCellDS(dm, cStart, &ds));
49759566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumFields(ds, &Nf));
49769566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(ds, &totDim));
49779566063dSJacob Faibussowitsch   PetscCall(DMGetAuxiliaryVec(dm, key[2].label, key[2].value, key[2].part, &locA[2]));
497804c51a94SMatthew G. Knepley   if (locA[2]) {
49799566063dSJacob Faibussowitsch     PetscCall(VecGetDM(locA[2], &dmAux[2]));
49809566063dSJacob Faibussowitsch     PetscCall(DMGetCellDS(dmAux[2], cStart, &dsAux[2]));
49819566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalDimension(dsAux[2], &totDimAux[2]));
49826528b96dSMatthew G. Knepley     {
49836528b96dSMatthew G. Knepley       const PetscInt *cone;
49846528b96dSMatthew G. Knepley       PetscInt        c;
49856528b96dSMatthew G. Knepley 
49869566063dSJacob Faibussowitsch       PetscCall(DMPlexGetCone(dm, cStart, &cone));
49876528b96dSMatthew G. Knepley       for (c = 0; c < 2; ++c) {
49886528b96dSMatthew G. Knepley         const PetscInt *support;
49896528b96dSMatthew G. Knepley         PetscInt ssize, s;
49906528b96dSMatthew G. Knepley 
49919566063dSJacob Faibussowitsch         PetscCall(DMPlexGetSupport(dm, cone[c], &support));
49929566063dSJacob Faibussowitsch         PetscCall(DMPlexGetSupportSize(dm, cone[c], &ssize));
49935f80ce2aSJacob Faibussowitsch         PetscCheck(ssize == 2,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Face %D from cell %D has support size %D != 2", cone[c], cStart, ssize);
49946528b96dSMatthew G. Knepley         if      (support[0] == cStart) s = 1;
49956528b96dSMatthew G. Knepley         else if (support[1] == cStart) s = 0;
499698921bdaSJacob Faibussowitsch         else SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Face %D does not have cell %D in its support", cone[c], cStart);
49979566063dSJacob Faibussowitsch         PetscCall(DMGetAuxiliaryVec(dm, key[c].label, key[c].value, key[c].part, &locA[c]));
49989566063dSJacob Faibussowitsch         if (locA[c]) PetscCall(VecGetDM(locA[c], &dmAux[c]));
499904c51a94SMatthew G. Knepley         else         {dmAux[c] = dmAux[2];}
50009566063dSJacob Faibussowitsch         PetscCall(DMGetCellDS(dmAux[c], support[s], &dsAux[c]));
50019566063dSJacob Faibussowitsch         PetscCall(PetscDSGetTotalDimension(dsAux[c], &totDimAux[c]));
50026528b96dSMatthew G. Knepley       }
50036528b96dSMatthew G. Knepley     }
50043e9753d6SMatthew G. Knepley   }
50053e9753d6SMatthew G. Knepley   /* 2: Setup geometric data */
50069566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateField(dm, &coordField));
50079566063dSJacob Faibussowitsch   PetscCall(DMFieldGetDegree(coordField, cellIS, NULL, &maxDegree));
50083e9753d6SMatthew G. Knepley   if (maxDegree > 1) {
50099566063dSJacob Faibussowitsch     PetscCall(PetscCalloc2(Nf, &quads, Nf, &geoms));
50103e9753d6SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
50113e9753d6SMatthew G. Knepley       PetscFE fe;
50123e9753d6SMatthew G. Knepley 
50139566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(ds, f, (PetscObject *) &fe));
50143e9753d6SMatthew G. Knepley       if (fe) {
50159566063dSJacob Faibussowitsch         PetscCall(PetscFEGetQuadrature(fe, &quads[f]));
50169566063dSJacob Faibussowitsch         PetscCall(PetscObjectReference((PetscObject) quads[f]));
50173e9753d6SMatthew G. Knepley       }
50183e9753d6SMatthew G. Knepley     }
50193e9753d6SMatthew G. Knepley   }
50203e9753d6SMatthew G. Knepley   /* Loop over chunks */
50213e9753d6SMatthew G. Knepley   cellChunkSize = numCells;
50223e9753d6SMatthew G. Knepley   numChunks     = !numCells ? 0 : PetscCeilReal(((PetscReal) numCells)/cellChunkSize);
50239566063dSJacob Faibussowitsch   PetscCall(PetscCalloc1(2*cellChunkSize, &faces));
50249566063dSJacob Faibussowitsch   PetscCall(ISCreateGeneral(PETSC_COMM_SELF, cellChunkSize, faces, PETSC_USE_POINTER, &chunkIS));
50253e9753d6SMatthew G. Knepley   /* Extract field coefficients */
50263e9753d6SMatthew G. Knepley   /* NOTE This needs the end cap faces to have identical orientations */
50279566063dSJacob Faibussowitsch   PetscCall(DMPlexGetCellFields(dm, cellIS, locX, locX_t, locA[2], &u, &u_t, &a[2]));
50289566063dSJacob Faibussowitsch   PetscCall(DMPlexGetHybridAuxFields(dm, dmAux, dsAux, cellIS, locA, a));
50299566063dSJacob Faibussowitsch   PetscCall(DMGetWorkArray(dm, cellChunkSize*totDim, MPIU_SCALAR, &elemVec));
50303e9753d6SMatthew G. Knepley   for (chunk = 0; chunk < numChunks; ++chunk) {
50313e9753d6SMatthew G. Knepley     PetscInt cS = cStart+chunk*cellChunkSize, cE = PetscMin(cS+cellChunkSize, cEnd), numCells = cE - cS, c;
50323e9753d6SMatthew G. Knepley 
50339566063dSJacob Faibussowitsch     PetscCall(PetscMemzero(elemVec, cellChunkSize*totDim * sizeof(PetscScalar)));
50343e9753d6SMatthew G. Knepley     /* Get faces */
50353e9753d6SMatthew G. Knepley     for (c = cS; c < cE; ++c) {
50363e9753d6SMatthew G. Knepley       const PetscInt  cell = cells ? cells[c] : c;
50373e9753d6SMatthew G. Knepley       const PetscInt *cone;
50389566063dSJacob Faibussowitsch       PetscCall(DMPlexGetCone(dm, cell, &cone));
50393e9753d6SMatthew G. Knepley       faces[(c-cS)*2+0] = cone[0];
50403e9753d6SMatthew G. Knepley       faces[(c-cS)*2+1] = cone[1];
50413e9753d6SMatthew G. Knepley     }
50429566063dSJacob Faibussowitsch     PetscCall(ISGeneralSetIndices(chunkIS, cellChunkSize, faces, PETSC_USE_POINTER));
50433e9753d6SMatthew G. Knepley     /* Get geometric data */
50443e9753d6SMatthew G. Knepley     if (maxDegree <= 1) {
50459566063dSJacob Faibussowitsch       if (!affineQuad) PetscCall(DMFieldCreateDefaultQuadrature(coordField, chunkIS, &affineQuad));
50469566063dSJacob Faibussowitsch       if (affineQuad)  PetscCall(DMSNESGetFEGeom(coordField, chunkIS, affineQuad, PETSC_TRUE, &affineGeom));
50473e9753d6SMatthew G. Knepley     } else {
50483e9753d6SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
50499566063dSJacob Faibussowitsch         if (quads[f]) PetscCall(DMSNESGetFEGeom(coordField, chunkIS, quads[f], PETSC_TRUE, &geoms[f]));
50503e9753d6SMatthew G. Knepley       }
50513e9753d6SMatthew G. Knepley     }
50523e9753d6SMatthew G. Knepley     /* Loop over fields */
50533e9753d6SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
50543e9753d6SMatthew G. Knepley       PetscFE         fe;
50553e9753d6SMatthew G. Knepley       PetscFEGeom    *geom = affineGeom ? affineGeom : geoms[f];
5056148442b3SMatthew G. Knepley       PetscFEGeom    *chunkGeom = NULL, *remGeom = NULL;
50573e9753d6SMatthew G. Knepley       PetscQuadrature quad = affineQuad ? affineQuad : quads[f];
50583e9753d6SMatthew G. Knepley       PetscInt        numChunks, numBatches, batchSize, numBlocks, blockSize, Ne, Nr, offset, Nq, Nb;
50595fedec97SMatthew G. Knepley       PetscBool       isCohesiveField;
50603e9753d6SMatthew G. Knepley 
50619566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(ds, f, (PetscObject *) &fe));
50623e9753d6SMatthew G. Knepley       if (!fe) continue;
50639566063dSJacob Faibussowitsch       PetscCall(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
50649566063dSJacob Faibussowitsch       PetscCall(PetscQuadratureGetData(quad, NULL, NULL, &Nq, NULL, NULL));
50659566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDimension(fe, &Nb));
50663e9753d6SMatthew G. Knepley       blockSize = Nb;
50673e9753d6SMatthew G. Knepley       batchSize = numBlocks * blockSize;
50689566063dSJacob Faibussowitsch       PetscCall(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
50693e9753d6SMatthew G. Knepley       numChunks = numCells / (numBatches*batchSize);
50703e9753d6SMatthew G. Knepley       Ne        = numChunks*numBatches*batchSize;
50713e9753d6SMatthew G. Knepley       Nr        = numCells % (numBatches*batchSize);
50723e9753d6SMatthew G. Knepley       offset    = numCells - Nr;
50739566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomGetChunk(geom,0,offset,&chunkGeom));
50749566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomGetChunk(geom,offset,numCells,&remGeom));
50759566063dSJacob Faibussowitsch       PetscCall(PetscDSGetCohesive(ds, f, &isCohesiveField));
50765fedec97SMatthew G. Knepley       chunkGeom->isCohesive = remGeom->isCohesive = PETSC_TRUE;
50776528b96dSMatthew G. Knepley       key[0].field = f;
50786528b96dSMatthew G. Knepley       key[1].field = f;
50795fedec97SMatthew G. Knepley       key[2].field = f;
50809566063dSJacob Faibussowitsch       PetscCall(PetscFEIntegrateHybridResidual(ds, key[0], 0, Ne, chunkGeom, u, u_t, dsAux[0], a[0], t, elemVec));
50819566063dSJacob 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]));
50829566063dSJacob Faibussowitsch       PetscCall(PetscFEIntegrateHybridResidual(ds, key[1], 1, Ne, chunkGeom, u, u_t, dsAux[1], a[1], t, elemVec));
50839566063dSJacob 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]));
50849566063dSJacob Faibussowitsch       PetscCall(PetscFEIntegrateHybridResidual(ds, key[2], 2, Ne, chunkGeom, u, u_t, dsAux[2], a[2], t, elemVec));
50859566063dSJacob 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]));
50869566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomRestoreChunk(geom,offset,numCells,&remGeom));
50879566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomRestoreChunk(geom,0,offset,&chunkGeom));
50883e9753d6SMatthew G. Knepley     }
50893e9753d6SMatthew G. Knepley     /* Add elemVec to locX */
50903e9753d6SMatthew G. Knepley     for (c = cS; c < cE; ++c) {
50913e9753d6SMatthew G. Knepley       const PetscInt cell = cells ? cells[c] : c;
50923e9753d6SMatthew G. Knepley       const PetscInt cind = c - cStart;
50933e9753d6SMatthew G. Knepley 
50949566063dSJacob Faibussowitsch       if (mesh->printFEM > 1) PetscCall(DMPrintCellVector(cell, name, totDim, &elemVec[cind*totDim]));
50953e9753d6SMatthew G. Knepley       if (ghostLabel) {
50963e9753d6SMatthew G. Knepley         PetscInt ghostVal;
50973e9753d6SMatthew G. Knepley 
50989566063dSJacob Faibussowitsch         PetscCall(DMLabelGetValue(ghostLabel,cell,&ghostVal));
50993e9753d6SMatthew G. Knepley         if (ghostVal > 0) continue;
51003e9753d6SMatthew G. Knepley       }
51019566063dSJacob Faibussowitsch       PetscCall(DMPlexVecSetClosure(dm, section, locF, cell, &elemVec[cind*totDim], ADD_ALL_VALUES));
51023e9753d6SMatthew G. Knepley     }
51033e9753d6SMatthew G. Knepley   }
51049566063dSJacob Faibussowitsch   PetscCall(DMPlexRestoreCellFields(dm, cellIS, locX, locX_t, locA[2], &u, &u_t, &a[2]));
51059566063dSJacob Faibussowitsch   PetscCall(DMPlexRestoreHybridAuxFields(dmAux, dsAux, cellIS, locA, a));
51069566063dSJacob Faibussowitsch   PetscCall(DMRestoreWorkArray(dm, numCells*totDim, MPIU_SCALAR, &elemVec));
51079566063dSJacob Faibussowitsch   PetscCall(PetscFree(faces));
51089566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&chunkIS));
51099566063dSJacob Faibussowitsch   PetscCall(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
51103e9753d6SMatthew G. Knepley   if (maxDegree <= 1) {
51119566063dSJacob Faibussowitsch     PetscCall(DMSNESRestoreFEGeom(coordField,cellIS,affineQuad,PETSC_FALSE,&affineGeom));
51129566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureDestroy(&affineQuad));
51133e9753d6SMatthew G. Knepley   } else {
51143e9753d6SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
51159566063dSJacob Faibussowitsch       if (geoms) PetscCall(DMSNESRestoreFEGeom(coordField,cellIS,quads[f],PETSC_FALSE,&geoms[f]));
51169566063dSJacob Faibussowitsch       if (quads) PetscCall(PetscQuadratureDestroy(&quads[f]));
51173e9753d6SMatthew G. Knepley     }
51189566063dSJacob Faibussowitsch     PetscCall(PetscFree2(quads,geoms));
51193e9753d6SMatthew G. Knepley   }
51209566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_ResidualFEM,dm,0,0,0));
51213e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
51223e9753d6SMatthew G. Knepley }
51233e9753d6SMatthew G. Knepley 
512445480ffeSMatthew 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)
51253e9753d6SMatthew G. Knepley {
51263e9753d6SMatthew G. Knepley   DM_Plex        *mesh = (DM_Plex *) dm->data;
51273e9753d6SMatthew G. Knepley   DM              plex = NULL, plexA = NULL, tdm;
51283e9753d6SMatthew G. Knepley   DMEnclosureType encAux;
51293e9753d6SMatthew G. Knepley   PetscDS         prob, probAux = NULL;
51303e9753d6SMatthew G. Knepley   PetscSection    section, sectionAux = NULL;
5131e432b41dSStefano Zampini   PetscSection    globalSection;
51323e9753d6SMatthew G. Knepley   Vec             locA = NULL, tv;
51333e9753d6SMatthew G. Knepley   PetscScalar    *u = NULL, *u_t = NULL, *a = NULL, *elemMat = NULL;
51343e9753d6SMatthew G. Knepley   PetscInt        v;
51353e9753d6SMatthew G. Knepley   PetscInt        Nf, totDim, totDimAux = 0;
5136e432b41dSStefano Zampini   PetscBool       transform;
51373e9753d6SMatthew G. Knepley 
51383e9753d6SMatthew G. Knepley   PetscFunctionBegin;
51399566063dSJacob Faibussowitsch   PetscCall(DMConvert(dm, DMPLEX, &plex));
51409566063dSJacob Faibussowitsch   PetscCall(DMHasBasisTransform(dm, &transform));
51419566063dSJacob Faibussowitsch   PetscCall(DMGetBasisTransformDM_Internal(dm, &tdm));
51429566063dSJacob Faibussowitsch   PetscCall(DMGetBasisTransformVec_Internal(dm, &tv));
51439566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
51449566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dm, &prob));
51459566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumFields(prob, &Nf));
51469566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(prob, &totDim));
51479566063dSJacob Faibussowitsch   PetscCall(DMGetAuxiliaryVec(dm, label, values[0], 0, &locA));
51483e9753d6SMatthew G. Knepley   if (locA) {
51493e9753d6SMatthew G. Knepley     DM dmAux;
51503e9753d6SMatthew G. Knepley 
51519566063dSJacob Faibussowitsch     PetscCall(VecGetDM(locA, &dmAux));
51529566063dSJacob Faibussowitsch     PetscCall(DMGetEnclosureRelation(dmAux, dm, &encAux));
51539566063dSJacob Faibussowitsch     PetscCall(DMConvert(dmAux, DMPLEX, &plexA));
51549566063dSJacob Faibussowitsch     PetscCall(DMGetDS(plexA, &probAux));
51559566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalDimension(probAux, &totDimAux));
51569566063dSJacob Faibussowitsch     PetscCall(DMGetLocalSection(plexA, &sectionAux));
51573e9753d6SMatthew G. Knepley   }
51583e9753d6SMatthew G. Knepley 
51599566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dm, &globalSection));
51603e9753d6SMatthew G. Knepley   for (v = 0; v < numValues; ++v) {
51613e9753d6SMatthew G. Knepley     PetscFEGeom     *fgeom;
51623e9753d6SMatthew G. Knepley     PetscInt         maxDegree;
51633e9753d6SMatthew G. Knepley     PetscQuadrature  qGeom = NULL;
51643e9753d6SMatthew G. Knepley     IS               pointIS;
51653e9753d6SMatthew G. Knepley     const PetscInt  *points;
516606ad1575SMatthew G. Knepley     PetscFormKey key;
51673e9753d6SMatthew G. Knepley     PetscInt         numFaces, face, Nq;
51683e9753d6SMatthew G. Knepley 
516945480ffeSMatthew G. Knepley     key.label = label;
517045480ffeSMatthew G. Knepley     key.value = values[v];
517106ad1575SMatthew G. Knepley     key.part  = 0;
51729566063dSJacob Faibussowitsch     PetscCall(DMLabelGetStratumIS(label, values[v], &pointIS));
51733e9753d6SMatthew G. Knepley     if (!pointIS) continue; /* No points with that id on this process */
51743e9753d6SMatthew G. Knepley     {
51753e9753d6SMatthew G. Knepley       IS isectIS;
51763e9753d6SMatthew G. Knepley 
51773e9753d6SMatthew G. Knepley       /* TODO: Special cases of ISIntersect where it is quick to check a prior if one is a superset of the other */
51789566063dSJacob Faibussowitsch       PetscCall(ISIntersect_Caching_Internal(facetIS,pointIS,&isectIS));
51799566063dSJacob Faibussowitsch       PetscCall(ISDestroy(&pointIS));
51803e9753d6SMatthew G. Knepley       pointIS = isectIS;
51813e9753d6SMatthew G. Knepley     }
51829566063dSJacob Faibussowitsch     PetscCall(ISGetLocalSize(pointIS, &numFaces));
51839566063dSJacob Faibussowitsch     PetscCall(ISGetIndices(pointIS, &points));
51849566063dSJacob Faibussowitsch     PetscCall(PetscMalloc4(numFaces*totDim, &u, locX_t ? numFaces*totDim : 0, &u_t, numFaces*totDim*totDim, &elemMat, locA ? numFaces*totDimAux : 0, &a));
51859566063dSJacob Faibussowitsch     PetscCall(DMFieldGetDegree(coordField,pointIS,NULL,&maxDegree));
51863e9753d6SMatthew G. Knepley     if (maxDegree <= 1) {
51879566063dSJacob Faibussowitsch       PetscCall(DMFieldCreateDefaultQuadrature(coordField,pointIS,&qGeom));
51883e9753d6SMatthew G. Knepley     }
51893e9753d6SMatthew G. Knepley     if (!qGeom) {
51903e9753d6SMatthew G. Knepley       PetscFE fe;
51913e9753d6SMatthew G. Knepley 
51929566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(prob, fieldI, (PetscObject *) &fe));
51939566063dSJacob Faibussowitsch       PetscCall(PetscFEGetFaceQuadrature(fe, &qGeom));
51949566063dSJacob Faibussowitsch       PetscCall(PetscObjectReference((PetscObject)qGeom));
51953e9753d6SMatthew G. Knepley     }
51969566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureGetData(qGeom, NULL, NULL, &Nq, NULL, NULL));
51979566063dSJacob Faibussowitsch     PetscCall(DMSNESGetFEGeom(coordField,pointIS,qGeom,PETSC_TRUE,&fgeom));
51983e9753d6SMatthew G. Knepley     for (face = 0; face < numFaces; ++face) {
5199f15274beSMatthew Knepley       const PetscInt point = points[face], *support;
52003e9753d6SMatthew G. Knepley       PetscScalar   *x     = NULL;
5201f15274beSMatthew Knepley       PetscInt       i;
52023e9753d6SMatthew G. Knepley 
52039566063dSJacob Faibussowitsch       PetscCall(DMPlexGetSupport(dm, point, &support));
52049566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(plex, section, locX, support[0], NULL, &x));
52053e9753d6SMatthew G. Knepley       for (i = 0; i < totDim; ++i) u[face*totDim+i] = x[i];
52069566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(plex, section, locX, support[0], NULL, &x));
52073e9753d6SMatthew G. Knepley       if (locX_t) {
52089566063dSJacob Faibussowitsch         PetscCall(DMPlexVecGetClosure(plex, section, locX_t, support[0], NULL, &x));
52093e9753d6SMatthew G. Knepley         for (i = 0; i < totDim; ++i) u_t[face*totDim+i] = x[i];
52109566063dSJacob Faibussowitsch         PetscCall(DMPlexVecRestoreClosure(plex, section, locX_t, support[0], NULL, &x));
52113e9753d6SMatthew G. Knepley       }
52123e9753d6SMatthew G. Knepley       if (locA) {
52133e9753d6SMatthew G. Knepley         PetscInt subp;
52149566063dSJacob Faibussowitsch         PetscCall(DMGetEnclosurePoint(plexA, dm, encAux, support[0], &subp));
52159566063dSJacob Faibussowitsch         PetscCall(DMPlexVecGetClosure(plexA, sectionAux, locA, subp, NULL, &x));
52163e9753d6SMatthew G. Knepley         for (i = 0; i < totDimAux; ++i) a[face*totDimAux+i] = x[i];
52179566063dSJacob Faibussowitsch         PetscCall(DMPlexVecRestoreClosure(plexA, sectionAux, locA, subp, NULL, &x));
52183e9753d6SMatthew G. Knepley       }
52193e9753d6SMatthew G. Knepley     }
52209566063dSJacob Faibussowitsch     PetscCall(PetscArrayzero(elemMat, numFaces*totDim*totDim));
52213e9753d6SMatthew G. Knepley     {
52223e9753d6SMatthew G. Knepley       PetscFE         fe;
52233e9753d6SMatthew G. Knepley       PetscInt        Nb;
52243e9753d6SMatthew G. Knepley       /* Conforming batches */
52253e9753d6SMatthew G. Knepley       PetscInt        numChunks, numBatches, numBlocks, Ne, blockSize, batchSize;
52263e9753d6SMatthew G. Knepley       /* Remainder */
52273e9753d6SMatthew G. Knepley       PetscFEGeom    *chunkGeom = NULL;
52283e9753d6SMatthew G. Knepley       PetscInt        fieldJ, Nr, offset;
52293e9753d6SMatthew G. Knepley 
52309566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(prob, fieldI, (PetscObject *) &fe));
52319566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDimension(fe, &Nb));
52329566063dSJacob Faibussowitsch       PetscCall(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
52333e9753d6SMatthew G. Knepley       blockSize = Nb;
52343e9753d6SMatthew G. Knepley       batchSize = numBlocks * blockSize;
52359566063dSJacob Faibussowitsch       PetscCall(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
52363e9753d6SMatthew G. Knepley       numChunks = numFaces / (numBatches*batchSize);
52373e9753d6SMatthew G. Knepley       Ne        = numChunks*numBatches*batchSize;
52383e9753d6SMatthew G. Knepley       Nr        = numFaces % (numBatches*batchSize);
52393e9753d6SMatthew G. Knepley       offset    = numFaces - Nr;
52409566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomGetChunk(fgeom,0,offset,&chunkGeom));
52413e9753d6SMatthew G. Knepley       for (fieldJ = 0; fieldJ < Nf; ++fieldJ) {
524245480ffeSMatthew G. Knepley         key.field = fieldI*Nf+fieldJ;
52439566063dSJacob Faibussowitsch         PetscCall(PetscFEIntegrateBdJacobian(prob, wf, key, Ne, chunkGeom, u, u_t, probAux, a, t, X_tShift, elemMat));
52443e9753d6SMatthew G. Knepley       }
52459566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomGetChunk(fgeom,offset,numFaces,&chunkGeom));
52463e9753d6SMatthew G. Knepley       for (fieldJ = 0; fieldJ < Nf; ++fieldJ) {
524745480ffeSMatthew G. Knepley         key.field = fieldI*Nf+fieldJ;
52489566063dSJacob 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]));
52493e9753d6SMatthew G. Knepley       }
52509566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomRestoreChunk(fgeom,offset,numFaces,&chunkGeom));
52513e9753d6SMatthew G. Knepley     }
52523e9753d6SMatthew G. Knepley     for (face = 0; face < numFaces; ++face) {
52533e9753d6SMatthew G. Knepley       const PetscInt point = points[face], *support;
52543e9753d6SMatthew G. Knepley 
52553e9753d6SMatthew G. Knepley       /* Transform to global basis before insertion in Jacobian */
52569566063dSJacob Faibussowitsch       PetscCall(DMPlexGetSupport(plex, point, &support));
52579566063dSJacob Faibussowitsch       if (transform) PetscCall(DMPlexBasisTransformPointTensor_Internal(dm, tdm, tv, support[0], PETSC_TRUE, totDim, &elemMat[face*totDim*totDim]));
52589566063dSJacob Faibussowitsch       if (mesh->printFEM > 1) PetscCall(DMPrintCellMatrix(point, "BdJacobian", totDim, totDim, &elemMat[face*totDim*totDim]));
52599566063dSJacob Faibussowitsch       PetscCall(DMPlexMatSetClosure(plex, section, globalSection, JacP, support[0], &elemMat[face*totDim*totDim], ADD_VALUES));
52603e9753d6SMatthew G. Knepley     }
52619566063dSJacob Faibussowitsch     PetscCall(DMSNESRestoreFEGeom(coordField,pointIS,qGeom,PETSC_TRUE,&fgeom));
52629566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureDestroy(&qGeom));
52639566063dSJacob Faibussowitsch     PetscCall(ISRestoreIndices(pointIS, &points));
52649566063dSJacob Faibussowitsch     PetscCall(ISDestroy(&pointIS));
52659566063dSJacob Faibussowitsch     PetscCall(PetscFree4(u, u_t, elemMat, a));
52663e9753d6SMatthew G. Knepley   }
52679566063dSJacob Faibussowitsch   if (plex)  PetscCall(DMDestroy(&plex));
52689566063dSJacob Faibussowitsch   if (plexA) PetscCall(DMDestroy(&plexA));
52693e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
52703e9753d6SMatthew G. Knepley }
52713e9753d6SMatthew G. Knepley 
527245480ffeSMatthew 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)
52733e9753d6SMatthew G. Knepley {
52743e9753d6SMatthew G. Knepley   DMField        coordField;
52753e9753d6SMatthew G. Knepley   DMLabel        depthLabel;
52763e9753d6SMatthew G. Knepley   IS             facetIS;
52773e9753d6SMatthew G. Knepley   PetscInt       dim;
52783e9753d6SMatthew G. Knepley 
52793e9753d6SMatthew G. Knepley   PetscFunctionBegin;
52809566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
52819566063dSJacob Faibussowitsch   PetscCall(DMPlexGetDepthLabel(dm, &depthLabel));
52829566063dSJacob Faibussowitsch   PetscCall(DMLabelGetStratumIS(depthLabel, dim-1, &facetIS));
52839566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateField(dm, &coordField));
52849566063dSJacob Faibussowitsch   PetscCall(DMPlexComputeBdJacobian_Single_Internal(dm, t, wf, label, numValues, values, field, locX, locX_t, X_tShift, Jac, JacP, coordField, facetIS));
52859566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&facetIS));
52863e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
52873e9753d6SMatthew G. Knepley }
52883e9753d6SMatthew G. Knepley 
52893e9753d6SMatthew G. Knepley PetscErrorCode DMPlexComputeBdJacobian_Internal(DM dm, Vec locX, Vec locX_t, PetscReal t, PetscReal X_tShift, Mat Jac, Mat JacP, void *user)
52903e9753d6SMatthew G. Knepley {
52913e9753d6SMatthew G. Knepley   PetscDS          prob;
52923e9753d6SMatthew G. Knepley   PetscInt         dim, numBd, bd;
52933e9753d6SMatthew G. Knepley   DMLabel          depthLabel;
52943e9753d6SMatthew G. Knepley   DMField          coordField = NULL;
52953e9753d6SMatthew G. Knepley   IS               facetIS;
52963e9753d6SMatthew G. Knepley 
52973e9753d6SMatthew G. Knepley   PetscFunctionBegin;
52989566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dm, &prob));
52999566063dSJacob Faibussowitsch   PetscCall(DMPlexGetDepthLabel(dm, &depthLabel));
53009566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
53019566063dSJacob Faibussowitsch   PetscCall(DMLabelGetStratumIS(depthLabel, dim-1, &facetIS));
53029566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumBoundary(prob, &numBd));
53039566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateField(dm, &coordField));
53043e9753d6SMatthew G. Knepley   for (bd = 0; bd < numBd; ++bd) {
530545480ffeSMatthew G. Knepley     PetscWeakForm           wf;
53063e9753d6SMatthew G. Knepley     DMBoundaryConditionType type;
53073e9753d6SMatthew G. Knepley     DMLabel                 label;
53083e9753d6SMatthew G. Knepley     const PetscInt         *values;
53093e9753d6SMatthew G. Knepley     PetscInt                fieldI, numValues;
53103e9753d6SMatthew G. Knepley     PetscObject             obj;
53113e9753d6SMatthew G. Knepley     PetscClassId            id;
53123e9753d6SMatthew G. Knepley 
53139566063dSJacob Faibussowitsch     PetscCall(PetscDSGetBoundary(prob, bd, &wf, &type, NULL, &label, &numValues, &values, &fieldI, NULL, NULL, NULL, NULL, NULL));
53149566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, fieldI, &obj));
53159566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
53163e9753d6SMatthew G. Knepley     if ((id != PETSCFE_CLASSID) || (type & DM_BC_ESSENTIAL)) continue;
53179566063dSJacob Faibussowitsch     PetscCall(DMPlexComputeBdJacobian_Single_Internal(dm, t, wf, label, numValues, values, fieldI, locX, locX_t, X_tShift, Jac, JacP, coordField, facetIS));
53183e9753d6SMatthew G. Knepley   }
53199566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&facetIS));
53203e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
53213e9753d6SMatthew G. Knepley }
53223e9753d6SMatthew G. Knepley 
532306ad1575SMatthew 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)
53243e9753d6SMatthew G. Knepley {
53253e9753d6SMatthew G. Knepley   DM_Plex        *mesh  = (DM_Plex *) dm->data;
53263e9753d6SMatthew G. Knepley   const char     *name  = "Jacobian";
53279a2a23afSMatthew G. Knepley   DM              dmAux = NULL, plex, tdm;
53283e9753d6SMatthew G. Knepley   DMEnclosureType encAux;
53293e9753d6SMatthew G. Knepley   Vec             A, tv;
53303e9753d6SMatthew G. Knepley   DMField         coordField;
53313e9753d6SMatthew G. Knepley   PetscDS         prob, probAux = NULL;
5332e432b41dSStefano Zampini   PetscSection    section, globalSection, sectionAux;
53333e9753d6SMatthew G. Knepley   PetscScalar    *elemMat, *elemMatP, *elemMatD, *u, *u_t, *a = NULL;
53343e9753d6SMatthew G. Knepley   const PetscInt *cells;
53353e9753d6SMatthew G. Knepley   PetscInt        Nf, fieldI, fieldJ;
53363e9753d6SMatthew G. Knepley   PetscInt        totDim, totDimAux, cStart, cEnd, numCells, c;
5337e432b41dSStefano Zampini   PetscBool       hasJac, hasPrec, hasDyn, hasFV = PETSC_FALSE, transform;
53383e9753d6SMatthew G. Knepley 
53393e9753d6SMatthew G. Knepley   PetscFunctionBegin;
53409566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_JacobianFEM,dm,0,0,0));
53419566063dSJacob Faibussowitsch   PetscCall(ISGetLocalSize(cellIS, &numCells));
53429566063dSJacob Faibussowitsch   PetscCall(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
53439566063dSJacob Faibussowitsch   PetscCall(DMHasBasisTransform(dm, &transform));
53449566063dSJacob Faibussowitsch   PetscCall(DMGetBasisTransformDM_Internal(dm, &tdm));
53459566063dSJacob Faibussowitsch   PetscCall(DMGetBasisTransformVec_Internal(dm, &tv));
53469566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
53479566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dm, &globalSection));
53489566063dSJacob Faibussowitsch   PetscCall(DMGetCellDS(dm, cells ? cells[cStart] : cStart, &prob));
53499566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumFields(prob, &Nf));
53509566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(prob, &totDim));
53519566063dSJacob Faibussowitsch   PetscCall(PetscDSHasJacobian(prob, &hasJac));
53529566063dSJacob Faibussowitsch   PetscCall(PetscDSHasJacobianPreconditioner(prob, &hasPrec));
53533e9753d6SMatthew G. Knepley   /* user passed in the same matrix, avoid double contributions and
53543e9753d6SMatthew G. Knepley      only assemble the Jacobian */
53553e9753d6SMatthew G. Knepley   if (hasJac && Jac == JacP) hasPrec = PETSC_FALSE;
53569566063dSJacob Faibussowitsch   PetscCall(PetscDSHasDynamicJacobian(prob, &hasDyn));
53573e9753d6SMatthew G. Knepley   hasDyn = hasDyn && (X_tShift != 0.0) ? PETSC_TRUE : PETSC_FALSE;
53589566063dSJacob Faibussowitsch   PetscCall(DMGetAuxiliaryVec(dm, key.label, key.value, key.part, &A));
53599a2a23afSMatthew G. Knepley   if (A) {
53609566063dSJacob Faibussowitsch     PetscCall(VecGetDM(A, &dmAux));
53619566063dSJacob Faibussowitsch     PetscCall(DMGetEnclosureRelation(dmAux, dm, &encAux));
53629566063dSJacob Faibussowitsch     PetscCall(DMConvert(dmAux, DMPLEX, &plex));
53639566063dSJacob Faibussowitsch     PetscCall(DMGetLocalSection(plex, &sectionAux));
53649566063dSJacob Faibussowitsch     PetscCall(DMGetDS(dmAux, &probAux));
53659566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalDimension(probAux, &totDimAux));
53663e9753d6SMatthew G. Knepley   }
53679566063dSJacob 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));
53689566063dSJacob Faibussowitsch   if (dmAux) PetscCall(PetscMalloc1(numCells*totDimAux, &a));
53699566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateField(dm, &coordField));
53703e9753d6SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
53713e9753d6SMatthew G. Knepley     const PetscInt cell = cells ? cells[c] : c;
53723e9753d6SMatthew G. Knepley     const PetscInt cind = c - cStart;
53733e9753d6SMatthew G. Knepley     PetscScalar   *x = NULL,  *x_t = NULL;
53743e9753d6SMatthew G. Knepley     PetscInt       i;
53753e9753d6SMatthew G. Knepley 
53769566063dSJacob Faibussowitsch     PetscCall(DMPlexVecGetClosure(dm, section, X, cell, NULL, &x));
53773e9753d6SMatthew G. Knepley     for (i = 0; i < totDim; ++i) u[cind*totDim+i] = x[i];
53789566063dSJacob Faibussowitsch     PetscCall(DMPlexVecRestoreClosure(dm, section, X, cell, NULL, &x));
53793e9753d6SMatthew G. Knepley     if (X_t) {
53809566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(dm, section, X_t, cell, NULL, &x_t));
53813e9753d6SMatthew G. Knepley       for (i = 0; i < totDim; ++i) u_t[cind*totDim+i] = x_t[i];
53829566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(dm, section, X_t, cell, NULL, &x_t));
53833e9753d6SMatthew G. Knepley     }
53843e9753d6SMatthew G. Knepley     if (dmAux) {
53853e9753d6SMatthew G. Knepley       PetscInt subcell;
53869566063dSJacob Faibussowitsch       PetscCall(DMGetEnclosurePoint(dmAux, dm, encAux, cell, &subcell));
53879566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(plex, sectionAux, A, subcell, NULL, &x));
53883e9753d6SMatthew G. Knepley       for (i = 0; i < totDimAux; ++i) a[cind*totDimAux+i] = x[i];
53899566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(plex, sectionAux, A, subcell, NULL, &x));
53903e9753d6SMatthew G. Knepley     }
53913e9753d6SMatthew G. Knepley   }
53929566063dSJacob Faibussowitsch   if (hasJac)  PetscCall(PetscArrayzero(elemMat,  numCells*totDim*totDim));
53939566063dSJacob Faibussowitsch   if (hasPrec) PetscCall(PetscArrayzero(elemMatP, numCells*totDim*totDim));
53949566063dSJacob Faibussowitsch   if (hasDyn)  PetscCall(PetscArrayzero(elemMatD, numCells*totDim*totDim));
53953e9753d6SMatthew G. Knepley   for (fieldI = 0; fieldI < Nf; ++fieldI) {
53963e9753d6SMatthew G. Knepley     PetscClassId    id;
53973e9753d6SMatthew G. Knepley     PetscFE         fe;
53983e9753d6SMatthew G. Knepley     PetscQuadrature qGeom = NULL;
53993e9753d6SMatthew G. Knepley     PetscInt        Nb;
54003e9753d6SMatthew G. Knepley     /* Conforming batches */
54013e9753d6SMatthew G. Knepley     PetscInt        numChunks, numBatches, numBlocks, Ne, blockSize, batchSize;
54023e9753d6SMatthew G. Knepley     /* Remainder */
54033e9753d6SMatthew G. Knepley     PetscInt        Nr, offset, Nq;
54043e9753d6SMatthew G. Knepley     PetscInt        maxDegree;
54053e9753d6SMatthew G. Knepley     PetscFEGeom     *cgeomFEM, *chunkGeom = NULL, *remGeom = NULL;
54063e9753d6SMatthew G. Knepley 
54079566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, fieldI, (PetscObject *) &fe));
54089566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId((PetscObject) fe, &id));
54093e9753d6SMatthew G. Knepley     if (id == PETSCFV_CLASSID) {hasFV = PETSC_TRUE; continue;}
54109566063dSJacob Faibussowitsch     PetscCall(PetscFEGetDimension(fe, &Nb));
54119566063dSJacob Faibussowitsch     PetscCall(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
54129566063dSJacob Faibussowitsch     PetscCall(DMFieldGetDegree(coordField,cellIS,NULL,&maxDegree));
54133e9753d6SMatthew G. Knepley     if (maxDegree <= 1) {
54149566063dSJacob Faibussowitsch       PetscCall(DMFieldCreateDefaultQuadrature(coordField,cellIS,&qGeom));
54153e9753d6SMatthew G. Knepley     }
54163e9753d6SMatthew G. Knepley     if (!qGeom) {
54179566063dSJacob Faibussowitsch       PetscCall(PetscFEGetQuadrature(fe,&qGeom));
54189566063dSJacob Faibussowitsch       PetscCall(PetscObjectReference((PetscObject)qGeom));
54193e9753d6SMatthew G. Knepley     }
54209566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureGetData(qGeom, NULL, NULL, &Nq, NULL, NULL));
54219566063dSJacob Faibussowitsch     PetscCall(DMSNESGetFEGeom(coordField,cellIS,qGeom,PETSC_FALSE,&cgeomFEM));
54223e9753d6SMatthew G. Knepley     blockSize = Nb;
54233e9753d6SMatthew G. Knepley     batchSize = numBlocks * blockSize;
54249566063dSJacob Faibussowitsch     PetscCall(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
54253e9753d6SMatthew G. Knepley     numChunks = numCells / (numBatches*batchSize);
54263e9753d6SMatthew G. Knepley     Ne        = numChunks*numBatches*batchSize;
54273e9753d6SMatthew G. Knepley     Nr        = numCells % (numBatches*batchSize);
54283e9753d6SMatthew G. Knepley     offset    = numCells - Nr;
54299566063dSJacob Faibussowitsch     PetscCall(PetscFEGeomGetChunk(cgeomFEM,0,offset,&chunkGeom));
54309566063dSJacob Faibussowitsch     PetscCall(PetscFEGeomGetChunk(cgeomFEM,offset,numCells,&remGeom));
54313e9753d6SMatthew G. Knepley     for (fieldJ = 0; fieldJ < Nf; ++fieldJ) {
54326528b96dSMatthew G. Knepley       key.field = fieldI*Nf+fieldJ;
54333e9753d6SMatthew G. Knepley       if (hasJac) {
54349566063dSJacob Faibussowitsch         PetscCall(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN, key, Ne, chunkGeom, u, u_t, probAux, a, t, X_tShift, elemMat));
54359566063dSJacob 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]));
54363e9753d6SMatthew G. Knepley       }
54373e9753d6SMatthew G. Knepley       if (hasPrec) {
54389566063dSJacob Faibussowitsch         PetscCall(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN_PRE, key, Ne, chunkGeom, u, u_t, probAux, a, t, X_tShift, elemMatP));
54399566063dSJacob 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]));
54403e9753d6SMatthew G. Knepley       }
54413e9753d6SMatthew G. Knepley       if (hasDyn) {
54429566063dSJacob Faibussowitsch         PetscCall(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN_DYN, key, Ne, chunkGeom, u, u_t, probAux, a, t, X_tShift, elemMatD));
54439566063dSJacob 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]));
54443e9753d6SMatthew G. Knepley       }
54453e9753d6SMatthew G. Knepley     }
54469566063dSJacob Faibussowitsch     PetscCall(PetscFEGeomRestoreChunk(cgeomFEM,offset,numCells,&remGeom));
54479566063dSJacob Faibussowitsch     PetscCall(PetscFEGeomRestoreChunk(cgeomFEM,0,offset,&chunkGeom));
54489566063dSJacob Faibussowitsch     PetscCall(DMSNESRestoreFEGeom(coordField,cellIS,qGeom,PETSC_FALSE,&cgeomFEM));
54499566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureDestroy(&qGeom));
54503e9753d6SMatthew G. Knepley   }
54513e9753d6SMatthew G. Knepley   /*   Add contribution from X_t */
54523e9753d6SMatthew G. Knepley   if (hasDyn) {for (c = 0; c < numCells*totDim*totDim; ++c) elemMat[c] += X_tShift*elemMatD[c];}
54533e9753d6SMatthew G. Knepley   if (hasFV) {
54543e9753d6SMatthew G. Knepley     PetscClassId id;
54553e9753d6SMatthew G. Knepley     PetscFV      fv;
54563e9753d6SMatthew G. Knepley     PetscInt     offsetI, NcI, NbI = 1, fc, f;
54573e9753d6SMatthew G. Knepley 
54583e9753d6SMatthew G. Knepley     for (fieldI = 0; fieldI < Nf; ++fieldI) {
54599566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(prob, fieldI, (PetscObject *) &fv));
54609566063dSJacob Faibussowitsch       PetscCall(PetscDSGetFieldOffset(prob, fieldI, &offsetI));
54619566063dSJacob Faibussowitsch       PetscCall(PetscObjectGetClassId((PetscObject) fv, &id));
54623e9753d6SMatthew G. Knepley       if (id != PETSCFV_CLASSID) continue;
54633e9753d6SMatthew G. Knepley       /* Put in the identity */
54649566063dSJacob Faibussowitsch       PetscCall(PetscFVGetNumComponents(fv, &NcI));
54653e9753d6SMatthew G. Knepley       for (c = cStart; c < cEnd; ++c) {
54663e9753d6SMatthew G. Knepley         const PetscInt cind    = c - cStart;
54673e9753d6SMatthew G. Knepley         const PetscInt eOffset = cind*totDim*totDim;
54683e9753d6SMatthew G. Knepley         for (fc = 0; fc < NcI; ++fc) {
54693e9753d6SMatthew G. Knepley           for (f = 0; f < NbI; ++f) {
54703e9753d6SMatthew G. Knepley             const PetscInt i = offsetI + f*NcI+fc;
54713e9753d6SMatthew G. Knepley             if (hasPrec) {
54723e9753d6SMatthew G. Knepley               if (hasJac) {elemMat[eOffset+i*totDim+i] = 1.0;}
54733e9753d6SMatthew G. Knepley               elemMatP[eOffset+i*totDim+i] = 1.0;
54743e9753d6SMatthew G. Knepley             } else {elemMat[eOffset+i*totDim+i] = 1.0;}
54753e9753d6SMatthew G. Knepley           }
54763e9753d6SMatthew G. Knepley         }
54773e9753d6SMatthew G. Knepley       }
54783e9753d6SMatthew G. Knepley     }
54793e9753d6SMatthew G. Knepley     /* No allocated space for FV stuff, so ignore the zero entries */
54809566063dSJacob Faibussowitsch     PetscCall(MatSetOption(JacP, MAT_IGNORE_ZERO_ENTRIES, PETSC_TRUE));
54813e9753d6SMatthew G. Knepley   }
54823e9753d6SMatthew G. Knepley   /* Insert values into matrix */
54833e9753d6SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
54843e9753d6SMatthew G. Knepley     const PetscInt cell = cells ? cells[c] : c;
54853e9753d6SMatthew G. Knepley     const PetscInt cind = c - cStart;
54863e9753d6SMatthew G. Knepley 
54873e9753d6SMatthew G. Knepley     /* Transform to global basis before insertion in Jacobian */
54889566063dSJacob Faibussowitsch     if (transform) PetscCall(DMPlexBasisTransformPointTensor_Internal(dm, tdm, tv, cell, PETSC_TRUE, totDim, &elemMat[cind*totDim*totDim]));
54893e9753d6SMatthew G. Knepley     if (hasPrec) {
54903e9753d6SMatthew G. Knepley       if (hasJac) {
54919566063dSJacob Faibussowitsch         if (mesh->printFEM > 1) PetscCall(DMPrintCellMatrix(cell, name, totDim, totDim, &elemMat[cind*totDim*totDim]));
54929566063dSJacob Faibussowitsch         PetscCall(DMPlexMatSetClosure(dm, section, globalSection, Jac, cell, &elemMat[cind*totDim*totDim], ADD_VALUES));
54933e9753d6SMatthew G. Knepley       }
54949566063dSJacob Faibussowitsch       if (mesh->printFEM > 1) PetscCall(DMPrintCellMatrix(cell, name, totDim, totDim, &elemMatP[cind*totDim*totDim]));
54959566063dSJacob Faibussowitsch       PetscCall(DMPlexMatSetClosure(dm, section, globalSection, JacP, cell, &elemMatP[cind*totDim*totDim], ADD_VALUES));
54963e9753d6SMatthew G. Knepley     } else {
54973e9753d6SMatthew G. Knepley       if (hasJac) {
54989566063dSJacob Faibussowitsch         if (mesh->printFEM > 1) PetscCall(DMPrintCellMatrix(cell, name, totDim, totDim, &elemMat[cind*totDim*totDim]));
54999566063dSJacob Faibussowitsch         PetscCall(DMPlexMatSetClosure(dm, section, globalSection, JacP, cell, &elemMat[cind*totDim*totDim], ADD_VALUES));
55003e9753d6SMatthew G. Knepley       }
55013e9753d6SMatthew G. Knepley     }
55023e9753d6SMatthew G. Knepley   }
55039566063dSJacob Faibussowitsch   PetscCall(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
55049566063dSJacob Faibussowitsch   if (hasFV) PetscCall(MatSetOption(JacP, MAT_IGNORE_ZERO_ENTRIES, PETSC_FALSE));
55059566063dSJacob Faibussowitsch   PetscCall(PetscFree5(u,u_t,elemMat,elemMatP,elemMatD));
55063e9753d6SMatthew G. Knepley   if (dmAux) {
55079566063dSJacob Faibussowitsch     PetscCall(PetscFree(a));
55089566063dSJacob Faibussowitsch     PetscCall(DMDestroy(&plex));
55093e9753d6SMatthew G. Knepley   }
55103e9753d6SMatthew G. Knepley   /* Compute boundary integrals */
55119566063dSJacob Faibussowitsch   PetscCall(DMPlexComputeBdJacobian_Internal(dm, X, X_t, t, X_tShift, Jac, JacP, user));
55123e9753d6SMatthew G. Knepley   /* Assemble matrix */
55133e9753d6SMatthew G. Knepley   if (hasJac && hasPrec) {
55149566063dSJacob Faibussowitsch     PetscCall(MatAssemblyBegin(Jac, MAT_FINAL_ASSEMBLY));
55159566063dSJacob Faibussowitsch     PetscCall(MatAssemblyEnd(Jac, MAT_FINAL_ASSEMBLY));
55163e9753d6SMatthew G. Knepley   }
55179566063dSJacob Faibussowitsch   PetscCall(MatAssemblyBegin(JacP, MAT_FINAL_ASSEMBLY));
55189566063dSJacob Faibussowitsch   PetscCall(MatAssemblyEnd(JacP, MAT_FINAL_ASSEMBLY));
55199566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_JacobianFEM,dm,0,0,0));
55203e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
55213e9753d6SMatthew G. Knepley }
55223e9753d6SMatthew G. Knepley 
552306ad1575SMatthew 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)
55243e9753d6SMatthew G. Knepley {
55253e9753d6SMatthew G. Knepley   DM_Plex         *mesh          = (DM_Plex *) dm->data;
55263e9753d6SMatthew G. Knepley   const char      *name          = "Hybrid Jacobian";
5527148442b3SMatthew G. Knepley   DM               dmAux[3]      = {NULL, NULL, NULL};
5528148442b3SMatthew G. Knepley   DMLabel          ghostLabel    = NULL;
55293e9753d6SMatthew G. Knepley   DM               plex          = NULL;
55303e9753d6SMatthew G. Knepley   DM               plexA         = NULL;
5531148442b3SMatthew G. Knepley   PetscDS          ds            = NULL;
5532148442b3SMatthew G. Knepley   PetscDS          dsAux[3]      = {NULL, NULL, NULL};
5533148442b3SMatthew G. Knepley   Vec              locA[3]       = {NULL, NULL, NULL};
55343e9753d6SMatthew G. Knepley   PetscSection     section       = NULL;
5535148442b3SMatthew G. Knepley   PetscSection     sectionAux[3] = {NULL, NULL, NULL};
55363e9753d6SMatthew G. Knepley   DMField          coordField    = NULL;
5537148442b3SMatthew G. Knepley   PetscScalar     *u = NULL, *u_t, *a[3];
55383e9753d6SMatthew G. Knepley   PetscScalar     *elemMat, *elemMatP;
5539e432b41dSStefano Zampini   PetscSection     globalSection;
55403e9753d6SMatthew G. Knepley   IS               chunkIS;
55413e9753d6SMatthew G. Knepley   const PetscInt  *cells;
55423e9753d6SMatthew G. Knepley   PetscInt        *faces;
55433e9753d6SMatthew G. Knepley   PetscInt         cStart, cEnd, numCells;
5544148442b3SMatthew G. Knepley   PetscInt         Nf, fieldI, fieldJ, totDim, totDimAux[3], numChunks, cellChunkSize, chunk;
55453e9753d6SMatthew G. Knepley   PetscInt         maxDegree = PETSC_MAX_INT;
55463e9753d6SMatthew G. Knepley   PetscQuadrature  affineQuad = NULL, *quads = NULL;
55473e9753d6SMatthew G. Knepley   PetscFEGeom     *affineGeom = NULL, **geoms = NULL;
5548e432b41dSStefano Zampini   PetscBool        hasBdJac, hasBdPrec;
55493e9753d6SMatthew G. Knepley 
55503e9753d6SMatthew G. Knepley   PetscFunctionBegin;
55515fedec97SMatthew G. Knepley   if ((key[0].label == key[1].label) && (key[0].value == key[1].value) && (key[0].part == key[1].part)) {
55525fedec97SMatthew G. Knepley     const char *name;
55539566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetName((PetscObject) key[0].label, &name));
555498921bdaSJacob Faibussowitsch     SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Form keys for each side of a cohesive surface must be different (%s, %D, %D)", name, key[0].value, key[0].part);
55555fedec97SMatthew G. Knepley   }
55569566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_JacobianFEM,dm,0,0,0));
55579566063dSJacob Faibussowitsch   PetscCall(ISGetLocalSize(cellIS, &numCells));
55589566063dSJacob Faibussowitsch   PetscCall(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
55599566063dSJacob Faibussowitsch   PetscCall(DMConvert(dm, DMPLEX, &plex));
55609566063dSJacob Faibussowitsch   PetscCall(DMGetSection(dm, &section));
55619566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dm, &globalSection));
55629566063dSJacob Faibussowitsch   PetscCall(DMGetLabel(dm, "ghost", &ghostLabel));
55639566063dSJacob Faibussowitsch   PetscCall(DMGetCellDS(dm, cStart, &ds));
55649566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumFields(ds, &Nf));
55659566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(ds, &totDim));
55669566063dSJacob Faibussowitsch   PetscCall(PetscDSHasBdJacobian(ds, &hasBdJac));
55679566063dSJacob Faibussowitsch   PetscCall(PetscDSHasBdJacobianPreconditioner(ds, &hasBdPrec));
55689566063dSJacob Faibussowitsch   PetscCall(DMGetAuxiliaryVec(dm, key[2].label, key[2].value, key[2].part, &locA[2]));
5569148442b3SMatthew G. Knepley   if (locA[2]) {
55709566063dSJacob Faibussowitsch     PetscCall(VecGetDM(locA[2], &dmAux[2]));
55719566063dSJacob Faibussowitsch     PetscCall(DMConvert(dmAux[2], DMPLEX, &plexA));
55729566063dSJacob Faibussowitsch     PetscCall(DMGetSection(dmAux[2], &sectionAux[2]));
55739566063dSJacob Faibussowitsch     PetscCall(DMGetCellDS(dmAux[2], cStart, &dsAux[2]));
55749566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalDimension(dsAux[2], &totDimAux[2]));
5575148442b3SMatthew G. Knepley     {
5576148442b3SMatthew G. Knepley       const PetscInt *cone;
5577148442b3SMatthew G. Knepley       PetscInt        c;
5578148442b3SMatthew G. Knepley 
55799566063dSJacob Faibussowitsch       PetscCall(DMPlexGetCone(dm, cStart, &cone));
5580148442b3SMatthew G. Knepley       for (c = 0; c < 2; ++c) {
5581148442b3SMatthew G. Knepley         const PetscInt *support;
5582148442b3SMatthew G. Knepley         PetscInt ssize, s;
5583148442b3SMatthew G. Knepley 
55849566063dSJacob Faibussowitsch         PetscCall(DMPlexGetSupport(dm, cone[c], &support));
55859566063dSJacob Faibussowitsch         PetscCall(DMPlexGetSupportSize(dm, cone[c], &ssize));
55865f80ce2aSJacob Faibussowitsch         PetscCheck(ssize == 2,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Face %D from cell %D has support size %D != 2", cone[c], cStart, ssize);
5587148442b3SMatthew G. Knepley         if      (support[0] == cStart) s = 1;
5588148442b3SMatthew G. Knepley         else if (support[1] == cStart) s = 0;
558998921bdaSJacob Faibussowitsch         else SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Face %D does not have cell %D in its support", cone[c], cStart);
55909566063dSJacob Faibussowitsch         PetscCall(DMGetAuxiliaryVec(dm, key[c].label, key[c].value, key[c].part, &locA[c]));
55919566063dSJacob Faibussowitsch         if (locA[c]) PetscCall(VecGetDM(locA[c], &dmAux[c]));
5592148442b3SMatthew G. Knepley         else         {dmAux[c] = dmAux[2];}
55939566063dSJacob Faibussowitsch         PetscCall(DMGetCellDS(dmAux[c], support[s], &dsAux[c]));
55949566063dSJacob Faibussowitsch         PetscCall(PetscDSGetTotalDimension(dsAux[c], &totDimAux[c]));
5595148442b3SMatthew G. Knepley       }
5596148442b3SMatthew G. Knepley     }
55973e9753d6SMatthew G. Knepley   }
55989566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateField(dm, &coordField));
55999566063dSJacob Faibussowitsch   PetscCall(DMFieldGetDegree(coordField, cellIS, NULL, &maxDegree));
56003e9753d6SMatthew G. Knepley   if (maxDegree > 1) {
56013e9753d6SMatthew G. Knepley     PetscInt f;
56029566063dSJacob Faibussowitsch     PetscCall(PetscCalloc2(Nf, &quads, Nf, &geoms));
56033e9753d6SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
56043e9753d6SMatthew G. Knepley       PetscFE fe;
56053e9753d6SMatthew G. Knepley 
56069566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(ds, f, (PetscObject *) &fe));
56073e9753d6SMatthew G. Knepley       if (fe) {
56089566063dSJacob Faibussowitsch         PetscCall(PetscFEGetQuadrature(fe, &quads[f]));
56099566063dSJacob Faibussowitsch         PetscCall(PetscObjectReference((PetscObject) quads[f]));
56103e9753d6SMatthew G. Knepley       }
56113e9753d6SMatthew G. Knepley     }
56123e9753d6SMatthew G. Knepley   }
56133e9753d6SMatthew G. Knepley   cellChunkSize = numCells;
56143e9753d6SMatthew G. Knepley   numChunks     = !numCells ? 0 : PetscCeilReal(((PetscReal) numCells)/cellChunkSize);
56159566063dSJacob Faibussowitsch   PetscCall(PetscCalloc1(2*cellChunkSize, &faces));
56169566063dSJacob Faibussowitsch   PetscCall(ISCreateGeneral(PETSC_COMM_SELF, cellChunkSize, faces, PETSC_USE_POINTER, &chunkIS));
56179566063dSJacob Faibussowitsch   PetscCall(DMPlexGetCellFields(dm, cellIS, locX, locX_t, locA[2], &u, &u_t, &a[2]));
56189566063dSJacob Faibussowitsch   PetscCall(DMPlexGetHybridAuxFields(dm, dmAux, dsAux, cellIS, locA, a));
56199566063dSJacob Faibussowitsch   PetscCall(DMGetWorkArray(dm, hasBdJac  ? cellChunkSize*totDim*totDim : 0, MPIU_SCALAR, &elemMat));
56209566063dSJacob Faibussowitsch   PetscCall(DMGetWorkArray(dm, hasBdPrec ? cellChunkSize*totDim*totDim : 0, MPIU_SCALAR, &elemMatP));
56213e9753d6SMatthew G. Knepley   for (chunk = 0; chunk < numChunks; ++chunk) {
56223e9753d6SMatthew G. Knepley     PetscInt cS = cStart+chunk*cellChunkSize, cE = PetscMin(cS+cellChunkSize, cEnd), numCells = cE - cS, c;
56233e9753d6SMatthew G. Knepley 
56249566063dSJacob Faibussowitsch     if (hasBdJac)  PetscCall(PetscMemzero(elemMat,  numCells*totDim*totDim * sizeof(PetscScalar)));
56259566063dSJacob Faibussowitsch     if (hasBdPrec) PetscCall(PetscMemzero(elemMatP, numCells*totDim*totDim * sizeof(PetscScalar)));
56263e9753d6SMatthew G. Knepley     /* Get faces */
56273e9753d6SMatthew G. Knepley     for (c = cS; c < cE; ++c) {
56283e9753d6SMatthew G. Knepley       const PetscInt  cell = cells ? cells[c] : c;
56293e9753d6SMatthew G. Knepley       const PetscInt *cone;
56309566063dSJacob Faibussowitsch       PetscCall(DMPlexGetCone(plex, cell, &cone));
56313e9753d6SMatthew G. Knepley       faces[(c-cS)*2+0] = cone[0];
56323e9753d6SMatthew G. Knepley       faces[(c-cS)*2+1] = cone[1];
56333e9753d6SMatthew G. Knepley     }
56349566063dSJacob Faibussowitsch     PetscCall(ISGeneralSetIndices(chunkIS, cellChunkSize, faces, PETSC_USE_POINTER));
56353e9753d6SMatthew G. Knepley     if (maxDegree <= 1) {
56369566063dSJacob Faibussowitsch       if (!affineQuad) PetscCall(DMFieldCreateDefaultQuadrature(coordField, chunkIS, &affineQuad));
56379566063dSJacob Faibussowitsch       if (affineQuad)  PetscCall(DMSNESGetFEGeom(coordField, chunkIS, affineQuad, PETSC_TRUE, &affineGeom));
56383e9753d6SMatthew G. Knepley     } else {
56393e9753d6SMatthew G. Knepley       PetscInt f;
56403e9753d6SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
56419566063dSJacob Faibussowitsch         if (quads[f]) PetscCall(DMSNESGetFEGeom(coordField, chunkIS, quads[f], PETSC_TRUE, &geoms[f]));
56423e9753d6SMatthew G. Knepley       }
56433e9753d6SMatthew G. Knepley     }
56443e9753d6SMatthew G. Knepley 
56453e9753d6SMatthew G. Knepley     for (fieldI = 0; fieldI < Nf; ++fieldI) {
56463e9753d6SMatthew G. Knepley       PetscFE         feI;
56473e9753d6SMatthew G. Knepley       PetscFEGeom    *geom = affineGeom ? affineGeom : geoms[fieldI];
56483e9753d6SMatthew G. Knepley       PetscFEGeom    *chunkGeom = NULL, *remGeom = NULL;
56493e9753d6SMatthew G. Knepley       PetscQuadrature quad = affineQuad ? affineQuad : quads[fieldI];
56503e9753d6SMatthew G. Knepley       PetscInt        numChunks, numBatches, batchSize, numBlocks, blockSize, Ne, Nr, offset, Nq, Nb;
56515fedec97SMatthew G. Knepley       PetscBool       isCohesiveField;
56523e9753d6SMatthew G. Knepley 
56539566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(ds, fieldI, (PetscObject *) &feI));
56543e9753d6SMatthew G. Knepley       if (!feI) continue;
56559566063dSJacob Faibussowitsch       PetscCall(PetscFEGetTileSizes(feI, NULL, &numBlocks, NULL, &numBatches));
56569566063dSJacob Faibussowitsch       PetscCall(PetscQuadratureGetData(quad, NULL, NULL, &Nq, NULL, NULL));
56579566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDimension(feI, &Nb));
56583e9753d6SMatthew G. Knepley       blockSize = Nb;
56593e9753d6SMatthew G. Knepley       batchSize = numBlocks * blockSize;
56609566063dSJacob Faibussowitsch       PetscCall(PetscFESetTileSizes(feI, blockSize, numBlocks, batchSize, numBatches));
56613e9753d6SMatthew G. Knepley       numChunks = numCells / (numBatches*batchSize);
56623e9753d6SMatthew G. Knepley       Ne        = numChunks*numBatches*batchSize;
56633e9753d6SMatthew G. Knepley       Nr        = numCells % (numBatches*batchSize);
56643e9753d6SMatthew G. Knepley       offset    = numCells - Nr;
56659566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomGetChunk(geom,0,offset,&chunkGeom));
56669566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomGetChunk(geom,offset,numCells,&remGeom));
56679566063dSJacob Faibussowitsch       PetscCall(PetscDSGetCohesive(ds, fieldI, &isCohesiveField));
56683e9753d6SMatthew G. Knepley       for (fieldJ = 0; fieldJ < Nf; ++fieldJ) {
56693e9753d6SMatthew G. Knepley         PetscFE feJ;
56703e9753d6SMatthew G. Knepley 
56719566063dSJacob Faibussowitsch         PetscCall(PetscDSGetDiscretization(ds, fieldJ, (PetscObject *) &feJ));
56723e9753d6SMatthew G. Knepley         if (!feJ) continue;
5673148442b3SMatthew G. Knepley         key[0].field = fieldI*Nf+fieldJ;
5674148442b3SMatthew G. Knepley         key[1].field = fieldI*Nf+fieldJ;
56755fedec97SMatthew G. Knepley         key[2].field = fieldI*Nf+fieldJ;
5676148442b3SMatthew G. Knepley         if (hasBdJac) {
56779566063dSJacob Faibussowitsch           PetscCall(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN, key[0], 0, Ne, chunkGeom, u, u_t, dsAux[0], a[0], t, X_tShift, elemMat));
56789566063dSJacob 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]));
56799566063dSJacob Faibussowitsch           PetscCall(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN, key[1], 1, Ne, chunkGeom, u, u_t, dsAux[1], a[1], t, X_tShift, elemMat));
56809566063dSJacob 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]));
5681148442b3SMatthew G. Knepley         }
5682148442b3SMatthew G. Knepley         if (hasBdPrec) {
56839566063dSJacob Faibussowitsch           PetscCall(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN_PRE, key[0], 0, Ne, chunkGeom, u, u_t, dsAux[0], a[0], t, X_tShift, elemMatP));
56849566063dSJacob 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]));
56859566063dSJacob Faibussowitsch           PetscCall(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN_PRE, key[1], 1, Ne, chunkGeom, u, u_t, dsAux[1], a[1], t, X_tShift, elemMatP));
56869566063dSJacob 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]));
5687148442b3SMatthew G. Knepley         }
56885fedec97SMatthew G. Knepley         if (hasBdJac) {
56899566063dSJacob Faibussowitsch           PetscCall(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN, key[2], 2, Ne, chunkGeom, u, u_t, dsAux[2], a[2], t, X_tShift, elemMat));
56909566063dSJacob 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]));
5691148442b3SMatthew G. Knepley         }
56925fedec97SMatthew G. Knepley         if (hasBdPrec) {
56939566063dSJacob Faibussowitsch           PetscCall(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN_PRE, key[2], 2, Ne, chunkGeom, u, u_t, dsAux[2], a[2], t, X_tShift, elemMatP));
56949566063dSJacob 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]));
56953e9753d6SMatthew G. Knepley         }
56963e9753d6SMatthew G. Knepley       }
56979566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomRestoreChunk(geom,offset,numCells,&remGeom));
56989566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomRestoreChunk(geom,0,offset,&chunkGeom));
56993e9753d6SMatthew G. Knepley     }
57003e9753d6SMatthew G. Knepley     /* Insert values into matrix */
57013e9753d6SMatthew G. Knepley     for (c = cS; c < cE; ++c) {
57023e9753d6SMatthew G. Knepley       const PetscInt cell = cells ? cells[c] : c;
57033e9753d6SMatthew G. Knepley       const PetscInt cind = c - cS;
57043e9753d6SMatthew G. Knepley 
57053e9753d6SMatthew G. Knepley       if (hasBdPrec) {
57063e9753d6SMatthew G. Knepley         if (hasBdJac) {
57079566063dSJacob Faibussowitsch           if (mesh->printFEM > 1) PetscCall(DMPrintCellMatrix(cell, name, totDim, totDim, &elemMat[cind*totDim*totDim]));
57089566063dSJacob Faibussowitsch           PetscCall(DMPlexMatSetClosure(plex, section, globalSection, Jac, cell, &elemMat[cind*totDim*totDim], ADD_VALUES));
57093e9753d6SMatthew G. Knepley         }
57109566063dSJacob Faibussowitsch         if (mesh->printFEM > 1) PetscCall(DMPrintCellMatrix(cell, name, totDim, totDim, &elemMatP[cind*totDim*totDim]));
57119566063dSJacob Faibussowitsch         PetscCall(DMPlexMatSetClosure(plex, section, globalSection, JacP, cell, &elemMatP[cind*totDim*totDim], ADD_VALUES));
57123e9753d6SMatthew G. Knepley       } else if (hasBdJac) {
57139566063dSJacob Faibussowitsch         if (mesh->printFEM > 1) PetscCall(DMPrintCellMatrix(cell, name, totDim, totDim, &elemMat[cind*totDim*totDim]));
57149566063dSJacob Faibussowitsch         PetscCall(DMPlexMatSetClosure(plex, section, globalSection, JacP, cell, &elemMat[cind*totDim*totDim], ADD_VALUES));
57153e9753d6SMatthew G. Knepley       }
57163e9753d6SMatthew G. Knepley     }
57173e9753d6SMatthew G. Knepley   }
57189566063dSJacob Faibussowitsch   PetscCall(DMPlexRestoreCellFields(dm, cellIS, locX, locX_t, locA[2], &u, &u_t, &a[2]));
57199566063dSJacob Faibussowitsch   PetscCall(DMPlexRestoreHybridAuxFields(dmAux, dsAux, cellIS, locA, a));
57209566063dSJacob Faibussowitsch   PetscCall(DMRestoreWorkArray(dm, hasBdJac  ? cellChunkSize*totDim*totDim : 0, MPIU_SCALAR, &elemMat));
57219566063dSJacob Faibussowitsch   PetscCall(DMRestoreWorkArray(dm, hasBdPrec ? cellChunkSize*totDim*totDim : 0, MPIU_SCALAR, &elemMatP));
57229566063dSJacob Faibussowitsch   PetscCall(PetscFree(faces));
57239566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&chunkIS));
57249566063dSJacob Faibussowitsch   PetscCall(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
57253e9753d6SMatthew G. Knepley   if (maxDegree <= 1) {
57269566063dSJacob Faibussowitsch     PetscCall(DMSNESRestoreFEGeom(coordField,cellIS,affineQuad,PETSC_FALSE,&affineGeom));
57279566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureDestroy(&affineQuad));
57283e9753d6SMatthew G. Knepley   } else {
57293e9753d6SMatthew G. Knepley     PetscInt f;
57303e9753d6SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
57319566063dSJacob Faibussowitsch       if (geoms) PetscCall(DMSNESRestoreFEGeom(coordField,cellIS,quads[f],PETSC_FALSE, &geoms[f]));
57329566063dSJacob Faibussowitsch       if (quads) PetscCall(PetscQuadratureDestroy(&quads[f]));
57333e9753d6SMatthew G. Knepley     }
57349566063dSJacob Faibussowitsch     PetscCall(PetscFree2(quads,geoms));
57353e9753d6SMatthew G. Knepley   }
57369566063dSJacob Faibussowitsch   if (dmAux[2]) PetscCall(DMDestroy(&plexA));
57379566063dSJacob Faibussowitsch   PetscCall(DMDestroy(&plex));
57383e9753d6SMatthew G. Knepley   /* Assemble matrix */
57393e9753d6SMatthew G. Knepley   if (hasBdJac && hasBdPrec) {
57409566063dSJacob Faibussowitsch     PetscCall(MatAssemblyBegin(Jac, MAT_FINAL_ASSEMBLY));
57419566063dSJacob Faibussowitsch     PetscCall(MatAssemblyEnd(Jac, MAT_FINAL_ASSEMBLY));
57423e9753d6SMatthew G. Knepley   }
57439566063dSJacob Faibussowitsch   PetscCall(MatAssemblyBegin(JacP, MAT_FINAL_ASSEMBLY));
57449566063dSJacob Faibussowitsch   PetscCall(MatAssemblyEnd(JacP, MAT_FINAL_ASSEMBLY));
57459566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_JacobianFEM,dm,0,0,0));
57463e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
57473e9753d6SMatthew G. Knepley }
57488e3a2eefSMatthew G. Knepley 
57498e3a2eefSMatthew G. Knepley /*
57508e3a2eefSMatthew 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.
57518e3a2eefSMatthew G. Knepley 
57528e3a2eefSMatthew G. Knepley   Input Parameters:
57538e3a2eefSMatthew G. Knepley + dm     - The mesh
57548e3a2eefSMatthew G. Knepley . key    - The PetscWeakFormKey indcating where integration should happen
575506ad1575SMatthew G. Knepley . cellIS - The cells to integrate over
57568e3a2eefSMatthew G. Knepley . t      - The time
57578e3a2eefSMatthew G. Knepley . X_tShift - The multiplier for the Jacobian with repsect to X_t
57588e3a2eefSMatthew G. Knepley . X      - Local solution vector
57598e3a2eefSMatthew G. Knepley . X_t    - Time-derivative of the local solution vector
57608e3a2eefSMatthew G. Knepley . Y      - Local input vector
576106ad1575SMatthew G. Knepley - user   - the user context
57628e3a2eefSMatthew G. Knepley 
57638e3a2eefSMatthew G. Knepley   Output Parameter:
57648e3a2eefSMatthew G. Knepley . Z - Local output vector
57658e3a2eefSMatthew G. Knepley 
57668e3a2eefSMatthew G. Knepley   Note:
57678e3a2eefSMatthew G. Knepley   We form the residual one batch of elements at a time. This allows us to offload work onto an accelerator,
57688e3a2eefSMatthew G. Knepley   like a GPU, or vectorize on a multicore machine.
57698e3a2eefSMatthew G. Knepley */
577006ad1575SMatthew 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)
57718e3a2eefSMatthew G. Knepley {
57728e3a2eefSMatthew G. Knepley   DM_Plex        *mesh  = (DM_Plex *) dm->data;
57738e3a2eefSMatthew G. Knepley   const char     *name  = "Jacobian";
57748e3a2eefSMatthew G. Knepley   DM              dmAux = NULL, plex, plexAux = NULL;
57758e3a2eefSMatthew G. Knepley   DMEnclosureType encAux;
57768e3a2eefSMatthew G. Knepley   Vec             A;
57778e3a2eefSMatthew G. Knepley   DMField         coordField;
57788e3a2eefSMatthew G. Knepley   PetscDS         prob, probAux = NULL;
57798e3a2eefSMatthew G. Knepley   PetscQuadrature quad;
57808e3a2eefSMatthew G. Knepley   PetscSection    section, globalSection, sectionAux;
57818e3a2eefSMatthew G. Knepley   PetscScalar    *elemMat, *elemMatD, *u, *u_t, *a = NULL, *y, *z;
57828e3a2eefSMatthew G. Knepley   const PetscInt *cells;
57838e3a2eefSMatthew G. Knepley   PetscInt        Nf, fieldI, fieldJ;
57848e3a2eefSMatthew G. Knepley   PetscInt        totDim, totDimAux = 0, cStart, cEnd, numCells, c;
57858e3a2eefSMatthew G. Knepley   PetscBool       hasDyn;
57868e3a2eefSMatthew G. Knepley 
57878e3a2eefSMatthew G. Knepley   PetscFunctionBegin;
57889566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_JacobianFEM,dm,0,0,0));
57899566063dSJacob Faibussowitsch   PetscCall(DMConvert(dm, DMPLEX, &plex));
57908e3a2eefSMatthew G. Knepley   if (!cellIS) {
57918e3a2eefSMatthew G. Knepley     PetscInt depth;
57928e3a2eefSMatthew G. Knepley 
57939566063dSJacob Faibussowitsch     PetscCall(DMPlexGetDepth(plex, &depth));
57949566063dSJacob Faibussowitsch     PetscCall(DMGetStratumIS(plex, "dim", depth, &cellIS));
57959566063dSJacob Faibussowitsch     if (!cellIS) PetscCall(DMGetStratumIS(plex, "depth", depth, &cellIS));
57968e3a2eefSMatthew G. Knepley   } else {
57979566063dSJacob Faibussowitsch     PetscCall(PetscObjectReference((PetscObject) cellIS));
57988e3a2eefSMatthew G. Knepley   }
57999566063dSJacob Faibussowitsch   PetscCall(ISGetLocalSize(cellIS, &numCells));
58009566063dSJacob Faibussowitsch   PetscCall(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
58019566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
58029566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dm, &globalSection));
58039566063dSJacob Faibussowitsch   PetscCall(DMGetCellDS(dm, cells ? cells[cStart] : cStart, &prob));
58049566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumFields(prob, &Nf));
58059566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(prob, &totDim));
58069566063dSJacob Faibussowitsch   PetscCall(PetscDSHasDynamicJacobian(prob, &hasDyn));
58078e3a2eefSMatthew G. Knepley   hasDyn = hasDyn && (X_tShift != 0.0) ? PETSC_TRUE : PETSC_FALSE;
58089566063dSJacob Faibussowitsch   PetscCall(DMGetAuxiliaryVec(dm, key.label, key.value, key.part, &A));
58098e3a2eefSMatthew G. Knepley   if (A) {
58109566063dSJacob Faibussowitsch     PetscCall(VecGetDM(A, &dmAux));
58119566063dSJacob Faibussowitsch     PetscCall(DMGetEnclosureRelation(dmAux, dm, &encAux));
58129566063dSJacob Faibussowitsch     PetscCall(DMConvert(dmAux, DMPLEX, &plexAux));
58139566063dSJacob Faibussowitsch     PetscCall(DMGetLocalSection(plexAux, &sectionAux));
58149566063dSJacob Faibussowitsch     PetscCall(DMGetDS(dmAux, &probAux));
58159566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalDimension(probAux, &totDimAux));
58168e3a2eefSMatthew G. Knepley   }
58179566063dSJacob Faibussowitsch   PetscCall(VecSet(Z, 0.0));
58189566063dSJacob 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));
58199566063dSJacob Faibussowitsch   if (dmAux) PetscCall(PetscMalloc1(numCells*totDimAux, &a));
58209566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateField(dm, &coordField));
58218e3a2eefSMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
58228e3a2eefSMatthew G. Knepley     const PetscInt cell = cells ? cells[c] : c;
58238e3a2eefSMatthew G. Knepley     const PetscInt cind = c - cStart;
58248e3a2eefSMatthew G. Knepley     PetscScalar   *x = NULL,  *x_t = NULL;
58258e3a2eefSMatthew G. Knepley     PetscInt       i;
58268e3a2eefSMatthew G. Knepley 
58279566063dSJacob Faibussowitsch     PetscCall(DMPlexVecGetClosure(plex, section, X, cell, NULL, &x));
58288e3a2eefSMatthew G. Knepley     for (i = 0; i < totDim; ++i) u[cind*totDim+i] = x[i];
58299566063dSJacob Faibussowitsch     PetscCall(DMPlexVecRestoreClosure(plex, section, X, cell, NULL, &x));
58308e3a2eefSMatthew G. Knepley     if (X_t) {
58319566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(plex, section, X_t, cell, NULL, &x_t));
58328e3a2eefSMatthew G. Knepley       for (i = 0; i < totDim; ++i) u_t[cind*totDim+i] = x_t[i];
58339566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(plex, section, X_t, cell, NULL, &x_t));
58348e3a2eefSMatthew G. Knepley     }
58358e3a2eefSMatthew G. Knepley     if (dmAux) {
58368e3a2eefSMatthew G. Knepley       PetscInt subcell;
58379566063dSJacob Faibussowitsch       PetscCall(DMGetEnclosurePoint(dmAux, dm, encAux, cell, &subcell));
58389566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(plexAux, sectionAux, A, subcell, NULL, &x));
58398e3a2eefSMatthew G. Knepley       for (i = 0; i < totDimAux; ++i) a[cind*totDimAux+i] = x[i];
58409566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(plexAux, sectionAux, A, subcell, NULL, &x));
58418e3a2eefSMatthew G. Knepley     }
58429566063dSJacob Faibussowitsch     PetscCall(DMPlexVecGetClosure(plex, section, Y, cell, NULL, &x));
58438e3a2eefSMatthew G. Knepley     for (i = 0; i < totDim; ++i) y[cind*totDim+i] = x[i];
58449566063dSJacob Faibussowitsch     PetscCall(DMPlexVecRestoreClosure(plex, section, Y, cell, NULL, &x));
58458e3a2eefSMatthew G. Knepley   }
58469566063dSJacob Faibussowitsch   PetscCall(PetscArrayzero(elemMat, numCells*totDim*totDim));
58479566063dSJacob Faibussowitsch   if (hasDyn)  PetscCall(PetscArrayzero(elemMatD, numCells*totDim*totDim));
58488e3a2eefSMatthew G. Knepley   for (fieldI = 0; fieldI < Nf; ++fieldI) {
58498e3a2eefSMatthew G. Knepley     PetscFE  fe;
58508e3a2eefSMatthew G. Knepley     PetscInt Nb;
58518e3a2eefSMatthew G. Knepley     /* Conforming batches */
58528e3a2eefSMatthew G. Knepley     PetscInt numChunks, numBatches, numBlocks, Ne, blockSize, batchSize;
58538e3a2eefSMatthew G. Knepley     /* Remainder */
58548e3a2eefSMatthew G. Knepley     PetscInt Nr, offset, Nq;
58558e3a2eefSMatthew G. Knepley     PetscQuadrature qGeom = NULL;
58568e3a2eefSMatthew G. Knepley     PetscInt    maxDegree;
58578e3a2eefSMatthew G. Knepley     PetscFEGeom *cgeomFEM, *chunkGeom = NULL, *remGeom = NULL;
58588e3a2eefSMatthew G. Knepley 
58599566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, fieldI, (PetscObject *) &fe));
58609566063dSJacob Faibussowitsch     PetscCall(PetscFEGetQuadrature(fe, &quad));
58619566063dSJacob Faibussowitsch     PetscCall(PetscFEGetDimension(fe, &Nb));
58629566063dSJacob Faibussowitsch     PetscCall(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
58639566063dSJacob Faibussowitsch     PetscCall(DMFieldGetDegree(coordField,cellIS,NULL,&maxDegree));
58649566063dSJacob Faibussowitsch     if (maxDegree <= 1) PetscCall(DMFieldCreateDefaultQuadrature(coordField,cellIS,&qGeom));
58658e3a2eefSMatthew G. Knepley     if (!qGeom) {
58669566063dSJacob Faibussowitsch       PetscCall(PetscFEGetQuadrature(fe,&qGeom));
58679566063dSJacob Faibussowitsch       PetscCall(PetscObjectReference((PetscObject)qGeom));
58688e3a2eefSMatthew G. Knepley     }
58699566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureGetData(qGeom, NULL, NULL, &Nq, NULL, NULL));
58709566063dSJacob Faibussowitsch     PetscCall(DMSNESGetFEGeom(coordField,cellIS,qGeom,PETSC_FALSE,&cgeomFEM));
58718e3a2eefSMatthew G. Knepley     blockSize = Nb;
58728e3a2eefSMatthew G. Knepley     batchSize = numBlocks * blockSize;
58739566063dSJacob Faibussowitsch     PetscCall(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
58748e3a2eefSMatthew G. Knepley     numChunks = numCells / (numBatches*batchSize);
58758e3a2eefSMatthew G. Knepley     Ne        = numChunks*numBatches*batchSize;
58768e3a2eefSMatthew G. Knepley     Nr        = numCells % (numBatches*batchSize);
58778e3a2eefSMatthew G. Knepley     offset    = numCells - Nr;
58789566063dSJacob Faibussowitsch     PetscCall(PetscFEGeomGetChunk(cgeomFEM,0,offset,&chunkGeom));
58799566063dSJacob Faibussowitsch     PetscCall(PetscFEGeomGetChunk(cgeomFEM,offset,numCells,&remGeom));
58808e3a2eefSMatthew G. Knepley     for (fieldJ = 0; fieldJ < Nf; ++fieldJ) {
58818e3a2eefSMatthew G. Knepley       key.field = fieldI*Nf + fieldJ;
58829566063dSJacob Faibussowitsch       PetscCall(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN, key, Ne, chunkGeom, u, u_t, probAux, a, t, X_tShift, elemMat));
58839566063dSJacob 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]));
58848e3a2eefSMatthew G. Knepley       if (hasDyn) {
58859566063dSJacob Faibussowitsch         PetscCall(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN_DYN, key, Ne, chunkGeom, u, u_t, probAux, a, t, X_tShift, elemMatD));
58869566063dSJacob 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]));
58878e3a2eefSMatthew G. Knepley       }
58888e3a2eefSMatthew G. Knepley     }
58899566063dSJacob Faibussowitsch     PetscCall(PetscFEGeomRestoreChunk(cgeomFEM,offset,numCells,&remGeom));
58909566063dSJacob Faibussowitsch     PetscCall(PetscFEGeomRestoreChunk(cgeomFEM,0,offset,&chunkGeom));
58919566063dSJacob Faibussowitsch     PetscCall(DMSNESRestoreFEGeom(coordField,cellIS,qGeom,PETSC_FALSE,&cgeomFEM));
58929566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureDestroy(&qGeom));
58938e3a2eefSMatthew G. Knepley   }
58948e3a2eefSMatthew G. Knepley   if (hasDyn) {
58958e3a2eefSMatthew G. Knepley     for (c = 0; c < numCells*totDim*totDim; ++c) elemMat[c] += X_tShift*elemMatD[c];
58968e3a2eefSMatthew G. Knepley   }
58978e3a2eefSMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
58988e3a2eefSMatthew G. Knepley     const PetscInt     cell = cells ? cells[c] : c;
58998e3a2eefSMatthew G. Knepley     const PetscInt     cind = c - cStart;
59008e3a2eefSMatthew G. Knepley     const PetscBLASInt M = totDim, one = 1;
59018e3a2eefSMatthew G. Knepley     const PetscScalar  a = 1.0, b = 0.0;
59028e3a2eefSMatthew G. Knepley 
59038e3a2eefSMatthew G. Knepley     PetscStackCallBLAS("BLASgemv", BLASgemv_("N", &M, &M, &a, &elemMat[cind*totDim*totDim], &M, &y[cind*totDim], &one, &b, z, &one));
59048e3a2eefSMatthew G. Knepley     if (mesh->printFEM > 1) {
59059566063dSJacob Faibussowitsch       PetscCall(DMPrintCellMatrix(c, name, totDim, totDim, &elemMat[cind*totDim*totDim]));
59069566063dSJacob Faibussowitsch       PetscCall(DMPrintCellVector(c, "Y",  totDim, &y[cind*totDim]));
59079566063dSJacob Faibussowitsch       PetscCall(DMPrintCellVector(c, "Z",  totDim, z));
59088e3a2eefSMatthew G. Knepley     }
59099566063dSJacob Faibussowitsch     PetscCall(DMPlexVecSetClosure(dm, section, Z, cell, z, ADD_VALUES));
59108e3a2eefSMatthew G. Knepley   }
59119566063dSJacob Faibussowitsch   PetscCall(PetscFree6(u,u_t,elemMat,elemMatD,y,z));
59128e3a2eefSMatthew G. Knepley   if (mesh->printFEM) {
59139566063dSJacob Faibussowitsch     PetscCall(PetscPrintf(PetscObjectComm((PetscObject)Z), "Z:\n"));
59149566063dSJacob Faibussowitsch     PetscCall(VecView(Z, NULL));
59158e3a2eefSMatthew G. Knepley   }
59169566063dSJacob Faibussowitsch   PetscCall(PetscFree(a));
59179566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&cellIS));
59189566063dSJacob Faibussowitsch   PetscCall(DMDestroy(&plexAux));
59199566063dSJacob Faibussowitsch   PetscCall(DMDestroy(&plex));
59209566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_JacobianFEM,dm,0,0,0));
59218e3a2eefSMatthew G. Knepley   PetscFunctionReturn(0);
59228e3a2eefSMatthew G. Knepley }
5923