xref: /petsc/src/dm/impls/plex/plexfem.c (revision 49abdd8a111d9c2ef7fc48ade253ef64e07f9b37)
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 
19d71ae5a4SJacob Faibussowitsch static PetscErrorCode DMPlexConvertPlex(DM dm, DM *plex, PetscBool copy)
20d71ae5a4SJacob Faibussowitsch {
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));
33cbf8eb3cSStefano Zampini     } else {
34cbf8eb3cSStefano Zampini       PetscCall(PetscObjectReference((PetscObject)*plex));
35cbf8eb3cSStefano Zampini     }
362f856554SMatthew G. Knepley     if (copy) {
372f856554SMatthew G. Knepley       DMSubDomainHookLink link;
389a2a23afSMatthew G. Knepley 
39bb4b53efSMatthew G. Knepley       PetscCall(DMCopyDS(dm, PETSC_DETERMINE, PETSC_DETERMINE, *plex));
409566063dSJacob Faibussowitsch       PetscCall(DMCopyAuxiliaryVec(dm, *plex));
419a2a23afSMatthew G. Knepley       /* Run the subdomain hook (this will copy the DMSNES/DMTS) */
422f856554SMatthew G. Knepley       for (link = dm->subdomainhook; link; link = link->next) {
439566063dSJacob Faibussowitsch         if (link->ddhook) PetscCall((*link->ddhook)(dm, *plex, link->ctx));
442f856554SMatthew G. Knepley       }
452f856554SMatthew G. Knepley     }
462f856554SMatthew G. Knepley   }
473ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
482f856554SMatthew G. Knepley }
492f856554SMatthew G. Knepley 
50*49abdd8aSBarry Smith static PetscErrorCode PetscContainerCtxDestroy_PetscFEGeom(void **ctx)
51d71ae5a4SJacob Faibussowitsch {
52*49abdd8aSBarry Smith   PetscFEGeom *geom = (PetscFEGeom *)*ctx;
539b6f715bSMatthew G. Knepley 
549b6f715bSMatthew G. Knepley   PetscFunctionBegin;
559566063dSJacob Faibussowitsch   PetscCall(PetscFEGeomDestroy(&geom));
563ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
579b6f715bSMatthew G. Knepley }
589b6f715bSMatthew G. Knepley 
59d71ae5a4SJacob Faibussowitsch static PetscErrorCode DMPlexGetFEGeom(DMField coordField, IS pointIS, PetscQuadrature quad, PetscBool faceData, PetscFEGeom **geom)
60d71ae5a4SJacob Faibussowitsch {
619b6f715bSMatthew G. Knepley   char           composeStr[33] = {0};
629b6f715bSMatthew G. Knepley   PetscObjectId  id;
639b6f715bSMatthew G. Knepley   PetscContainer container;
649b6f715bSMatthew G. Knepley 
659b6f715bSMatthew G. Knepley   PetscFunctionBegin;
669566063dSJacob Faibussowitsch   PetscCall(PetscObjectGetId((PetscObject)quad, &id));
6763a3b9bcSJacob Faibussowitsch   PetscCall(PetscSNPrintf(composeStr, 32, "DMPlexGetFEGeom_%" PetscInt64_FMT "\n", id));
689566063dSJacob Faibussowitsch   PetscCall(PetscObjectQuery((PetscObject)pointIS, composeStr, (PetscObject *)&container));
699b6f715bSMatthew G. Knepley   if (container) {
709566063dSJacob Faibussowitsch     PetscCall(PetscContainerGetPointer(container, (void **)geom));
719b6f715bSMatthew G. Knepley   } else {
729566063dSJacob Faibussowitsch     PetscCall(DMFieldCreateFEGeom(coordField, pointIS, quad, faceData, geom));
739566063dSJacob Faibussowitsch     PetscCall(PetscContainerCreate(PETSC_COMM_SELF, &container));
749566063dSJacob Faibussowitsch     PetscCall(PetscContainerSetPointer(container, (void *)*geom));
75*49abdd8aSBarry Smith     PetscCall(PetscContainerSetCtxDestroy(container, PetscContainerCtxDestroy_PetscFEGeom));
769566063dSJacob Faibussowitsch     PetscCall(PetscObjectCompose((PetscObject)pointIS, composeStr, (PetscObject)container));
779566063dSJacob Faibussowitsch     PetscCall(PetscContainerDestroy(&container));
789b6f715bSMatthew G. Knepley   }
793ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
809b6f715bSMatthew G. Knepley }
819b6f715bSMatthew G. Knepley 
82d71ae5a4SJacob Faibussowitsch static PetscErrorCode DMPlexRestoreFEGeom(DMField coordField, IS pointIS, PetscQuadrature quad, PetscBool faceData, PetscFEGeom **geom)
83d71ae5a4SJacob Faibussowitsch {
849b6f715bSMatthew G. Knepley   PetscFunctionBegin;
859b6f715bSMatthew G. Knepley   *geom = NULL;
863ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
879b6f715bSMatthew G. Knepley }
889b6f715bSMatthew G. Knepley 
8946fa42a0SMatthew G. Knepley /*@
9046fa42a0SMatthew G. Knepley   DMPlexGetScale - Get the scale for the specified fundamental unit
9146fa42a0SMatthew G. Knepley 
9220f4b53cSBarry Smith   Not Collective
9346fa42a0SMatthew G. Knepley 
944165533cSJose E. Roman   Input Parameters:
95a1cb98faSBarry Smith + dm   - the `DM`
9646fa42a0SMatthew G. Knepley - unit - The SI unit
9746fa42a0SMatthew G. Knepley 
984165533cSJose E. Roman   Output Parameter:
9946fa42a0SMatthew G. Knepley . scale - The value used to scale all quantities with this unit
10046fa42a0SMatthew G. Knepley 
10146fa42a0SMatthew G. Knepley   Level: advanced
10246fa42a0SMatthew G. Knepley 
1031cc06b55SBarry Smith .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `DMPlexSetScale()`, `PetscUnit`
10446fa42a0SMatthew G. Knepley @*/
105d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexGetScale(DM dm, PetscUnit unit, PetscReal *scale)
106d71ae5a4SJacob Faibussowitsch {
107cb1e1211SMatthew G Knepley   DM_Plex *mesh = (DM_Plex *)dm->data;
108cb1e1211SMatthew G Knepley 
109cb1e1211SMatthew G Knepley   PetscFunctionBegin;
110cb1e1211SMatthew G Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
1114f572ea9SToby Isaac   PetscAssertPointer(scale, 3);
112cb1e1211SMatthew G Knepley   *scale = mesh->scale[unit];
1133ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
114cb1e1211SMatthew G Knepley }
115cb1e1211SMatthew G Knepley 
11646fa42a0SMatthew G. Knepley /*@
11746fa42a0SMatthew G. Knepley   DMPlexSetScale - Set the scale for the specified fundamental unit
11846fa42a0SMatthew G. Knepley 
11920f4b53cSBarry Smith   Not Collective
12046fa42a0SMatthew G. Knepley 
1214165533cSJose E. Roman   Input Parameters:
122a1cb98faSBarry Smith + dm    - the `DM`
12346fa42a0SMatthew G. Knepley . unit  - The SI unit
12446fa42a0SMatthew G. Knepley - scale - The value used to scale all quantities with this unit
12546fa42a0SMatthew G. Knepley 
12646fa42a0SMatthew G. Knepley   Level: advanced
12746fa42a0SMatthew G. Knepley 
1281cc06b55SBarry Smith .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `DMPlexGetScale()`, `PetscUnit`
12946fa42a0SMatthew G. Knepley @*/
130d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexSetScale(DM dm, PetscUnit unit, PetscReal scale)
131d71ae5a4SJacob Faibussowitsch {
132cb1e1211SMatthew G Knepley   DM_Plex *mesh = (DM_Plex *)dm->data;
133cb1e1211SMatthew G Knepley 
134cb1e1211SMatthew G Knepley   PetscFunctionBegin;
135cb1e1211SMatthew G Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
136cb1e1211SMatthew G Knepley   mesh->scale[unit] = scale;
1373ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
138cb1e1211SMatthew G Knepley }
139cb1e1211SMatthew G Knepley 
140d2b2dc1eSMatthew G. Knepley PetscErrorCode DMPlexGetUseCeed_Plex(DM dm, PetscBool *useCeed)
141d2b2dc1eSMatthew G. Knepley {
142d2b2dc1eSMatthew G. Knepley   DM_Plex *mesh = (DM_Plex *)dm->data;
143d2b2dc1eSMatthew G. Knepley 
144d2b2dc1eSMatthew G. Knepley   PetscFunctionBegin;
145d2b2dc1eSMatthew G. Knepley   *useCeed = mesh->useCeed;
146d2b2dc1eSMatthew G. Knepley   PetscFunctionReturn(PETSC_SUCCESS);
147d2b2dc1eSMatthew G. Knepley }
148d2b2dc1eSMatthew G. Knepley PetscErrorCode DMPlexSetUseCeed_Plex(DM dm, PetscBool useCeed)
149d2b2dc1eSMatthew G. Knepley {
150d2b2dc1eSMatthew G. Knepley   DM_Plex *mesh = (DM_Plex *)dm->data;
151d2b2dc1eSMatthew G. Knepley 
152d2b2dc1eSMatthew G. Knepley   PetscFunctionBegin;
153d2b2dc1eSMatthew G. Knepley   mesh->useCeed = useCeed;
154d2b2dc1eSMatthew G. Knepley   PetscFunctionReturn(PETSC_SUCCESS);
155d2b2dc1eSMatthew G. Knepley }
156d2b2dc1eSMatthew G. Knepley 
157d2b2dc1eSMatthew G. Knepley /*@
158d2b2dc1eSMatthew G. Knepley   DMPlexGetUseCeed - Get flag for using the LibCEED backend
159d2b2dc1eSMatthew G. Knepley 
160d2b2dc1eSMatthew G. Knepley   Not collective
161d2b2dc1eSMatthew G. Knepley 
162d2b2dc1eSMatthew G. Knepley   Input Parameter:
163d2b2dc1eSMatthew G. Knepley . dm - The `DM`
164d2b2dc1eSMatthew G. Knepley 
165d2b2dc1eSMatthew G. Knepley   Output Parameter:
166d2b2dc1eSMatthew G. Knepley . useCeed - The flag
167d2b2dc1eSMatthew G. Knepley 
168d2b2dc1eSMatthew G. Knepley   Level: intermediate
169d2b2dc1eSMatthew G. Knepley 
170d2b2dc1eSMatthew G. Knepley .seealso: `DMPlexSetUseCeed()`
171d2b2dc1eSMatthew G. Knepley @*/
172d2b2dc1eSMatthew G. Knepley PetscErrorCode DMPlexGetUseCeed(DM dm, PetscBool *useCeed)
173d2b2dc1eSMatthew G. Knepley {
174d2b2dc1eSMatthew G. Knepley   PetscFunctionBegin;
175d2b2dc1eSMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
176d2b2dc1eSMatthew G. Knepley   PetscAssertPointer(useCeed, 2);
177d2b2dc1eSMatthew G. Knepley   *useCeed = PETSC_FALSE;
178d2b2dc1eSMatthew G. Knepley   PetscTryMethod(dm, "DMPlexGetUseCeed_C", (DM, PetscBool *), (dm, useCeed));
179d2b2dc1eSMatthew G. Knepley   PetscFunctionReturn(PETSC_SUCCESS);
180d2b2dc1eSMatthew G. Knepley }
181d2b2dc1eSMatthew G. Knepley 
182d2b2dc1eSMatthew G. Knepley /*@
183d2b2dc1eSMatthew G. Knepley   DMPlexSetUseCeed - Set flag for using the LibCEED backend
184d2b2dc1eSMatthew G. Knepley 
185d2b2dc1eSMatthew G. Knepley   Not collective
186d2b2dc1eSMatthew G. Knepley 
187d2b2dc1eSMatthew G. Knepley   Input Parameters:
188d2b2dc1eSMatthew G. Knepley + dm      - The `DM`
189d2b2dc1eSMatthew G. Knepley - useCeed - The flag
190d2b2dc1eSMatthew G. Knepley 
191d2b2dc1eSMatthew G. Knepley   Level: intermediate
192d2b2dc1eSMatthew G. Knepley 
193fe8e7dddSPierre Jolivet .seealso: `DMPlexGetUseCeed()`
194d2b2dc1eSMatthew G. Knepley @*/
195d2b2dc1eSMatthew G. Knepley PetscErrorCode DMPlexSetUseCeed(DM dm, PetscBool useCeed)
196d2b2dc1eSMatthew G. Knepley {
197d2b2dc1eSMatthew G. Knepley   PetscFunctionBegin;
198d2b2dc1eSMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
199d2b2dc1eSMatthew G. Knepley   PetscValidLogicalCollectiveBool(dm, useCeed, 2);
200d2b2dc1eSMatthew G. Knepley   PetscUseMethod(dm, "DMPlexSetUseCeed_C", (DM, PetscBool), (dm, useCeed));
201d2b2dc1eSMatthew G. Knepley   PetscFunctionReturn(PETSC_SUCCESS);
202d2b2dc1eSMatthew G. Knepley }
203d2b2dc1eSMatthew G. Knepley 
204e8e188d2SZach Atkins /*@
205e8e188d2SZach Atkins   DMPlexGetUseMatClosurePermutation - Get flag for using a closure permutation for matrix insertion
206e8e188d2SZach Atkins 
207e8e188d2SZach Atkins   Not collective
208e8e188d2SZach Atkins 
209e8e188d2SZach Atkins   Input Parameter:
210e8e188d2SZach Atkins . dm - The `DM`
211e8e188d2SZach Atkins 
212e8e188d2SZach Atkins   Output Parameter:
213e8e188d2SZach Atkins . useClPerm - The flag
214e8e188d2SZach Atkins 
215e8e188d2SZach Atkins   Level: intermediate
216e8e188d2SZach Atkins 
217e8e188d2SZach Atkins .seealso: `DMPlexSetUseMatClosurePermutation()`
218e8e188d2SZach Atkins @*/
219e8e188d2SZach Atkins PetscErrorCode DMPlexGetUseMatClosurePermutation(DM dm, PetscBool *useClPerm)
220e8e188d2SZach Atkins {
221e8e188d2SZach Atkins   DM_Plex *mesh = (DM_Plex *)dm->data;
222e8e188d2SZach Atkins 
223e8e188d2SZach Atkins   PetscFunctionBegin;
224e8e188d2SZach Atkins   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
225e8e188d2SZach Atkins   PetscAssertPointer(useClPerm, 2);
226e8e188d2SZach Atkins   *useClPerm = mesh->useMatClPerm;
227e8e188d2SZach Atkins   PetscFunctionReturn(PETSC_SUCCESS);
228e8e188d2SZach Atkins }
229e8e188d2SZach Atkins 
230e8e188d2SZach Atkins /*@
231e8e188d2SZach Atkins   DMPlexSetUseMatClosurePermutation - Set flag for using a closure permutation for matrix insertion
232e8e188d2SZach Atkins 
233e8e188d2SZach Atkins   Not collective
234e8e188d2SZach Atkins 
235e8e188d2SZach Atkins   Input Parameters:
236e8e188d2SZach Atkins + dm        - The `DM`
237e8e188d2SZach Atkins - useClPerm - The flag
238e8e188d2SZach Atkins 
239e8e188d2SZach Atkins   Level: intermediate
240e8e188d2SZach Atkins 
241e8e188d2SZach Atkins .seealso: `DMPlexGetUseMatClosurePermutation()`
242e8e188d2SZach Atkins @*/
243e8e188d2SZach Atkins PetscErrorCode DMPlexSetUseMatClosurePermutation(DM dm, PetscBool useClPerm)
244e8e188d2SZach Atkins {
245e8e188d2SZach Atkins   DM_Plex *mesh = (DM_Plex *)dm->data;
246e8e188d2SZach Atkins 
247e8e188d2SZach Atkins   PetscFunctionBegin;
248e8e188d2SZach Atkins   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
249e8e188d2SZach Atkins   PetscValidLogicalCollectiveBool(dm, useClPerm, 2);
250e8e188d2SZach Atkins   mesh->useMatClPerm = useClPerm;
251e8e188d2SZach Atkins   PetscFunctionReturn(PETSC_SUCCESS);
252e8e188d2SZach Atkins }
253e8e188d2SZach Atkins 
254d71ae5a4SJacob Faibussowitsch static PetscErrorCode DMPlexProjectRigidBody_Private(PetscInt dim, PetscReal t, const PetscReal X[], PetscInt Nc, PetscScalar *mode, void *ctx)
255d71ae5a4SJacob Faibussowitsch {
2569371c9d4SSatish Balay   const PetscInt eps[3][3][3] = {
2579371c9d4SSatish Balay     {{0, 0, 0},  {0, 0, 1},  {0, -1, 0}},
2589371c9d4SSatish Balay     {{0, 0, -1}, {0, 0, 0},  {1, 0, 0} },
2599371c9d4SSatish Balay     {{0, 1, 0},  {-1, 0, 0}, {0, 0, 0} }
2609371c9d4SSatish Balay   };
261026175e5SToby Isaac   PetscInt *ctxInt = (PetscInt *)ctx;
262ad917190SMatthew G. Knepley   PetscInt  dim2   = ctxInt[0];
263026175e5SToby Isaac   PetscInt  d      = ctxInt[1];
264026175e5SToby Isaac   PetscInt  i, j, k = dim > 2 ? d - dim : d;
265026175e5SToby Isaac 
266ad917190SMatthew G. Knepley   PetscFunctionBegin;
26763a3b9bcSJacob Faibussowitsch   PetscCheck(dim == dim2, PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Input dimension %" PetscInt_FMT " does not match context dimension %" PetscInt_FMT, dim, dim2);
268026175e5SToby Isaac   for (i = 0; i < dim; i++) mode[i] = 0.;
269026175e5SToby Isaac   if (d < dim) {
27012adca46SMatthew G. Knepley     mode[d] = 1.; /* Translation along axis d */
271ad917190SMatthew G. Knepley   } else {
272026175e5SToby Isaac     for (i = 0; i < dim; i++) {
2739371c9d4SSatish Balay       for (j = 0; j < dim; j++) { mode[j] += eps[i][j][k] * X[i]; /* Rotation about axis d */ }
274026175e5SToby Isaac     }
275026175e5SToby Isaac   }
2763ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
277026175e5SToby Isaac }
278026175e5SToby Isaac 
279cc4e42d9SMartin Diehl /*@
28012adca46SMatthew G. Knepley   DMPlexCreateRigidBody - For the default global section, create rigid body modes by function space interpolation
281cb1e1211SMatthew G Knepley 
28220f4b53cSBarry Smith   Collective
283cb1e1211SMatthew G Knepley 
2844165533cSJose E. Roman   Input Parameters:
285a1cb98faSBarry Smith + dm    - the `DM`
28656cf3b9cSMatthew G. Knepley - field - The field number for the rigid body space, or 0 for the default
287cb1e1211SMatthew G Knepley 
2884165533cSJose E. Roman   Output Parameter:
289cb1e1211SMatthew G Knepley . sp - the null space
290cb1e1211SMatthew G Knepley 
291cb1e1211SMatthew G Knepley   Level: advanced
292cb1e1211SMatthew G Knepley 
293a1cb98faSBarry Smith   Note:
294a1cb98faSBarry Smith   This is necessary to provide a suitable coarse space for algebraic multigrid
295a1cb98faSBarry Smith 
2961cc06b55SBarry Smith .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `MatNullSpaceCreate()`, `PCGAMG`
297cb1e1211SMatthew G Knepley @*/
298d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexCreateRigidBody(DM dm, PetscInt field, MatNullSpace *sp)
299d71ae5a4SJacob Faibussowitsch {
30056cf3b9cSMatthew G. Knepley   PetscErrorCode (**func)(PetscInt, PetscReal, const PetscReal *, PetscInt, PetscScalar *, void *);
301cb1e1211SMatthew G Knepley   MPI_Comm     comm;
302026175e5SToby Isaac   Vec          mode[6];
303026175e5SToby Isaac   PetscSection section, globalSection;
30456cf3b9cSMatthew G. Knepley   PetscInt     dim, dimEmbed, Nf, n, m, mmin, d, i, j;
305db14aad5SMatthew G. Knepley   void       **ctxs;
306cb1e1211SMatthew G Knepley 
307cb1e1211SMatthew G Knepley   PetscFunctionBegin;
3089566063dSJacob Faibussowitsch   PetscCall(PetscObjectGetComm((PetscObject)dm, &comm));
3099566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
3109566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateDim(dm, &dimEmbed));
3119566063dSJacob Faibussowitsch   PetscCall(DMGetNumFields(dm, &Nf));
31263a3b9bcSJacob Faibussowitsch   PetscCheck(!Nf || !(field < 0 || field >= Nf), comm, PETSC_ERR_ARG_OUTOFRANGE, "Field %" PetscInt_FMT " is not in [0, %" PetscInt_FMT ")", field, Nf);
31356cf3b9cSMatthew G. Knepley   if (dim == 1 && Nf < 2) {
3149566063dSJacob Faibussowitsch     PetscCall(MatNullSpaceCreate(comm, PETSC_TRUE, 0, NULL, sp));
3153ba16761SJacob Faibussowitsch     PetscFunctionReturn(PETSC_SUCCESS);
316cb1e1211SMatthew G Knepley   }
3179566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
3189566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dm, &globalSection));
3199566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetConstrainedStorageSize(globalSection, &n));
320db14aad5SMatthew G. Knepley   PetscCall(PetscCalloc2(Nf, &func, Nf, &ctxs));
321b247467aSMatthew G. Knepley   m = (dim * (dim + 1)) / 2;
3229566063dSJacob Faibussowitsch   PetscCall(VecCreate(comm, &mode[0]));
3239566063dSJacob Faibussowitsch   PetscCall(VecSetType(mode[0], dm->vectype));
3249566063dSJacob Faibussowitsch   PetscCall(VecSetSizes(mode[0], n, PETSC_DETERMINE));
3259566063dSJacob Faibussowitsch   PetscCall(VecSetUp(mode[0]));
3269566063dSJacob Faibussowitsch   PetscCall(VecGetSize(mode[0], &n));
327b247467aSMatthew G. Knepley   mmin        = PetscMin(m, n);
32856cf3b9cSMatthew G. Knepley   func[field] = DMPlexProjectRigidBody_Private;
3299566063dSJacob Faibussowitsch   for (i = 1; i < m; ++i) PetscCall(VecDuplicate(mode[0], &mode[i]));
330026175e5SToby Isaac   for (d = 0; d < m; d++) {
331330485fdSToby Isaac     PetscInt ctx[2];
332cb1e1211SMatthew G Knepley 
333db14aad5SMatthew G. Knepley     ctxs[field] = (void *)(&ctx[0]);
3349d8fbdeaSMatthew G. Knepley     ctx[0]      = dimEmbed;
335330485fdSToby Isaac     ctx[1]      = d;
336db14aad5SMatthew G. Knepley     PetscCall(DMProjectFunction(dm, 0.0, func, ctxs, INSERT_VALUES, mode[d]));
337cb1e1211SMatthew G Knepley   }
3383b2202bfSJacob Faibussowitsch   /* Orthonormalize system */
339b50a2c0aSJacob Faibussowitsch   for (i = 0; i < mmin; ++i) {
340b77f2eeeSJacob Faibussowitsch     PetscScalar dots[6];
341b50a2c0aSJacob Faibussowitsch 
3429566063dSJacob Faibussowitsch     PetscCall(VecNormalize(mode[i], NULL));
3439566063dSJacob Faibussowitsch     PetscCall(VecMDot(mode[i], mmin - i - 1, mode + i + 1, dots + i + 1));
344b50a2c0aSJacob Faibussowitsch     for (j = i + 1; j < mmin; ++j) {
345b77f2eeeSJacob Faibussowitsch       dots[j] *= -1.0;
3469566063dSJacob Faibussowitsch       PetscCall(VecAXPY(mode[j], dots[j], mode[i]));
347b50a2c0aSJacob Faibussowitsch     }
348cb1e1211SMatthew G Knepley   }
3499566063dSJacob Faibussowitsch   PetscCall(MatNullSpaceCreate(comm, PETSC_FALSE, mmin, mode, sp));
3509566063dSJacob Faibussowitsch   for (i = 0; i < m; ++i) PetscCall(VecDestroy(&mode[i]));
351db14aad5SMatthew G. Knepley   PetscCall(PetscFree2(func, ctxs));
3523ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
353cb1e1211SMatthew G Knepley }
354cb1e1211SMatthew G Knepley 
355cc4e42d9SMartin Diehl /*@
35612adca46SMatthew G. Knepley   DMPlexCreateRigidBodies - For the default global section, create rigid body modes by function space interpolation
35712adca46SMatthew G. Knepley 
35820f4b53cSBarry Smith   Collective
35912adca46SMatthew G. Knepley 
3604165533cSJose E. Roman   Input Parameters:
361a1cb98faSBarry Smith + dm    - the `DM`
36212adca46SMatthew G. Knepley . nb    - The number of bodies
363a1cb98faSBarry Smith . label - The `DMLabel` marking each domain
36412adca46SMatthew G. Knepley . nids  - The number of ids per body
36512adca46SMatthew G. Knepley - ids   - An array of the label ids in sequence for each domain
36612adca46SMatthew G. Knepley 
3674165533cSJose E. Roman   Output Parameter:
36812adca46SMatthew G. Knepley . sp - the null space
36912adca46SMatthew G. Knepley 
37012adca46SMatthew G. Knepley   Level: advanced
37112adca46SMatthew G. Knepley 
372a1cb98faSBarry Smith   Note:
373a1cb98faSBarry Smith   This is necessary to provide a suitable coarse space for algebraic multigrid
374a1cb98faSBarry Smith 
3751cc06b55SBarry Smith .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `MatNullSpaceCreate()`
37612adca46SMatthew G. Knepley @*/
377d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexCreateRigidBodies(DM dm, PetscInt nb, DMLabel label, const PetscInt nids[], const PetscInt ids[], MatNullSpace *sp)
378d71ae5a4SJacob Faibussowitsch {
37912adca46SMatthew G. Knepley   MPI_Comm     comm;
38012adca46SMatthew G. Knepley   PetscSection section, globalSection;
38112adca46SMatthew G. Knepley   Vec         *mode;
38212adca46SMatthew G. Knepley   PetscScalar *dots;
38312adca46SMatthew G. Knepley   PetscInt     dim, dimEmbed, n, m, b, d, i, j, off;
38412adca46SMatthew G. Knepley 
38512adca46SMatthew G. Knepley   PetscFunctionBegin;
3869566063dSJacob Faibussowitsch   PetscCall(PetscObjectGetComm((PetscObject)dm, &comm));
3879566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
3889566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateDim(dm, &dimEmbed));
3899566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
3909566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dm, &globalSection));
3919566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetConstrainedStorageSize(globalSection, &n));
39212adca46SMatthew G. Knepley   m = nb * (dim * (dim + 1)) / 2;
3939566063dSJacob Faibussowitsch   PetscCall(PetscMalloc2(m, &mode, m, &dots));
3949566063dSJacob Faibussowitsch   PetscCall(VecCreate(comm, &mode[0]));
3959566063dSJacob Faibussowitsch   PetscCall(VecSetSizes(mode[0], n, PETSC_DETERMINE));
3969566063dSJacob Faibussowitsch   PetscCall(VecSetUp(mode[0]));
3979566063dSJacob Faibussowitsch   for (i = 1; i < m; ++i) PetscCall(VecDuplicate(mode[0], &mode[i]));
39812adca46SMatthew G. Knepley   for (b = 0, off = 0; b < nb; ++b) {
39912adca46SMatthew G. Knepley     for (d = 0; d < m / nb; ++d) {
40012adca46SMatthew G. Knepley       PetscInt ctx[2];
40112adca46SMatthew G. Knepley       PetscErrorCode (*func)(PetscInt, PetscReal, const PetscReal *, PetscInt, PetscScalar *, void *) = DMPlexProjectRigidBody_Private;
40212adca46SMatthew G. Knepley       void *voidctx                                                                                   = (void *)(&ctx[0]);
40312adca46SMatthew G. Knepley 
40412adca46SMatthew G. Knepley       ctx[0] = dimEmbed;
40512adca46SMatthew G. Knepley       ctx[1] = d;
4069566063dSJacob Faibussowitsch       PetscCall(DMProjectFunctionLabel(dm, 0.0, label, nids[b], &ids[off], 0, NULL, &func, &voidctx, INSERT_VALUES, mode[d]));
40712adca46SMatthew G. Knepley       off += nids[b];
40812adca46SMatthew G. Knepley     }
40912adca46SMatthew G. Knepley   }
4103b2202bfSJacob Faibussowitsch   /* Orthonormalize system */
411606c1a1cSJacob Faibussowitsch   for (i = 0; i < m; ++i) {
412b77f2eeeSJacob Faibussowitsch     PetscScalar dots[6];
4135a0e29b9SJacob Faibussowitsch 
4149566063dSJacob Faibussowitsch     PetscCall(VecNormalize(mode[i], NULL));
4159566063dSJacob Faibussowitsch     PetscCall(VecMDot(mode[i], m - i - 1, mode + i + 1, dots + i + 1));
4165a0e29b9SJacob Faibussowitsch     for (j = i + 1; j < m; ++j) {
417b77f2eeeSJacob Faibussowitsch       dots[j] *= -1.0;
4189566063dSJacob Faibussowitsch       PetscCall(VecAXPY(mode[j], dots[j], mode[i]));
4195a0e29b9SJacob Faibussowitsch     }
42012adca46SMatthew G. Knepley   }
4219566063dSJacob Faibussowitsch   PetscCall(MatNullSpaceCreate(comm, PETSC_FALSE, m, mode, sp));
4229566063dSJacob Faibussowitsch   for (i = 0; i < m; ++i) PetscCall(VecDestroy(&mode[i]));
4239566063dSJacob Faibussowitsch   PetscCall(PetscFree2(mode, dots));
4243ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
42512adca46SMatthew G. Knepley }
42612adca46SMatthew G. Knepley 
427b29cfa1cSToby Isaac /*@
428b29cfa1cSToby Isaac   DMPlexSetMaxProjectionHeight - In DMPlexProjectXXXLocal() functions, the projected values of a basis function's dofs
429b29cfa1cSToby Isaac   are computed by associating the basis function with one of the mesh points in its transitively-closed support, and
430a4e35b19SJacob Faibussowitsch   evaluating the dual space basis of that point.
431b29cfa1cSToby Isaac 
432b29cfa1cSToby Isaac   Input Parameters:
433a1cb98faSBarry Smith + dm     - the `DMPLEX` object
434b29cfa1cSToby Isaac - height - the maximum projection height >= 0
435b29cfa1cSToby Isaac 
436b29cfa1cSToby Isaac   Level: advanced
437b29cfa1cSToby Isaac 
438a4e35b19SJacob Faibussowitsch   Notes:
439a4e35b19SJacob Faibussowitsch   A basis function is associated with the point in its transitively-closed support whose mesh
440a4e35b19SJacob Faibussowitsch   height is highest (w.r.t. DAG height), but not greater than the maximum projection height,
441a4e35b19SJacob Faibussowitsch   which is set with this function.  By default, the maximum projection height is zero, which
442a4e35b19SJacob Faibussowitsch   means that only mesh cells are used to project basis functions.  A height of one, for
443a4e35b19SJacob Faibussowitsch   example, evaluates a cell-interior basis functions using its cells dual space basis, but all
444a4e35b19SJacob Faibussowitsch   other basis functions with the dual space basis of a face.
445a4e35b19SJacob Faibussowitsch 
4461cc06b55SBarry Smith .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `DMPlexGetMaxProjectionHeight()`, `DMProjectFunctionLocal()`, `DMProjectFunctionLabelLocal()`
447b29cfa1cSToby Isaac @*/
448d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexSetMaxProjectionHeight(DM dm, PetscInt height)
449d71ae5a4SJacob Faibussowitsch {
450b29cfa1cSToby Isaac   DM_Plex *plex = (DM_Plex *)dm->data;
451b29cfa1cSToby Isaac 
452b29cfa1cSToby Isaac   PetscFunctionBegin;
453b29cfa1cSToby Isaac   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
454b29cfa1cSToby Isaac   plex->maxProjectionHeight = height;
4553ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
456b29cfa1cSToby Isaac }
457b29cfa1cSToby Isaac 
458b29cfa1cSToby Isaac /*@
459b29cfa1cSToby Isaac   DMPlexGetMaxProjectionHeight - Get the maximum height (w.r.t. DAG) of mesh points used to evaluate dual bases in
460b29cfa1cSToby Isaac   DMPlexProjectXXXLocal() functions.
461b29cfa1cSToby Isaac 
4622fe279fdSBarry Smith   Input Parameter:
463a1cb98faSBarry Smith . dm - the `DMPLEX` object
464b29cfa1cSToby Isaac 
4652fe279fdSBarry Smith   Output Parameter:
466b29cfa1cSToby Isaac . height - the maximum projection height
467b29cfa1cSToby Isaac 
468b29cfa1cSToby Isaac   Level: intermediate
469b29cfa1cSToby Isaac 
4701cc06b55SBarry Smith .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `DMPlexSetMaxProjectionHeight()`, `DMProjectFunctionLocal()`, `DMProjectFunctionLabelLocal()`
471b29cfa1cSToby Isaac @*/
472d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexGetMaxProjectionHeight(DM dm, PetscInt *height)
473d71ae5a4SJacob Faibussowitsch {
474b29cfa1cSToby Isaac   DM_Plex *plex = (DM_Plex *)dm->data;
475b29cfa1cSToby Isaac 
476b29cfa1cSToby Isaac   PetscFunctionBegin;
477b29cfa1cSToby Isaac   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
478b29cfa1cSToby Isaac   *height = plex->maxProjectionHeight;
4793ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
480b29cfa1cSToby Isaac }
481b29cfa1cSToby Isaac 
482ca3d3a14SMatthew G. Knepley typedef struct {
483ca3d3a14SMatthew G. Knepley   PetscReal    alpha; /* The first Euler angle, and in 2D the only one */
484ca3d3a14SMatthew G. Knepley   PetscReal    beta;  /* The second Euler angle */
485ca3d3a14SMatthew G. Knepley   PetscReal    gamma; /* The third Euler angle */
486ca3d3a14SMatthew G. Knepley   PetscInt     dim;   /* The dimension of R */
487ca3d3a14SMatthew G. Knepley   PetscScalar *R;     /* The rotation matrix, transforming a vector in the local basis to the global basis */
488ca3d3a14SMatthew G. Knepley   PetscScalar *RT;    /* The transposed rotation matrix, transforming a vector in the global basis to the local basis */
489ca3d3a14SMatthew G. Knepley } RotCtx;
490ca3d3a14SMatthew G. Knepley 
491ca3d3a14SMatthew G. Knepley /*
492ca3d3a14SMatthew G. Knepley   Note: Following https://en.wikipedia.org/wiki/Euler_angles, we will specify Euler angles by extrinsic rotations, meaning that
493ca3d3a14SMatthew 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:
494ca3d3a14SMatthew 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.
495ca3d3a14SMatthew 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.
496ca3d3a14SMatthew G. Knepley   $ The XYZ system rotates a third time about the z axis by gamma.
497ca3d3a14SMatthew G. Knepley */
498d71ae5a4SJacob Faibussowitsch static PetscErrorCode DMPlexBasisTransformSetUp_Rotation_Internal(DM dm, void *ctx)
499d71ae5a4SJacob Faibussowitsch {
500ca3d3a14SMatthew G. Knepley   RotCtx   *rc  = (RotCtx *)ctx;
501ca3d3a14SMatthew G. Knepley   PetscInt  dim = rc->dim;
502ca3d3a14SMatthew G. Knepley   PetscReal c1, s1, c2, s2, c3, s3;
503ca3d3a14SMatthew G. Knepley 
504ca3d3a14SMatthew G. Knepley   PetscFunctionBegin;
5059566063dSJacob Faibussowitsch   PetscCall(PetscMalloc2(PetscSqr(dim), &rc->R, PetscSqr(dim), &rc->RT));
506ca3d3a14SMatthew G. Knepley   switch (dim) {
507ca3d3a14SMatthew G. Knepley   case 2:
5089371c9d4SSatish Balay     c1       = PetscCosReal(rc->alpha);
5099371c9d4SSatish Balay     s1       = PetscSinReal(rc->alpha);
5109371c9d4SSatish Balay     rc->R[0] = c1;
5119371c9d4SSatish Balay     rc->R[1] = s1;
5129371c9d4SSatish Balay     rc->R[2] = -s1;
5139371c9d4SSatish Balay     rc->R[3] = c1;
5149566063dSJacob Faibussowitsch     PetscCall(PetscArraycpy(rc->RT, rc->R, PetscSqr(dim)));
515b458e8f1SJose E. Roman     DMPlex_Transpose2D_Internal(rc->RT);
516ca3d3a14SMatthew G. Knepley     break;
517ca3d3a14SMatthew G. Knepley   case 3:
5189371c9d4SSatish Balay     c1       = PetscCosReal(rc->alpha);
5199371c9d4SSatish Balay     s1       = PetscSinReal(rc->alpha);
5209371c9d4SSatish Balay     c2       = PetscCosReal(rc->beta);
5219371c9d4SSatish Balay     s2       = PetscSinReal(rc->beta);
5229371c9d4SSatish Balay     c3       = PetscCosReal(rc->gamma);
5239371c9d4SSatish Balay     s3       = PetscSinReal(rc->gamma);
5249371c9d4SSatish Balay     rc->R[0] = c1 * c3 - c2 * s1 * s3;
5259371c9d4SSatish Balay     rc->R[1] = c3 * s1 + c1 * c2 * s3;
5269371c9d4SSatish Balay     rc->R[2] = s2 * s3;
5279371c9d4SSatish Balay     rc->R[3] = -c1 * s3 - c2 * c3 * s1;
5289371c9d4SSatish Balay     rc->R[4] = c1 * c2 * c3 - s1 * s3;
5299371c9d4SSatish Balay     rc->R[5] = c3 * s2;
5309371c9d4SSatish Balay     rc->R[6] = s1 * s2;
5319371c9d4SSatish Balay     rc->R[7] = -c1 * s2;
5329371c9d4SSatish Balay     rc->R[8] = c2;
5339566063dSJacob Faibussowitsch     PetscCall(PetscArraycpy(rc->RT, rc->R, PetscSqr(dim)));
534b458e8f1SJose E. Roman     DMPlex_Transpose3D_Internal(rc->RT);
535ca3d3a14SMatthew G. Knepley     break;
536d71ae5a4SJacob Faibussowitsch   default:
537d71ae5a4SJacob Faibussowitsch     SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_OUTOFRANGE, "Dimension %" PetscInt_FMT " not supported", dim);
538ca3d3a14SMatthew G. Knepley   }
5393ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
540ca3d3a14SMatthew G. Knepley }
541ca3d3a14SMatthew G. Knepley 
542d71ae5a4SJacob Faibussowitsch static PetscErrorCode DMPlexBasisTransformDestroy_Rotation_Internal(DM dm, void *ctx)
543d71ae5a4SJacob Faibussowitsch {
544ca3d3a14SMatthew G. Knepley   RotCtx *rc = (RotCtx *)ctx;
545ca3d3a14SMatthew G. Knepley 
546ca3d3a14SMatthew G. Knepley   PetscFunctionBegin;
5479566063dSJacob Faibussowitsch   PetscCall(PetscFree2(rc->R, rc->RT));
5489566063dSJacob Faibussowitsch   PetscCall(PetscFree(rc));
5493ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
550ca3d3a14SMatthew G. Knepley }
551ca3d3a14SMatthew G. Knepley 
552d71ae5a4SJacob Faibussowitsch static PetscErrorCode DMPlexBasisTransformGetMatrix_Rotation_Internal(DM dm, const PetscReal x[], PetscBool l2g, const PetscScalar **A, void *ctx)
553d71ae5a4SJacob Faibussowitsch {
554ca3d3a14SMatthew G. Knepley   RotCtx *rc = (RotCtx *)ctx;
555ca3d3a14SMatthew G. Knepley 
556ca3d3a14SMatthew G. Knepley   PetscFunctionBeginHot;
5574f572ea9SToby Isaac   PetscAssertPointer(ctx, 5);
5589371c9d4SSatish Balay   if (l2g) {
5599371c9d4SSatish Balay     *A = rc->R;
5609371c9d4SSatish Balay   } else {
5619371c9d4SSatish Balay     *A = rc->RT;
5629371c9d4SSatish Balay   }
5633ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
564ca3d3a14SMatthew G. Knepley }
565ca3d3a14SMatthew G. Knepley 
566d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexBasisTransformApplyReal_Internal(DM dm, const PetscReal x[], PetscBool l2g, PetscInt dim, const PetscReal *y, PetscReal *z, void *ctx)
567d71ae5a4SJacob Faibussowitsch {
568ec277c0fSMatthew G. Knepley   PetscFunctionBegin;
569ab6a9622SMatthew G. Knepley #if defined(PETSC_USE_COMPLEX)
570ab6a9622SMatthew G. Knepley   switch (dim) {
5719371c9d4SSatish Balay   case 2: {
57227104ee2SJacob Faibussowitsch     PetscScalar yt[2] = {y[0], y[1]}, zt[2] = {0.0, 0.0};
573ab6a9622SMatthew G. Knepley 
5749566063dSJacob Faibussowitsch     PetscCall(DMPlexBasisTransformApply_Internal(dm, x, l2g, dim, yt, zt, ctx));
5759371c9d4SSatish Balay     z[0] = PetscRealPart(zt[0]);
5769371c9d4SSatish Balay     z[1] = PetscRealPart(zt[1]);
5779371c9d4SSatish Balay   } break;
5789371c9d4SSatish Balay   case 3: {
57927104ee2SJacob Faibussowitsch     PetscScalar yt[3] = {y[0], y[1], y[2]}, zt[3] = {0.0, 0.0, 0.0};
580ab6a9622SMatthew G. Knepley 
5819566063dSJacob Faibussowitsch     PetscCall(DMPlexBasisTransformApply_Internal(dm, x, l2g, dim, yt, zt, ctx));
5829371c9d4SSatish Balay     z[0] = PetscRealPart(zt[0]);
5839371c9d4SSatish Balay     z[1] = PetscRealPart(zt[1]);
5849371c9d4SSatish Balay     z[2] = PetscRealPart(zt[2]);
5859371c9d4SSatish Balay   } break;
586ab6a9622SMatthew G. Knepley   }
587ab6a9622SMatthew G. Knepley #else
5889566063dSJacob Faibussowitsch   PetscCall(DMPlexBasisTransformApply_Internal(dm, x, l2g, dim, y, z, ctx));
589ab6a9622SMatthew G. Knepley #endif
5903ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
591ab6a9622SMatthew G. Knepley }
592ab6a9622SMatthew G. Knepley 
593d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexBasisTransformApply_Internal(DM dm, const PetscReal x[], PetscBool l2g, PetscInt dim, const PetscScalar *y, PetscScalar *z, void *ctx)
594d71ae5a4SJacob Faibussowitsch {
595ca3d3a14SMatthew G. Knepley   const PetscScalar *A;
596ca3d3a14SMatthew G. Knepley 
597ca3d3a14SMatthew G. Knepley   PetscFunctionBeginHot;
5989566063dSJacob Faibussowitsch   PetscCall((*dm->transformGetMatrix)(dm, x, l2g, &A, ctx));
599ca3d3a14SMatthew G. Knepley   switch (dim) {
600d71ae5a4SJacob Faibussowitsch   case 2:
601d71ae5a4SJacob Faibussowitsch     DMPlex_Mult2D_Internal(A, 1, y, z);
602d71ae5a4SJacob Faibussowitsch     break;
603d71ae5a4SJacob Faibussowitsch   case 3:
604d71ae5a4SJacob Faibussowitsch     DMPlex_Mult3D_Internal(A, 1, y, z);
605d71ae5a4SJacob Faibussowitsch     break;
606ca3d3a14SMatthew G. Knepley   }
6073ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
608ca3d3a14SMatthew G. Knepley }
609ca3d3a14SMatthew G. Knepley 
610d71ae5a4SJacob Faibussowitsch static PetscErrorCode DMPlexBasisTransformField_Internal(DM dm, DM tdm, Vec tv, PetscInt p, PetscInt f, PetscBool l2g, PetscScalar *a)
611d71ae5a4SJacob Faibussowitsch {
612ca3d3a14SMatthew G. Knepley   PetscSection       ts;
613ca3d3a14SMatthew G. Knepley   const PetscScalar *ta, *tva;
614ca3d3a14SMatthew G. Knepley   PetscInt           dof;
615ca3d3a14SMatthew G. Knepley 
616ca3d3a14SMatthew G. Knepley   PetscFunctionBeginHot;
6179566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(tdm, &ts));
6189566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetFieldDof(ts, p, f, &dof));
6199566063dSJacob Faibussowitsch   PetscCall(VecGetArrayRead(tv, &ta));
6209566063dSJacob Faibussowitsch   PetscCall(DMPlexPointLocalFieldRead(tdm, p, f, ta, &tva));
621ca3d3a14SMatthew G. Knepley   if (l2g) {
622ca3d3a14SMatthew G. Knepley     switch (dof) {
623d71ae5a4SJacob Faibussowitsch     case 4:
624d71ae5a4SJacob Faibussowitsch       DMPlex_Mult2D_Internal(tva, 1, a, a);
625d71ae5a4SJacob Faibussowitsch       break;
626d71ae5a4SJacob Faibussowitsch     case 9:
627d71ae5a4SJacob Faibussowitsch       DMPlex_Mult3D_Internal(tva, 1, a, a);
628d71ae5a4SJacob Faibussowitsch       break;
629ca3d3a14SMatthew G. Knepley     }
630ca3d3a14SMatthew G. Knepley   } else {
631ca3d3a14SMatthew G. Knepley     switch (dof) {
632d71ae5a4SJacob Faibussowitsch     case 4:
633d71ae5a4SJacob Faibussowitsch       DMPlex_MultTranspose2D_Internal(tva, 1, a, a);
634d71ae5a4SJacob Faibussowitsch       break;
635d71ae5a4SJacob Faibussowitsch     case 9:
636d71ae5a4SJacob Faibussowitsch       DMPlex_MultTranspose3D_Internal(tva, 1, a, a);
637d71ae5a4SJacob Faibussowitsch       break;
638ca3d3a14SMatthew G. Knepley     }
639ca3d3a14SMatthew G. Knepley   }
6409566063dSJacob Faibussowitsch   PetscCall(VecRestoreArrayRead(tv, &ta));
6413ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
642ca3d3a14SMatthew G. Knepley }
643ca3d3a14SMatthew G. Knepley 
644d71ae5a4SJacob Faibussowitsch static PetscErrorCode DMPlexBasisTransformFieldTensor_Internal(DM dm, DM tdm, Vec tv, PetscInt pf, PetscInt f, PetscInt pg, PetscInt g, PetscBool l2g, PetscInt lda, PetscScalar *a)
645d71ae5a4SJacob Faibussowitsch {
646ca3d3a14SMatthew G. Knepley   PetscSection       s, ts;
647ca3d3a14SMatthew G. Knepley   const PetscScalar *ta, *tvaf, *tvag;
648ca3d3a14SMatthew G. Knepley   PetscInt           fdof, gdof, fpdof, gpdof;
649ca3d3a14SMatthew G. Knepley 
650ca3d3a14SMatthew G. Knepley   PetscFunctionBeginHot;
6519566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &s));
6529566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(tdm, &ts));
6539566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetFieldDof(s, pf, f, &fpdof));
6549566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetFieldDof(s, pg, g, &gpdof));
6559566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetFieldDof(ts, pf, f, &fdof));
6569566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetFieldDof(ts, pg, g, &gdof));
6579566063dSJacob Faibussowitsch   PetscCall(VecGetArrayRead(tv, &ta));
6589566063dSJacob Faibussowitsch   PetscCall(DMPlexPointLocalFieldRead(tdm, pf, f, ta, &tvaf));
6599566063dSJacob Faibussowitsch   PetscCall(DMPlexPointLocalFieldRead(tdm, pg, g, ta, &tvag));
660ca3d3a14SMatthew G. Knepley   if (l2g) {
661ca3d3a14SMatthew G. Knepley     switch (fdof) {
662d71ae5a4SJacob Faibussowitsch     case 4:
663d71ae5a4SJacob Faibussowitsch       DMPlex_MatMult2D_Internal(tvaf, gpdof, lda, a, a);
664d71ae5a4SJacob Faibussowitsch       break;
665d71ae5a4SJacob Faibussowitsch     case 9:
666d71ae5a4SJacob Faibussowitsch       DMPlex_MatMult3D_Internal(tvaf, gpdof, lda, a, a);
667d71ae5a4SJacob Faibussowitsch       break;
668ca3d3a14SMatthew G. Knepley     }
669ca3d3a14SMatthew G. Knepley     switch (gdof) {
670d71ae5a4SJacob Faibussowitsch     case 4:
671d71ae5a4SJacob Faibussowitsch       DMPlex_MatMultTransposeLeft2D_Internal(tvag, fpdof, lda, a, a);
672d71ae5a4SJacob Faibussowitsch       break;
673d71ae5a4SJacob Faibussowitsch     case 9:
674d71ae5a4SJacob Faibussowitsch       DMPlex_MatMultTransposeLeft3D_Internal(tvag, fpdof, lda, a, a);
675d71ae5a4SJacob Faibussowitsch       break;
676ca3d3a14SMatthew G. Knepley     }
677ca3d3a14SMatthew G. Knepley   } else {
678ca3d3a14SMatthew G. Knepley     switch (fdof) {
679d71ae5a4SJacob Faibussowitsch     case 4:
680d71ae5a4SJacob Faibussowitsch       DMPlex_MatMultTranspose2D_Internal(tvaf, gpdof, lda, a, a);
681d71ae5a4SJacob Faibussowitsch       break;
682d71ae5a4SJacob Faibussowitsch     case 9:
683d71ae5a4SJacob Faibussowitsch       DMPlex_MatMultTranspose3D_Internal(tvaf, gpdof, lda, a, a);
684d71ae5a4SJacob Faibussowitsch       break;
685ca3d3a14SMatthew G. Knepley     }
686ca3d3a14SMatthew G. Knepley     switch (gdof) {
687d71ae5a4SJacob Faibussowitsch     case 4:
688d71ae5a4SJacob Faibussowitsch       DMPlex_MatMultLeft2D_Internal(tvag, fpdof, lda, a, a);
689d71ae5a4SJacob Faibussowitsch       break;
690d71ae5a4SJacob Faibussowitsch     case 9:
691d71ae5a4SJacob Faibussowitsch       DMPlex_MatMultLeft3D_Internal(tvag, fpdof, lda, a, a);
692d71ae5a4SJacob Faibussowitsch       break;
693ca3d3a14SMatthew G. Knepley     }
694ca3d3a14SMatthew G. Knepley   }
6959566063dSJacob Faibussowitsch   PetscCall(VecRestoreArrayRead(tv, &ta));
6963ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
697ca3d3a14SMatthew G. Knepley }
698ca3d3a14SMatthew G. Knepley 
699d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexBasisTransformPoint_Internal(DM dm, DM tdm, Vec tv, PetscInt p, PetscBool fieldActive[], PetscBool l2g, PetscScalar *a)
700d71ae5a4SJacob Faibussowitsch {
701ca3d3a14SMatthew G. Knepley   PetscSection    s;
702ca3d3a14SMatthew G. Knepley   PetscSection    clSection;
703ca3d3a14SMatthew G. Knepley   IS              clPoints;
704ca3d3a14SMatthew G. Knepley   const PetscInt *clp;
705ca3d3a14SMatthew G. Knepley   PetscInt       *points = NULL;
706ca3d3a14SMatthew G. Knepley   PetscInt        Nf, f, Np, cp, dof, d = 0;
707ca3d3a14SMatthew G. Knepley 
708ca3d3a14SMatthew G. Knepley   PetscFunctionBegin;
7099566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &s));
7109566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetNumFields(s, &Nf));
71107218a29SMatthew G. Knepley   PetscCall(DMPlexGetCompressedClosure(dm, s, p, 0, &Np, &points, &clSection, &clPoints, &clp));
712ca3d3a14SMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
713ca3d3a14SMatthew G. Knepley     for (cp = 0; cp < Np * 2; cp += 2) {
7149566063dSJacob Faibussowitsch       PetscCall(PetscSectionGetFieldDof(s, points[cp], f, &dof));
715ca3d3a14SMatthew G. Knepley       if (!dof) continue;
7169566063dSJacob Faibussowitsch       if (fieldActive[f]) PetscCall(DMPlexBasisTransformField_Internal(dm, tdm, tv, points[cp], f, l2g, &a[d]));
717ca3d3a14SMatthew G. Knepley       d += dof;
718ca3d3a14SMatthew G. Knepley     }
719ca3d3a14SMatthew G. Knepley   }
7209566063dSJacob Faibussowitsch   PetscCall(DMPlexRestoreCompressedClosure(dm, s, p, &Np, &points, &clSection, &clPoints, &clp));
7213ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
722ca3d3a14SMatthew G. Knepley }
723ca3d3a14SMatthew G. Knepley 
724d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexBasisTransformPointTensor_Internal(DM dm, DM tdm, Vec tv, PetscInt p, PetscBool l2g, PetscInt lda, PetscScalar *a)
725d71ae5a4SJacob Faibussowitsch {
726ca3d3a14SMatthew G. Knepley   PetscSection    s;
727ca3d3a14SMatthew G. Knepley   PetscSection    clSection;
728ca3d3a14SMatthew G. Knepley   IS              clPoints;
729ca3d3a14SMatthew G. Knepley   const PetscInt *clp;
730ca3d3a14SMatthew G. Knepley   PetscInt       *points = NULL;
7318bdb3c71SMatthew G. Knepley   PetscInt        Nf, f, g, Np, cpf, cpg, fdof, gdof, r, c = 0;
732ca3d3a14SMatthew G. Knepley 
733ca3d3a14SMatthew G. Knepley   PetscFunctionBegin;
7349566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &s));
7359566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetNumFields(s, &Nf));
73607218a29SMatthew G. Knepley   PetscCall(DMPlexGetCompressedClosure(dm, s, p, 0, &Np, &points, &clSection, &clPoints, &clp));
737ca3d3a14SMatthew G. Knepley   for (f = 0, r = 0; f < Nf; ++f) {
738ca3d3a14SMatthew G. Knepley     for (cpf = 0; cpf < Np * 2; cpf += 2) {
7399566063dSJacob Faibussowitsch       PetscCall(PetscSectionGetFieldDof(s, points[cpf], f, &fdof));
740ca3d3a14SMatthew G. Knepley       for (g = 0, c = 0; g < Nf; ++g) {
741ca3d3a14SMatthew G. Knepley         for (cpg = 0; cpg < Np * 2; cpg += 2) {
7429566063dSJacob Faibussowitsch           PetscCall(PetscSectionGetFieldDof(s, points[cpg], g, &gdof));
7439566063dSJacob Faibussowitsch           PetscCall(DMPlexBasisTransformFieldTensor_Internal(dm, tdm, tv, points[cpf], f, points[cpg], g, l2g, lda, &a[r * lda + c]));
744ca3d3a14SMatthew G. Knepley           c += gdof;
745ca3d3a14SMatthew G. Knepley         }
746ca3d3a14SMatthew G. Knepley       }
74763a3b9bcSJacob Faibussowitsch       PetscCheck(c == lda, PETSC_COMM_SELF, PETSC_ERR_PLIB, "Invalid number of columns %" PetscInt_FMT " should be %" PetscInt_FMT, c, lda);
748ca3d3a14SMatthew G. Knepley       r += fdof;
749ca3d3a14SMatthew G. Knepley     }
750ca3d3a14SMatthew G. Knepley   }
75163a3b9bcSJacob Faibussowitsch   PetscCheck(r == lda, PETSC_COMM_SELF, PETSC_ERR_PLIB, "Invalid number of rows %" PetscInt_FMT " should be %" PetscInt_FMT, c, lda);
7529566063dSJacob Faibussowitsch   PetscCall(DMPlexRestoreCompressedClosure(dm, s, p, &Np, &points, &clSection, &clPoints, &clp));
7533ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
754ca3d3a14SMatthew G. Knepley }
755ca3d3a14SMatthew G. Knepley 
756d71ae5a4SJacob Faibussowitsch static PetscErrorCode DMPlexBasisTransform_Internal(DM dm, Vec lv, PetscBool l2g)
757d71ae5a4SJacob Faibussowitsch {
758ca3d3a14SMatthew G. Knepley   DM                 tdm;
759ca3d3a14SMatthew G. Knepley   Vec                tv;
760ca3d3a14SMatthew G. Knepley   PetscSection       ts, s;
761ca3d3a14SMatthew G. Knepley   const PetscScalar *ta;
762ca3d3a14SMatthew G. Knepley   PetscScalar       *a, *va;
763ca3d3a14SMatthew G. Knepley   PetscInt           pStart, pEnd, p, Nf, f;
764ca3d3a14SMatthew G. Knepley 
765ca3d3a14SMatthew G. Knepley   PetscFunctionBegin;
7669566063dSJacob Faibussowitsch   PetscCall(DMGetBasisTransformDM_Internal(dm, &tdm));
7679566063dSJacob Faibussowitsch   PetscCall(DMGetBasisTransformVec_Internal(dm, &tv));
7689566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(tdm, &ts));
7699566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &s));
7709566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetChart(s, &pStart, &pEnd));
7719566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetNumFields(s, &Nf));
7729566063dSJacob Faibussowitsch   PetscCall(VecGetArray(lv, &a));
7739566063dSJacob Faibussowitsch   PetscCall(VecGetArrayRead(tv, &ta));
774ca3d3a14SMatthew G. Knepley   for (p = pStart; p < pEnd; ++p) {
775ca3d3a14SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
7769566063dSJacob Faibussowitsch       PetscCall(DMPlexPointLocalFieldRef(dm, p, f, a, &va));
7779566063dSJacob Faibussowitsch       PetscCall(DMPlexBasisTransformField_Internal(dm, tdm, tv, p, f, l2g, va));
778ca3d3a14SMatthew G. Knepley     }
779ca3d3a14SMatthew G. Knepley   }
7809566063dSJacob Faibussowitsch   PetscCall(VecRestoreArray(lv, &a));
7819566063dSJacob Faibussowitsch   PetscCall(VecRestoreArrayRead(tv, &ta));
7823ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
783ca3d3a14SMatthew G. Knepley }
784ca3d3a14SMatthew G. Knepley 
785ca3d3a14SMatthew G. Knepley /*@
786ca3d3a14SMatthew G. Knepley   DMPlexGlobalToLocalBasis - Transform the values in the given local vector from the global basis to the local basis
787ca3d3a14SMatthew G. Knepley 
788ca3d3a14SMatthew G. Knepley   Input Parameters:
789a1cb98faSBarry Smith + dm - The `DM`
790ca3d3a14SMatthew G. Knepley - lv - A local vector with values in the global basis
791ca3d3a14SMatthew G. Knepley 
7922fe279fdSBarry Smith   Output Parameter:
793ca3d3a14SMatthew G. Knepley . lv - A local vector with values in the local basis
794ca3d3a14SMatthew G. Knepley 
795ca3d3a14SMatthew G. Knepley   Level: developer
796ca3d3a14SMatthew G. Knepley 
797a1cb98faSBarry Smith   Note:
798a1cb98faSBarry Smith   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.
799a1cb98faSBarry Smith 
8001cc06b55SBarry Smith .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `DMPlexLocalToGlobalBasis()`, `DMGetLocalSection()`, `DMPlexCreateBasisRotation()`
801ca3d3a14SMatthew G. Knepley @*/
802d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexGlobalToLocalBasis(DM dm, Vec lv)
803d71ae5a4SJacob Faibussowitsch {
804ca3d3a14SMatthew G. Knepley   PetscFunctionBegin;
805ca3d3a14SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
806ca3d3a14SMatthew G. Knepley   PetscValidHeaderSpecific(lv, VEC_CLASSID, 2);
8079566063dSJacob Faibussowitsch   PetscCall(DMPlexBasisTransform_Internal(dm, lv, PETSC_FALSE));
8083ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
809ca3d3a14SMatthew G. Knepley }
810ca3d3a14SMatthew G. Knepley 
811ca3d3a14SMatthew G. Knepley /*@
812ca3d3a14SMatthew G. Knepley   DMPlexLocalToGlobalBasis - Transform the values in the given local vector from the local basis to the global basis
813ca3d3a14SMatthew G. Knepley 
814ca3d3a14SMatthew G. Knepley   Input Parameters:
815a1cb98faSBarry Smith + dm - The `DM`
816ca3d3a14SMatthew G. Knepley - lv - A local vector with values in the local basis
817ca3d3a14SMatthew G. Knepley 
8182fe279fdSBarry Smith   Output Parameter:
819ca3d3a14SMatthew G. Knepley . lv - A local vector with values in the global basis
820ca3d3a14SMatthew G. Knepley 
821ca3d3a14SMatthew G. Knepley   Level: developer
822ca3d3a14SMatthew G. Knepley 
823a1cb98faSBarry Smith   Note:
824a1cb98faSBarry Smith   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.
825a1cb98faSBarry Smith 
8261cc06b55SBarry Smith .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `DMPlexGlobalToLocalBasis()`, `DMGetLocalSection()`, `DMPlexCreateBasisRotation()`
827ca3d3a14SMatthew G. Knepley @*/
828d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexLocalToGlobalBasis(DM dm, Vec lv)
829d71ae5a4SJacob Faibussowitsch {
830ca3d3a14SMatthew G. Knepley   PetscFunctionBegin;
831ca3d3a14SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
832ca3d3a14SMatthew G. Knepley   PetscValidHeaderSpecific(lv, VEC_CLASSID, 2);
8339566063dSJacob Faibussowitsch   PetscCall(DMPlexBasisTransform_Internal(dm, lv, PETSC_TRUE));
8343ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
835ca3d3a14SMatthew G. Knepley }
836ca3d3a14SMatthew G. Knepley 
837ca3d3a14SMatthew G. Knepley /*@
838ca3d3a14SMatthew G. Knepley   DMPlexCreateBasisRotation - Create an internal transformation from the global basis, used to specify boundary conditions
839ca3d3a14SMatthew G. Knepley   and global solutions, to a local basis, appropriate for discretization integrals and assembly.
840ca3d3a14SMatthew G. Knepley 
841ca3d3a14SMatthew G. Knepley   Input Parameters:
842a1cb98faSBarry Smith + dm    - The `DM`
843ca3d3a14SMatthew G. Knepley . alpha - The first Euler angle, and in 2D the only one
844ca3d3a14SMatthew G. Knepley . beta  - The second Euler angle
845f0fc11ceSJed Brown - gamma - The third Euler angle
846ca3d3a14SMatthew G. Knepley 
847ca3d3a14SMatthew G. Knepley   Level: developer
848ca3d3a14SMatthew G. Knepley 
849a1cb98faSBarry Smith   Note:
850a1cb98faSBarry Smith   Following https://en.wikipedia.org/wiki/Euler_angles, we will specify Euler angles by extrinsic rotations, meaning that
851a1cb98faSBarry Smith   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
852a1cb98faSBarry Smith .vb
853a1cb98faSBarry Smith    The XYZ system rotates about the z axis by alpha. The X axis is now at angle alpha with respect to the x axis.
854a1cb98faSBarry Smith    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.
855a1cb98faSBarry Smith    The XYZ system rotates a third time about the z axis by gamma.
856a1cb98faSBarry Smith .ve
857a1cb98faSBarry Smith 
8581cc06b55SBarry Smith .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `DMPlexGlobalToLocalBasis()`, `DMPlexLocalToGlobalBasis()`
859ca3d3a14SMatthew G. Knepley @*/
860d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexCreateBasisRotation(DM dm, PetscReal alpha, PetscReal beta, PetscReal gamma)
861d71ae5a4SJacob Faibussowitsch {
862ca3d3a14SMatthew G. Knepley   RotCtx  *rc;
863ca3d3a14SMatthew G. Knepley   PetscInt cdim;
864ca3d3a14SMatthew G. Knepley 
865362febeeSStefano Zampini   PetscFunctionBegin;
8669566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateDim(dm, &cdim));
8679566063dSJacob Faibussowitsch   PetscCall(PetscMalloc1(1, &rc));
868ca3d3a14SMatthew G. Knepley   dm->transformCtx       = rc;
869ca3d3a14SMatthew G. Knepley   dm->transformSetUp     = DMPlexBasisTransformSetUp_Rotation_Internal;
870ca3d3a14SMatthew G. Knepley   dm->transformDestroy   = DMPlexBasisTransformDestroy_Rotation_Internal;
871ca3d3a14SMatthew G. Knepley   dm->transformGetMatrix = DMPlexBasisTransformGetMatrix_Rotation_Internal;
872ca3d3a14SMatthew G. Knepley   rc->dim                = cdim;
873ca3d3a14SMatthew G. Knepley   rc->alpha              = alpha;
874ca3d3a14SMatthew G. Knepley   rc->beta               = beta;
875ca3d3a14SMatthew G. Knepley   rc->gamma              = gamma;
8769566063dSJacob Faibussowitsch   PetscCall((*dm->transformSetUp)(dm, dm->transformCtx));
8779566063dSJacob Faibussowitsch   PetscCall(DMConstructBasisTransform_Internal(dm));
8783ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
879ca3d3a14SMatthew G. Knepley }
880ca3d3a14SMatthew G. Knepley 
881b278463cSMatthew G. Knepley /*@C
882ece3a9fcSMatthew G. Knepley   DMPlexInsertBoundaryValuesEssential - Insert boundary values into a local vector using a function of the coordinates
883b278463cSMatthew G. Knepley 
884b278463cSMatthew G. Knepley   Input Parameters:
885a1cb98faSBarry Smith + dm     - The `DM`, with a `PetscDS` that matches the problem being constrained
886b278463cSMatthew G. Knepley . time   - The time
887b278463cSMatthew G. Knepley . field  - The field to constrain
8881c531cf8SMatthew G. Knepley . Nc     - The number of constrained field components, or 0 for all components
88920f4b53cSBarry Smith . comps  - An array of constrained component numbers, or `NULL` for all components
890a1cb98faSBarry Smith . label  - The `DMLabel` defining constrained points
891a1cb98faSBarry Smith . numids - The number of `DMLabel` ids for constrained points
892b278463cSMatthew G. Knepley . ids    - An array of ids for constrained points
893b278463cSMatthew G. Knepley . func   - A pointwise function giving boundary values
894b278463cSMatthew G. Knepley - ctx    - An optional user context for bcFunc
895b278463cSMatthew G. Knepley 
896b278463cSMatthew G. Knepley   Output Parameter:
897b278463cSMatthew G. Knepley . locX - A local vector to receives the boundary values
898b278463cSMatthew G. Knepley 
899b278463cSMatthew G. Knepley   Level: developer
900b278463cSMatthew G. Knepley 
9011cc06b55SBarry Smith .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `DMLabel`, `DMPlexInsertBoundaryValuesEssentialField()`, `DMPlexInsertBoundaryValuesEssentialBdField()`, `DMAddBoundary()`
902b278463cSMatthew G. Knepley @*/
903d71ae5a4SJacob Faibussowitsch 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)
904d71ae5a4SJacob Faibussowitsch {
9050163fd50SMatthew G. Knepley   PetscErrorCode (**funcs)(PetscInt, PetscReal, const PetscReal x[], PetscInt, PetscScalar *u, void *ctx);
90655f2e967SMatthew G. Knepley   void   **ctxs;
907d7ddef95SMatthew G. Knepley   PetscInt numFields;
908d7ddef95SMatthew G. Knepley 
909d7ddef95SMatthew G. Knepley   PetscFunctionBegin;
9109566063dSJacob Faibussowitsch   PetscCall(DMGetNumFields(dm, &numFields));
9119566063dSJacob Faibussowitsch   PetscCall(PetscCalloc2(numFields, &funcs, numFields, &ctxs));
912d7ddef95SMatthew G. Knepley   funcs[field] = func;
913d7ddef95SMatthew G. Knepley   ctxs[field]  = ctx;
9149566063dSJacob Faibussowitsch   PetscCall(DMProjectFunctionLabelLocal(dm, time, label, numids, ids, Nc, comps, funcs, ctxs, INSERT_BC_VALUES, locX));
9159566063dSJacob Faibussowitsch   PetscCall(PetscFree2(funcs, ctxs));
9163ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
917d7ddef95SMatthew G. Knepley }
918d7ddef95SMatthew G. Knepley 
919b278463cSMatthew G. Knepley /*@C
920ece3a9fcSMatthew G. Knepley   DMPlexInsertBoundaryValuesEssentialField - Insert boundary values into a local vector using a function of the coordinates and field data
921b278463cSMatthew G. Knepley 
922b278463cSMatthew G. Knepley   Input Parameters:
923a1cb98faSBarry Smith + dm     - The `DM`, with a `PetscDS` that matches the problem being constrained
924b278463cSMatthew G. Knepley . time   - The time
925b278463cSMatthew G. Knepley . locU   - A local vector with the input solution values
926b278463cSMatthew G. Knepley . field  - The field to constrain
9271c531cf8SMatthew G. Knepley . Nc     - The number of constrained field components, or 0 for all components
92820f4b53cSBarry Smith . comps  - An array of constrained component numbers, or `NULL` for all components
929a1cb98faSBarry Smith . label  - The `DMLabel` defining constrained points
930a1cb98faSBarry Smith . numids - The number of `DMLabel` ids for constrained points
931b278463cSMatthew G. Knepley . ids    - An array of ids for constrained points
932b278463cSMatthew G. Knepley . func   - A pointwise function giving boundary values
933b278463cSMatthew G. Knepley - ctx    - An optional user context for bcFunc
934b278463cSMatthew G. Knepley 
935b278463cSMatthew G. Knepley   Output Parameter:
936b278463cSMatthew G. Knepley . locX - A local vector to receives the boundary values
937b278463cSMatthew G. Knepley 
938b278463cSMatthew G. Knepley   Level: developer
939b278463cSMatthew G. Knepley 
9401cc06b55SBarry Smith .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `DMPlexInsertBoundaryValuesEssential()`, `DMPlexInsertBoundaryValuesEssentialBdField()`, `DMAddBoundary()`
941b278463cSMatthew G. Knepley @*/
942d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexInsertBoundaryValuesEssentialField(DM dm, PetscReal time, Vec locU, PetscInt field, PetscInt Nc, const PetscInt comps[], DMLabel label, PetscInt numids, const PetscInt ids[], void (*func)(PetscInt, PetscInt, PetscInt, const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[], PetscReal, const PetscReal[], PetscInt, const PetscScalar[], PetscScalar[]), void *ctx, Vec locX)
943d71ae5a4SJacob Faibussowitsch {
9449371c9d4SSatish Balay   void (**funcs)(PetscInt, PetscInt, PetscInt, const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[], PetscReal, const PetscReal[], PetscInt, const PetscScalar[], PetscScalar[]);
945c60e475cSMatthew G. Knepley   void   **ctxs;
946c60e475cSMatthew G. Knepley   PetscInt numFields;
947c60e475cSMatthew G. Knepley 
948c60e475cSMatthew G. Knepley   PetscFunctionBegin;
9499566063dSJacob Faibussowitsch   PetscCall(DMGetNumFields(dm, &numFields));
9509566063dSJacob Faibussowitsch   PetscCall(PetscCalloc2(numFields, &funcs, numFields, &ctxs));
951c60e475cSMatthew G. Knepley   funcs[field] = func;
952c60e475cSMatthew G. Knepley   ctxs[field]  = ctx;
9539566063dSJacob Faibussowitsch   PetscCall(DMProjectFieldLabelLocal(dm, time, label, numids, ids, Nc, comps, locU, funcs, INSERT_BC_VALUES, locX));
9549566063dSJacob Faibussowitsch   PetscCall(PetscFree2(funcs, ctxs));
9553ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
956c60e475cSMatthew G. Knepley }
957c60e475cSMatthew G. Knepley 
958b278463cSMatthew G. Knepley /*@C
959d5b43468SJose E. Roman   DMPlexInsertBoundaryValuesEssentialBdField - Insert boundary values into a local vector using a function of the coordinates and boundary field data
960ece3a9fcSMatthew G. Knepley 
96120f4b53cSBarry Smith   Collective
962ece3a9fcSMatthew G. Knepley 
963ece3a9fcSMatthew G. Knepley   Input Parameters:
964a1cb98faSBarry Smith + dm     - The `DM`, with a `PetscDS` that matches the problem being constrained
965ece3a9fcSMatthew G. Knepley . time   - The time
966ece3a9fcSMatthew G. Knepley . locU   - A local vector with the input solution values
967ece3a9fcSMatthew G. Knepley . field  - The field to constrain
968ece3a9fcSMatthew G. Knepley . Nc     - The number of constrained field components, or 0 for all components
96920f4b53cSBarry Smith . comps  - An array of constrained component numbers, or `NULL` for all components
970a1cb98faSBarry Smith . label  - The `DMLabel` defining constrained points
971a1cb98faSBarry Smith . numids - The number of `DMLabel` ids for constrained points
972ece3a9fcSMatthew G. Knepley . ids    - An array of ids for constrained points
97320f4b53cSBarry Smith . func   - A pointwise function giving boundary values, the calling sequence is given in `DMProjectBdFieldLabelLocal()`
97420f4b53cSBarry Smith - ctx    - An optional user context for `func`
975ece3a9fcSMatthew G. Knepley 
976ece3a9fcSMatthew G. Knepley   Output Parameter:
977ece3a9fcSMatthew G. Knepley . locX - A local vector to receive the boundary values
978ece3a9fcSMatthew G. Knepley 
979ece3a9fcSMatthew G. Knepley   Level: developer
980ece3a9fcSMatthew G. Knepley 
9811cc06b55SBarry Smith .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `DMProjectBdFieldLabelLocal()`, `DMPlexInsertBoundaryValuesEssential()`, `DMPlexInsertBoundaryValuesEssentialField()`, `DMAddBoundary()`
982ece3a9fcSMatthew G. Knepley @*/
983d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexInsertBoundaryValuesEssentialBdField(DM dm, PetscReal time, Vec locU, PetscInt field, PetscInt Nc, const PetscInt comps[], DMLabel label, PetscInt numids, const PetscInt ids[], void (*func)(PetscInt, PetscInt, PetscInt, const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[], PetscReal, const PetscReal[], const PetscReal[], PetscInt, const PetscScalar[], PetscScalar[]), void *ctx, Vec locX)
984d71ae5a4SJacob Faibussowitsch {
9859371c9d4SSatish Balay   void (**funcs)(PetscInt, PetscInt, PetscInt, const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[], PetscReal, const PetscReal[], const PetscReal[], PetscInt, const PetscScalar[], PetscScalar[]);
986ece3a9fcSMatthew G. Knepley   void   **ctxs;
987ece3a9fcSMatthew G. Knepley   PetscInt numFields;
988ece3a9fcSMatthew G. Knepley 
989ece3a9fcSMatthew G. Knepley   PetscFunctionBegin;
9909566063dSJacob Faibussowitsch   PetscCall(DMGetNumFields(dm, &numFields));
9919566063dSJacob Faibussowitsch   PetscCall(PetscCalloc2(numFields, &funcs, numFields, &ctxs));
992ece3a9fcSMatthew G. Knepley   funcs[field] = func;
993ece3a9fcSMatthew G. Knepley   ctxs[field]  = ctx;
9949566063dSJacob Faibussowitsch   PetscCall(DMProjectBdFieldLabelLocal(dm, time, label, numids, ids, Nc, comps, locU, funcs, INSERT_BC_VALUES, locX));
9959566063dSJacob Faibussowitsch   PetscCall(PetscFree2(funcs, ctxs));
9963ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
997ece3a9fcSMatthew G. Knepley }
998ece3a9fcSMatthew G. Knepley 
999ece3a9fcSMatthew G. Knepley /*@C
1000b278463cSMatthew G. Knepley   DMPlexInsertBoundaryValuesRiemann - Insert boundary values into a local vector
1001b278463cSMatthew G. Knepley 
1002b278463cSMatthew G. Knepley   Input Parameters:
1003a1cb98faSBarry Smith + dm           - The `DM`, with a `PetscDS` that matches the problem being constrained
1004b278463cSMatthew G. Knepley . time         - The time
1005b278463cSMatthew G. Knepley . faceGeometry - A vector with the FVM face geometry information
1006b278463cSMatthew G. Knepley . cellGeometry - A vector with the FVM cell geometry information
1007b278463cSMatthew G. Knepley . Grad         - A vector with the FVM cell gradient information
1008b278463cSMatthew G. Knepley . field        - The field to constrain
10091c531cf8SMatthew G. Knepley . Nc           - The number of constrained field components, or 0 for all components
101020f4b53cSBarry Smith . comps        - An array of constrained component numbers, or `NULL` for all components
1011a1cb98faSBarry Smith . label        - The `DMLabel` defining constrained points
1012a1cb98faSBarry Smith . numids       - The number of `DMLabel` ids for constrained points
1013b278463cSMatthew G. Knepley . ids          - An array of ids for constrained points
1014b278463cSMatthew G. Knepley . func         - A pointwise function giving boundary values
1015b278463cSMatthew G. Knepley - ctx          - An optional user context for bcFunc
1016b278463cSMatthew G. Knepley 
1017b278463cSMatthew G. Knepley   Output Parameter:
1018b278463cSMatthew G. Knepley . locX - A local vector to receives the boundary values
1019b278463cSMatthew G. Knepley 
1020b278463cSMatthew G. Knepley   Level: developer
1021b278463cSMatthew G. Knepley 
1022a1cb98faSBarry Smith   Note:
1023a1cb98faSBarry Smith   This implementation currently ignores the numcomps/comps argument from `DMAddBoundary()`
1024a1cb98faSBarry Smith 
10251cc06b55SBarry Smith .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `DMPlexInsertBoundaryValuesEssential()`, `DMPlexInsertBoundaryValuesEssentialField()`, `DMAddBoundary()`
1026b278463cSMatthew G. Knepley @*/
1027d71ae5a4SJacob Faibussowitsch 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[], PetscErrorCode (*func)(PetscReal, const PetscReal *, const PetscReal *, const PetscScalar *, PetscScalar *, void *), void *ctx, Vec locX)
1028d71ae5a4SJacob Faibussowitsch {
102961f58d28SMatthew G. Knepley   PetscDS            prob;
1030da97024aSMatthew G. Knepley   PetscSF            sf;
1031d7ddef95SMatthew G. Knepley   DM                 dmFace, dmCell, dmGrad;
103220369375SToby Isaac   const PetscScalar *facegeom, *cellgeom = NULL, *grad;
1033da97024aSMatthew G. Knepley   const PetscInt    *leaves;
1034d7ddef95SMatthew G. Knepley   PetscScalar       *x, *fx;
1035520b3818SMatthew G. Knepley   PetscInt           dim, nleaves, loc, fStart, fEnd, pdim, i;
10363ba16761SJacob Faibussowitsch   PetscErrorCode     ierru = PETSC_SUCCESS;
1037d7ddef95SMatthew G. Knepley 
1038d7ddef95SMatthew G. Knepley   PetscFunctionBegin;
10399566063dSJacob Faibussowitsch   PetscCall(DMGetPointSF(dm, &sf));
10409566063dSJacob Faibussowitsch   PetscCall(PetscSFGetGraph(sf, NULL, &nleaves, &leaves, NULL));
1041da97024aSMatthew G. Knepley   nleaves = PetscMax(0, nleaves);
10429566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
10439566063dSJacob Faibussowitsch   PetscCall(DMPlexGetHeightStratum(dm, 1, &fStart, &fEnd));
10449566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dm, &prob));
10459566063dSJacob Faibussowitsch   PetscCall(VecGetDM(faceGeometry, &dmFace));
10469566063dSJacob Faibussowitsch   PetscCall(VecGetArrayRead(faceGeometry, &facegeom));
104720369375SToby Isaac   if (cellGeometry) {
10489566063dSJacob Faibussowitsch     PetscCall(VecGetDM(cellGeometry, &dmCell));
10499566063dSJacob Faibussowitsch     PetscCall(VecGetArrayRead(cellGeometry, &cellgeom));
105020369375SToby Isaac   }
1051d7ddef95SMatthew G. Knepley   if (Grad) {
1052c0a6632aSMatthew G. Knepley     PetscFV fv;
1053c0a6632aSMatthew G. Knepley 
10549566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, field, (PetscObject *)&fv));
10559566063dSJacob Faibussowitsch     PetscCall(VecGetDM(Grad, &dmGrad));
10569566063dSJacob Faibussowitsch     PetscCall(VecGetArrayRead(Grad, &grad));
10579566063dSJacob Faibussowitsch     PetscCall(PetscFVGetNumComponents(fv, &pdim));
10589566063dSJacob Faibussowitsch     PetscCall(DMGetWorkArray(dm, pdim, MPIU_SCALAR, &fx));
1059d7ddef95SMatthew G. Knepley   }
10609566063dSJacob Faibussowitsch   PetscCall(VecGetArray(locX, &x));
1061d7ddef95SMatthew G. Knepley   for (i = 0; i < numids; ++i) {
1062d7ddef95SMatthew G. Knepley     IS              faceIS;
1063d7ddef95SMatthew G. Knepley     const PetscInt *faces;
1064d7ddef95SMatthew G. Knepley     PetscInt        numFaces, f;
1065d7ddef95SMatthew G. Knepley 
10669566063dSJacob Faibussowitsch     PetscCall(DMLabelGetStratumIS(label, ids[i], &faceIS));
1067d7ddef95SMatthew G. Knepley     if (!faceIS) continue; /* No points with that id on this process */
10689566063dSJacob Faibussowitsch     PetscCall(ISGetLocalSize(faceIS, &numFaces));
10699566063dSJacob Faibussowitsch     PetscCall(ISGetIndices(faceIS, &faces));
1070d7ddef95SMatthew G. Knepley     for (f = 0; f < numFaces; ++f) {
1071d7ddef95SMatthew G. Knepley       const PetscInt   face = faces[f], *cells;
1072640bce14SSatish Balay       PetscFVFaceGeom *fg;
1073d7ddef95SMatthew G. Knepley 
1074d7ddef95SMatthew G. Knepley       if ((face < fStart) || (face >= fEnd)) continue; /* Refinement adds non-faces to labels */
10759566063dSJacob Faibussowitsch       PetscCall(PetscFindInt(face, nleaves, (PetscInt *)leaves, &loc));
1076da97024aSMatthew G. Knepley       if (loc >= 0) continue;
10779566063dSJacob Faibussowitsch       PetscCall(DMPlexPointLocalRead(dmFace, face, facegeom, &fg));
10789566063dSJacob Faibussowitsch       PetscCall(DMPlexGetSupport(dm, face, &cells));
1079d7ddef95SMatthew G. Knepley       if (Grad) {
1080640bce14SSatish Balay         PetscFVCellGeom *cg;
1081640bce14SSatish Balay         PetscScalar     *cx, *cgrad;
1082d7ddef95SMatthew G. Knepley         PetscScalar     *xG;
1083d7ddef95SMatthew G. Knepley         PetscReal        dx[3];
1084d7ddef95SMatthew G. Knepley         PetscInt         d;
1085d7ddef95SMatthew G. Knepley 
10869566063dSJacob Faibussowitsch         PetscCall(DMPlexPointLocalRead(dmCell, cells[0], cellgeom, &cg));
10879566063dSJacob Faibussowitsch         PetscCall(DMPlexPointLocalRead(dm, cells[0], x, &cx));
10889566063dSJacob Faibussowitsch         PetscCall(DMPlexPointLocalRead(dmGrad, cells[0], grad, &cgrad));
10899566063dSJacob Faibussowitsch         PetscCall(DMPlexPointLocalFieldRef(dm, cells[1], field, x, &xG));
1090d7ddef95SMatthew G. Knepley         DMPlex_WaxpyD_Internal(dim, -1, cg->centroid, fg->centroid, dx);
1091d7ddef95SMatthew G. Knepley         for (d = 0; d < pdim; ++d) fx[d] = cx[d] + DMPlex_DotD_Internal(dim, &cgrad[d * dim], dx);
10929566063dSJacob Faibussowitsch         PetscCall((*func)(time, fg->centroid, fg->normal, fx, xG, ctx));
1093d7ddef95SMatthew G. Knepley       } else {
1094640bce14SSatish Balay         PetscScalar *xI;
1095d7ddef95SMatthew G. Knepley         PetscScalar *xG;
1096d7ddef95SMatthew G. Knepley 
10979566063dSJacob Faibussowitsch         PetscCall(DMPlexPointLocalRead(dm, cells[0], x, &xI));
10989566063dSJacob Faibussowitsch         PetscCall(DMPlexPointLocalFieldRef(dm, cells[1], field, x, &xG));
1099e735a8a9SMatthew G. Knepley         ierru = (*func)(time, fg->centroid, fg->normal, xI, xG, ctx);
1100e735a8a9SMatthew G. Knepley         if (ierru) {
11019566063dSJacob Faibussowitsch           PetscCall(ISRestoreIndices(faceIS, &faces));
11029566063dSJacob Faibussowitsch           PetscCall(ISDestroy(&faceIS));
1103e735a8a9SMatthew G. Knepley           goto cleanup;
1104e735a8a9SMatthew G. Knepley         }
1105d7ddef95SMatthew G. Knepley       }
1106d7ddef95SMatthew G. Knepley     }
11079566063dSJacob Faibussowitsch     PetscCall(ISRestoreIndices(faceIS, &faces));
11089566063dSJacob Faibussowitsch     PetscCall(ISDestroy(&faceIS));
1109d7ddef95SMatthew G. Knepley   }
1110e735a8a9SMatthew G. Knepley cleanup:
11119566063dSJacob Faibussowitsch   PetscCall(VecRestoreArray(locX, &x));
1112d7ddef95SMatthew G. Knepley   if (Grad) {
11139566063dSJacob Faibussowitsch     PetscCall(DMRestoreWorkArray(dm, pdim, MPIU_SCALAR, &fx));
11149566063dSJacob Faibussowitsch     PetscCall(VecRestoreArrayRead(Grad, &grad));
1115d7ddef95SMatthew G. Knepley   }
11169566063dSJacob Faibussowitsch   if (cellGeometry) PetscCall(VecRestoreArrayRead(cellGeometry, &cellgeom));
11179566063dSJacob Faibussowitsch   PetscCall(VecRestoreArrayRead(faceGeometry, &facegeom));
11189566063dSJacob Faibussowitsch   PetscCall(ierru);
11193ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
1120d7ddef95SMatthew G. Knepley }
1121d7ddef95SMatthew G. Knepley 
1122d71ae5a4SJacob Faibussowitsch static PetscErrorCode zero(PetscInt dim, PetscReal time, const PetscReal x[], PetscInt Nc, PetscScalar *u, void *ctx)
1123d71ae5a4SJacob Faibussowitsch {
11240c364540SMatthew G. Knepley   PetscInt c;
11250c364540SMatthew G. Knepley   for (c = 0; c < Nc; ++c) u[c] = 0.0;
11263ba16761SJacob Faibussowitsch   return PETSC_SUCCESS;
11270c364540SMatthew G. Knepley }
11280c364540SMatthew G. Knepley 
1129d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexInsertBoundaryValues_Plex(DM dm, PetscBool insertEssential, Vec locX, PetscReal time, Vec faceGeomFVM, Vec cellGeomFVM, Vec gradFVM)
1130d71ae5a4SJacob Faibussowitsch {
11310c364540SMatthew G. Knepley   PetscObject isZero;
1132e5e52638SMatthew G. Knepley   PetscDS     prob;
1133d7ddef95SMatthew G. Knepley   PetscInt    numBd, b;
113455f2e967SMatthew G. Knepley 
113555f2e967SMatthew G. Knepley   PetscFunctionBegin;
11369566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dm, &prob));
11379566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumBoundary(prob, &numBd));
11389566063dSJacob Faibussowitsch   PetscCall(PetscObjectQuery((PetscObject)locX, "__Vec_bc_zero__", &isZero));
1139450c7a9fSMatthew G. Knepley   PetscCall(PetscDSUpdateBoundaryLabels(prob, dm));
114055f2e967SMatthew G. Knepley   for (b = 0; b < numBd; ++b) {
114145480ffeSMatthew G. Knepley     PetscWeakForm           wf;
1142f971fd6bSMatthew G. Knepley     DMBoundaryConditionType type;
114345480ffeSMatthew G. Knepley     const char             *name;
1144d7ddef95SMatthew G. Knepley     DMLabel                 label;
11451c531cf8SMatthew G. Knepley     PetscInt                field, Nc;
11461c531cf8SMatthew G. Knepley     const PetscInt         *comps;
1147d7ddef95SMatthew G. Knepley     PetscObject             obj;
1148d7ddef95SMatthew G. Knepley     PetscClassId            id;
114945480ffeSMatthew G. Knepley     void (*bvfunc)(void);
1150d7ddef95SMatthew G. Knepley     PetscInt        numids;
1151d7ddef95SMatthew G. Knepley     const PetscInt *ids;
115255f2e967SMatthew G. Knepley     void           *ctx;
115355f2e967SMatthew G. Knepley 
11549566063dSJacob Faibussowitsch     PetscCall(PetscDSGetBoundary(prob, b, &wf, &type, &name, &label, &numids, &ids, &field, &Nc, &comps, &bvfunc, NULL, &ctx));
1155f971fd6bSMatthew G. Knepley     if (insertEssential != (type & DM_BC_ESSENTIAL)) continue;
11569566063dSJacob Faibussowitsch     PetscCall(DMGetField(dm, field, NULL, &obj));
11579566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
1158d7ddef95SMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
1159c60e475cSMatthew G. Knepley       switch (type) {
1160c60e475cSMatthew G. Knepley         /* for FEM, there is no insertion to be done for non-essential boundary conditions */
11619371c9d4SSatish Balay       case DM_BC_ESSENTIAL: {
11628434afd1SBarry Smith         PetscSimplePointFn *func = (PetscSimplePointFn *)bvfunc;
116345480ffeSMatthew G. Knepley 
116445480ffeSMatthew G. Knepley         if (isZero) func = zero;
11659566063dSJacob Faibussowitsch         PetscCall(DMPlexLabelAddCells(dm, label));
11669566063dSJacob Faibussowitsch         PetscCall(DMPlexInsertBoundaryValuesEssential(dm, time, field, Nc, comps, label, numids, ids, func, ctx, locX));
11679566063dSJacob Faibussowitsch         PetscCall(DMPlexLabelClearCells(dm, label));
11689371c9d4SSatish Balay       } break;
11699371c9d4SSatish Balay       case DM_BC_ESSENTIAL_FIELD: {
117045480ffeSMatthew G. Knepley         PetscPointFunc func = (PetscPointFunc)bvfunc;
117145480ffeSMatthew G. Knepley 
11729566063dSJacob Faibussowitsch         PetscCall(DMPlexLabelAddCells(dm, label));
11739566063dSJacob Faibussowitsch         PetscCall(DMPlexInsertBoundaryValuesEssentialField(dm, time, locX, field, Nc, comps, label, numids, ids, func, ctx, locX));
11749566063dSJacob Faibussowitsch         PetscCall(DMPlexLabelClearCells(dm, label));
11759371c9d4SSatish Balay       } break;
1176d71ae5a4SJacob Faibussowitsch       default:
1177d71ae5a4SJacob Faibussowitsch         break;
1178c60e475cSMatthew G. Knepley       }
1179d7ddef95SMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
118045480ffeSMatthew G. Knepley       {
118145480ffeSMatthew G. Knepley         PetscErrorCode (*func)(PetscReal, const PetscReal *, const PetscReal *, const PetscScalar *, PetscScalar *, void *) = (PetscErrorCode (*)(PetscReal, const PetscReal *, const PetscReal *, const PetscScalar *, PetscScalar *, void *))bvfunc;
118245480ffeSMatthew G. Knepley 
118343ea7facSMatthew G. Knepley         if (!faceGeomFVM) continue;
11849566063dSJacob Faibussowitsch         PetscCall(DMPlexInsertBoundaryValuesRiemann(dm, time, faceGeomFVM, cellGeomFVM, gradFVM, field, Nc, comps, label, numids, ids, func, ctx, locX));
118545480ffeSMatthew G. Knepley       }
118663a3b9bcSJacob Faibussowitsch     } else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, field);
118755f2e967SMatthew G. Knepley   }
11883ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
118955f2e967SMatthew G. Knepley }
119055f2e967SMatthew G. Knepley 
1191d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexInsertTimeDerivativeBoundaryValues_Plex(DM dm, PetscBool insertEssential, Vec locX, PetscReal time, Vec faceGeomFVM, Vec cellGeomFVM, Vec gradFVM)
1192d71ae5a4SJacob Faibussowitsch {
119356cf3b9cSMatthew G. Knepley   PetscObject isZero;
119456cf3b9cSMatthew G. Knepley   PetscDS     prob;
119556cf3b9cSMatthew G. Knepley   PetscInt    numBd, b;
119656cf3b9cSMatthew G. Knepley 
119756cf3b9cSMatthew G. Knepley   PetscFunctionBegin;
11983ba16761SJacob Faibussowitsch   if (!locX) PetscFunctionReturn(PETSC_SUCCESS);
11999566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dm, &prob));
12009566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumBoundary(prob, &numBd));
12019566063dSJacob Faibussowitsch   PetscCall(PetscObjectQuery((PetscObject)locX, "__Vec_bc_zero__", &isZero));
120256cf3b9cSMatthew G. Knepley   for (b = 0; b < numBd; ++b) {
120345480ffeSMatthew G. Knepley     PetscWeakForm           wf;
120456cf3b9cSMatthew G. Knepley     DMBoundaryConditionType type;
120545480ffeSMatthew G. Knepley     const char             *name;
120656cf3b9cSMatthew G. Knepley     DMLabel                 label;
120756cf3b9cSMatthew G. Knepley     PetscInt                field, Nc;
120856cf3b9cSMatthew G. Knepley     const PetscInt         *comps;
120956cf3b9cSMatthew G. Knepley     PetscObject             obj;
121056cf3b9cSMatthew G. Knepley     PetscClassId            id;
121156cf3b9cSMatthew G. Knepley     PetscInt                numids;
121256cf3b9cSMatthew G. Knepley     const PetscInt         *ids;
121345480ffeSMatthew G. Knepley     void (*bvfunc)(void);
121456cf3b9cSMatthew G. Knepley     void *ctx;
121556cf3b9cSMatthew G. Knepley 
12169566063dSJacob Faibussowitsch     PetscCall(PetscDSGetBoundary(prob, b, &wf, &type, &name, &label, &numids, &ids, &field, &Nc, &comps, NULL, &bvfunc, &ctx));
121756cf3b9cSMatthew G. Knepley     if (insertEssential != (type & DM_BC_ESSENTIAL)) continue;
12189566063dSJacob Faibussowitsch     PetscCall(DMGetField(dm, field, NULL, &obj));
12199566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
122056cf3b9cSMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
122156cf3b9cSMatthew G. Knepley       switch (type) {
122256cf3b9cSMatthew G. Knepley         /* for FEM, there is no insertion to be done for non-essential boundary conditions */
12239371c9d4SSatish Balay       case DM_BC_ESSENTIAL: {
12248434afd1SBarry Smith         PetscSimplePointFn *func_t = (PetscSimplePointFn *)bvfunc;
122545480ffeSMatthew G. Knepley 
122645480ffeSMatthew G. Knepley         if (isZero) func_t = zero;
12279566063dSJacob Faibussowitsch         PetscCall(DMPlexLabelAddCells(dm, label));
12289566063dSJacob Faibussowitsch         PetscCall(DMPlexInsertBoundaryValuesEssential(dm, time, field, Nc, comps, label, numids, ids, func_t, ctx, locX));
12299566063dSJacob Faibussowitsch         PetscCall(DMPlexLabelClearCells(dm, label));
12309371c9d4SSatish Balay       } break;
12319371c9d4SSatish Balay       case DM_BC_ESSENTIAL_FIELD: {
123245480ffeSMatthew G. Knepley         PetscPointFunc func_t = (PetscPointFunc)bvfunc;
123345480ffeSMatthew G. Knepley 
12349566063dSJacob Faibussowitsch         PetscCall(DMPlexLabelAddCells(dm, label));
12359566063dSJacob Faibussowitsch         PetscCall(DMPlexInsertBoundaryValuesEssentialField(dm, time, locX, field, Nc, comps, label, numids, ids, func_t, ctx, locX));
12369566063dSJacob Faibussowitsch         PetscCall(DMPlexLabelClearCells(dm, label));
12379371c9d4SSatish Balay       } break;
1238d71ae5a4SJacob Faibussowitsch       default:
1239d71ae5a4SJacob Faibussowitsch         break;
124056cf3b9cSMatthew G. Knepley       }
124163a3b9bcSJacob Faibussowitsch     } else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, field);
124256cf3b9cSMatthew G. Knepley   }
12433ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
124456cf3b9cSMatthew G. Knepley }
124556cf3b9cSMatthew G. Knepley 
1246f1d73a7aSMatthew G. Knepley /*@
1247f1d73a7aSMatthew G. Knepley   DMPlexInsertBoundaryValues - Puts coefficients which represent boundary values into the local solution vector
1248f1d73a7aSMatthew G. Knepley 
1249ed808b8fSJed Brown   Not Collective
1250ed808b8fSJed Brown 
1251f1d73a7aSMatthew G. Knepley   Input Parameters:
1252a1cb98faSBarry Smith + dm              - The `DM`
1253f1d73a7aSMatthew G. Knepley . insertEssential - Should I insert essential (e.g. Dirichlet) or inessential (e.g. Neumann) boundary conditions
1254f1d73a7aSMatthew G. Knepley . time            - The time
1255f1d73a7aSMatthew G. Knepley . faceGeomFVM     - Face geometry data for FV discretizations
1256f1d73a7aSMatthew G. Knepley . cellGeomFVM     - Cell geometry data for FV discretizations
1257f1d73a7aSMatthew G. Knepley - gradFVM         - Gradient reconstruction data for FV discretizations
1258f1d73a7aSMatthew G. Knepley 
12592fe279fdSBarry Smith   Output Parameter:
1260f1d73a7aSMatthew G. Knepley . locX - Solution updated with boundary values
1261f1d73a7aSMatthew G. Knepley 
1262ed808b8fSJed Brown   Level: intermediate
1263f1d73a7aSMatthew G. Knepley 
12641cc06b55SBarry Smith .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `DMProjectFunctionLabelLocal()`, `DMAddBoundary()`
1265f1d73a7aSMatthew G. Knepley @*/
1266d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexInsertBoundaryValues(DM dm, PetscBool insertEssential, Vec locX, PetscReal time, Vec faceGeomFVM, Vec cellGeomFVM, Vec gradFVM)
1267d71ae5a4SJacob Faibussowitsch {
1268f1d73a7aSMatthew G. Knepley   PetscFunctionBegin;
1269f1d73a7aSMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
1270064a246eSJacob Faibussowitsch   PetscValidHeaderSpecific(locX, VEC_CLASSID, 3);
1271ad540459SPierre Jolivet   if (faceGeomFVM) PetscValidHeaderSpecific(faceGeomFVM, VEC_CLASSID, 5);
1272ad540459SPierre Jolivet   if (cellGeomFVM) PetscValidHeaderSpecific(cellGeomFVM, VEC_CLASSID, 6);
1273ad540459SPierre Jolivet   if (gradFVM) PetscValidHeaderSpecific(gradFVM, VEC_CLASSID, 7);
1274cac4c232SBarry Smith   PetscTryMethod(dm, "DMPlexInsertBoundaryValues_C", (DM, PetscBool, Vec, PetscReal, Vec, Vec, Vec), (dm, insertEssential, locX, time, faceGeomFVM, cellGeomFVM, gradFVM));
12753ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
1276f1d73a7aSMatthew G. Knepley }
1277f1d73a7aSMatthew G. Knepley 
127856cf3b9cSMatthew G. Knepley /*@
1279a5b23f4aSJose E. Roman   DMPlexInsertTimeDerivativeBoundaryValues - Puts coefficients which represent boundary values of the time derivative into the local solution vector
128056cf3b9cSMatthew G. Knepley 
128156cf3b9cSMatthew G. Knepley   Input Parameters:
1282a1cb98faSBarry Smith + dm              - The `DM`
128356cf3b9cSMatthew G. Knepley . insertEssential - Should I insert essential (e.g. Dirichlet) or inessential (e.g. Neumann) boundary conditions
128456cf3b9cSMatthew G. Knepley . time            - The time
128556cf3b9cSMatthew G. Knepley . faceGeomFVM     - Face geometry data for FV discretizations
128656cf3b9cSMatthew G. Knepley . cellGeomFVM     - Cell geometry data for FV discretizations
128756cf3b9cSMatthew G. Knepley - gradFVM         - Gradient reconstruction data for FV discretizations
128856cf3b9cSMatthew G. Knepley 
12892fe279fdSBarry Smith   Output Parameter:
129056cf3b9cSMatthew G. Knepley . locX_t - Solution updated with boundary values
129156cf3b9cSMatthew G. Knepley 
129256cf3b9cSMatthew G. Knepley   Level: developer
129356cf3b9cSMatthew G. Knepley 
12941cc06b55SBarry Smith .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `DMProjectFunctionLabelLocal()`
129556cf3b9cSMatthew G. Knepley @*/
1296d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexInsertTimeDerivativeBoundaryValues(DM dm, PetscBool insertEssential, Vec locX_t, PetscReal time, Vec faceGeomFVM, Vec cellGeomFVM, Vec gradFVM)
1297d71ae5a4SJacob Faibussowitsch {
129856cf3b9cSMatthew G. Knepley   PetscFunctionBegin;
129956cf3b9cSMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
1300ad540459SPierre Jolivet   if (locX_t) PetscValidHeaderSpecific(locX_t, VEC_CLASSID, 3);
1301ad540459SPierre Jolivet   if (faceGeomFVM) PetscValidHeaderSpecific(faceGeomFVM, VEC_CLASSID, 5);
1302ad540459SPierre Jolivet   if (cellGeomFVM) PetscValidHeaderSpecific(cellGeomFVM, VEC_CLASSID, 6);
1303ad540459SPierre Jolivet   if (gradFVM) PetscValidHeaderSpecific(gradFVM, VEC_CLASSID, 7);
13046c51210dSStefano Zampini   PetscTryMethod(dm, "DMPlexInsertTimeDerivativeBoundaryValues_C", (DM, PetscBool, Vec, PetscReal, Vec, Vec, Vec), (dm, insertEssential, locX_t, time, faceGeomFVM, cellGeomFVM, gradFVM));
13053ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
130656cf3b9cSMatthew G. Knepley }
130756cf3b9cSMatthew G. Knepley 
13085962854dSMatthew G. Knepley // Handle non-essential (e.g. outflow) boundary values
13095962854dSMatthew G. Knepley PetscErrorCode DMPlexInsertBoundaryValuesFVM(DM dm, PetscFV fv, Vec locX, PetscReal time, Vec *locGradient)
13105962854dSMatthew G. Knepley {
13115962854dSMatthew G. Knepley   DM  dmGrad;
13125962854dSMatthew G. Knepley   Vec cellGeometryFVM, faceGeometryFVM, locGrad = NULL;
13135962854dSMatthew G. Knepley 
13145962854dSMatthew G. Knepley   PetscFunctionBegin;
13155962854dSMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
13165962854dSMatthew G. Knepley   PetscValidHeaderSpecific(fv, PETSCFV_CLASSID, 2);
13175962854dSMatthew G. Knepley   PetscValidHeaderSpecific(locX, VEC_CLASSID, 3);
13185962854dSMatthew G. Knepley   if (locGradient) {
13195962854dSMatthew G. Knepley     PetscAssertPointer(locGradient, 5);
13205962854dSMatthew G. Knepley     *locGradient = NULL;
13215962854dSMatthew G. Knepley   }
13225962854dSMatthew G. Knepley   PetscCall(DMPlexGetGeometryFVM(dm, &faceGeometryFVM, &cellGeometryFVM, NULL));
13235962854dSMatthew G. Knepley   /* Reconstruct and limit cell gradients */
13245962854dSMatthew G. Knepley   PetscCall(DMPlexGetGradientDM(dm, fv, &dmGrad));
13255962854dSMatthew G. Knepley   if (dmGrad) {
13265962854dSMatthew G. Knepley     Vec      grad;
13275962854dSMatthew G. Knepley     PetscInt fStart, fEnd;
13285962854dSMatthew G. Knepley 
13295962854dSMatthew G. Knepley     PetscCall(DMPlexGetHeightStratum(dm, 1, &fStart, &fEnd));
13305962854dSMatthew G. Knepley     PetscCall(DMGetGlobalVector(dmGrad, &grad));
13315962854dSMatthew G. Knepley     PetscCall(DMPlexReconstructGradients_Internal(dm, fv, fStart, fEnd, faceGeometryFVM, cellGeometryFVM, locX, grad));
13325962854dSMatthew G. Knepley     /* Communicate gradient values */
13335962854dSMatthew G. Knepley     PetscCall(DMGetLocalVector(dmGrad, &locGrad));
13345962854dSMatthew G. Knepley     PetscCall(DMGlobalToLocalBegin(dmGrad, grad, INSERT_VALUES, locGrad));
13355962854dSMatthew G. Knepley     PetscCall(DMGlobalToLocalEnd(dmGrad, grad, INSERT_VALUES, locGrad));
13365962854dSMatthew G. Knepley     PetscCall(DMRestoreGlobalVector(dmGrad, &grad));
13375962854dSMatthew G. Knepley   }
13385962854dSMatthew G. Knepley   PetscCall(DMPlexInsertBoundaryValues(dm, PETSC_FALSE, locX, time, faceGeometryFVM, cellGeometryFVM, locGrad));
13395962854dSMatthew G. Knepley   if (locGradient) *locGradient = locGrad;
13405962854dSMatthew G. Knepley   else if (locGrad) PetscCall(DMRestoreLocalVector(dmGrad, &locGrad));
13415962854dSMatthew G. Knepley   PetscFunctionReturn(PETSC_SUCCESS);
13425962854dSMatthew G. Knepley }
13435962854dSMatthew G. Knepley 
1344d71ae5a4SJacob Faibussowitsch PetscErrorCode DMComputeL2Diff_Plex(DM dm, PetscReal time, PetscErrorCode (**funcs)(PetscInt, PetscReal, const PetscReal[], PetscInt, PetscScalar *, void *), void **ctxs, Vec X, PetscReal *diff)
1345d71ae5a4SJacob Faibussowitsch {
1346574a98acSMatthew G. Knepley   Vec localX;
1347574a98acSMatthew G. Knepley 
1348574a98acSMatthew G. Knepley   PetscFunctionBegin;
13499566063dSJacob Faibussowitsch   PetscCall(DMGetLocalVector(dm, &localX));
13509566063dSJacob Faibussowitsch   PetscCall(DMPlexInsertBoundaryValues(dm, PETSC_TRUE, localX, time, NULL, NULL, NULL));
13519566063dSJacob Faibussowitsch   PetscCall(DMGlobalToLocalBegin(dm, X, INSERT_VALUES, localX));
13529566063dSJacob Faibussowitsch   PetscCall(DMGlobalToLocalEnd(dm, X, INSERT_VALUES, localX));
13539566063dSJacob Faibussowitsch   PetscCall(DMPlexComputeL2DiffLocal(dm, time, funcs, ctxs, localX, diff));
13549566063dSJacob Faibussowitsch   PetscCall(DMRestoreLocalVector(dm, &localX));
13553ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
1356574a98acSMatthew G. Knepley }
1357574a98acSMatthew G. Knepley 
1358574a98acSMatthew G. Knepley /*@C
135960225df5SJacob Faibussowitsch   DMPlexComputeL2DiffLocal - This function computes the L_2 difference between a function u and an FEM interpolant solution u_h.
1360574a98acSMatthew G. Knepley 
136120f4b53cSBarry Smith   Collective
1362c0f8e1fdSMatthew G. Knepley 
1363574a98acSMatthew G. Knepley   Input Parameters:
1364a1cb98faSBarry Smith + dm     - The `DM`
1365574a98acSMatthew G. Knepley . time   - The time
1366574a98acSMatthew G. Knepley . funcs  - The functions to evaluate for each field component
136720f4b53cSBarry Smith . ctxs   - Optional array of contexts to pass to each function, or `NULL`.
1368574a98acSMatthew G. Knepley - localX - The coefficient vector u_h, a local vector
1369574a98acSMatthew G. Knepley 
1370574a98acSMatthew G. Knepley   Output Parameter:
1371574a98acSMatthew G. Knepley . diff - The diff ||u - u_h||_2
1372574a98acSMatthew G. Knepley 
1373574a98acSMatthew G. Knepley   Level: developer
1374574a98acSMatthew G. Knepley 
13751cc06b55SBarry Smith .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `DMProjectFunction()`, `DMComputeL2FieldDiff()`, `DMComputeL2GradientDiff()`
1376574a98acSMatthew G. Knepley @*/
1377d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexComputeL2DiffLocal(DM dm, PetscReal time, PetscErrorCode (**funcs)(PetscInt, PetscReal, const PetscReal[], PetscInt, PetscScalar *, void *), void **ctxs, Vec localX, PetscReal *diff)
1378d71ae5a4SJacob Faibussowitsch {
13790f09c10fSMatthew G. Knepley   const PetscInt   debug = ((DM_Plex *)dm->data)->printL2;
1380ca3d3a14SMatthew G. Knepley   DM               tdm;
1381ca3d3a14SMatthew G. Knepley   Vec              tv;
1382cb1e1211SMatthew G Knepley   PetscSection     section;
1383c5bbbd5bSMatthew G. Knepley   PetscQuadrature  quad;
13844bee2e38SMatthew G. Knepley   PetscFEGeom      fegeom;
138515496722SMatthew G. Knepley   PetscScalar     *funcVal, *interpolant;
13864bee2e38SMatthew G. Knepley   PetscReal       *coords, *gcoords;
1387cb1e1211SMatthew G Knepley   PetscReal        localDiff = 0.0;
13887318780aSToby Isaac   const PetscReal *quadWeights;
1389412e9a14SMatthew G. Knepley   PetscInt         dim, coordDim, numFields, numComponents = 0, qNc, Nq, cellHeight, cStart, cEnd, c, field, fieldOffset;
1390ca3d3a14SMatthew G. Knepley   PetscBool        transform;
1391cb1e1211SMatthew G Knepley 
1392cb1e1211SMatthew G Knepley   PetscFunctionBegin;
13939566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
13949566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateDim(dm, &coordDim));
13952a4e142eSMatthew G. Knepley   fegeom.dimEmbed = coordDim;
13969566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
13979566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetNumFields(section, &numFields));
13989566063dSJacob Faibussowitsch   PetscCall(DMGetBasisTransformDM_Internal(dm, &tdm));
13999566063dSJacob Faibussowitsch   PetscCall(DMGetBasisTransformVec_Internal(dm, &tv));
14009566063dSJacob Faibussowitsch   PetscCall(DMHasBasisTransform(dm, &transform));
1401eae3dc7dSJacob Faibussowitsch   PetscCheck(numFields, PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of fields is zero!");
1402cb1e1211SMatthew G Knepley   for (field = 0; field < numFields; ++field) {
140315496722SMatthew G. Knepley     PetscObject  obj;
140415496722SMatthew G. Knepley     PetscClassId id;
1405c5bbbd5bSMatthew G. Knepley     PetscInt     Nc;
1406c5bbbd5bSMatthew G. Knepley 
14079566063dSJacob Faibussowitsch     PetscCall(DMGetField(dm, field, NULL, &obj));
14089566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
140915496722SMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
141015496722SMatthew G. Knepley       PetscFE fe = (PetscFE)obj;
141115496722SMatthew G. Knepley 
14129566063dSJacob Faibussowitsch       PetscCall(PetscFEGetQuadrature(fe, &quad));
14139566063dSJacob Faibussowitsch       PetscCall(PetscFEGetNumComponents(fe, &Nc));
141415496722SMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
141515496722SMatthew G. Knepley       PetscFV fv = (PetscFV)obj;
141615496722SMatthew G. Knepley 
14179566063dSJacob Faibussowitsch       PetscCall(PetscFVGetQuadrature(fv, &quad));
14189566063dSJacob Faibussowitsch       PetscCall(PetscFVGetNumComponents(fv, &Nc));
141963a3b9bcSJacob Faibussowitsch     } else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, field);
1420c5bbbd5bSMatthew G. Knepley     numComponents += Nc;
1421cb1e1211SMatthew G Knepley   }
14229566063dSJacob Faibussowitsch   PetscCall(PetscQuadratureGetData(quad, NULL, &qNc, &Nq, NULL, &quadWeights));
142363a3b9bcSJacob Faibussowitsch   PetscCheck(!(qNc != 1) || !(qNc != numComponents), PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_SIZ, "Quadrature components %" PetscInt_FMT " != %" PetscInt_FMT " field components", qNc, numComponents);
1424c9cb6370SYANG Zongze   PetscCall(PetscMalloc6(numComponents, &funcVal, numComponents, &interpolant, coordDim * (Nq + 1), &coords, Nq, &fegeom.detJ, coordDim * coordDim * Nq, &fegeom.J, coordDim * coordDim * Nq, &fegeom.invJ));
14259566063dSJacob Faibussowitsch   PetscCall(DMPlexGetVTKCellHeight(dm, &cellHeight));
14269566063dSJacob Faibussowitsch   PetscCall(DMPlexGetSimplexOrBoxCells(dm, cellHeight, &cStart, &cEnd));
1427cb1e1211SMatthew G Knepley   for (c = cStart; c < cEnd; ++c) {
1428a1e44745SMatthew G. Knepley     PetscScalar *x        = NULL;
1429cb1e1211SMatthew G Knepley     PetscReal    elemDiff = 0.0;
14309c3cf19fSMatthew G. Knepley     PetscInt     qc       = 0;
1431cb1e1211SMatthew G Knepley 
14329566063dSJacob Faibussowitsch     PetscCall(DMPlexComputeCellGeometryFEM(dm, c, quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
1433e8e188d2SZach Atkins     PetscCall(DMPlexVecGetOrientedClosure_Internal(dm, NULL, PETSC_FALSE, localX, c, 0, NULL, &x));
1434cb1e1211SMatthew G Knepley 
143515496722SMatthew G. Knepley     for (field = 0, fieldOffset = 0; field < numFields; ++field) {
143615496722SMatthew G. Knepley       PetscObject  obj;
143715496722SMatthew G. Knepley       PetscClassId id;
1438c110b1eeSGeoffrey Irving       void *const  ctx = ctxs ? ctxs[field] : NULL;
143915496722SMatthew G. Knepley       PetscInt     Nb, Nc, q, fc;
1440cb1e1211SMatthew G Knepley 
14419566063dSJacob Faibussowitsch       PetscCall(DMGetField(dm, field, NULL, &obj));
14429566063dSJacob Faibussowitsch       PetscCall(PetscObjectGetClassId(obj, &id));
14439371c9d4SSatish Balay       if (id == PETSCFE_CLASSID) {
14449371c9d4SSatish Balay         PetscCall(PetscFEGetNumComponents((PetscFE)obj, &Nc));
14459371c9d4SSatish Balay         PetscCall(PetscFEGetDimension((PetscFE)obj, &Nb));
14469371c9d4SSatish Balay       } else if (id == PETSCFV_CLASSID) {
14479371c9d4SSatish Balay         PetscCall(PetscFVGetNumComponents((PetscFV)obj, &Nc));
14489371c9d4SSatish Balay         Nb = 1;
14499371c9d4SSatish Balay       } else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, field);
1450cb1e1211SMatthew G Knepley       if (debug) {
1451cb1e1211SMatthew G Knepley         char title[1024];
145263a3b9bcSJacob Faibussowitsch         PetscCall(PetscSNPrintf(title, 1023, "Solution for Field %" PetscInt_FMT, field));
14539566063dSJacob Faibussowitsch         PetscCall(DMPrintCellVector(c, title, Nb, &x[fieldOffset]));
1454cb1e1211SMatthew G Knepley       }
14557318780aSToby Isaac       for (q = 0; q < Nq; ++q) {
14562a4e142eSMatthew G. Knepley         PetscFEGeom    qgeom;
1457d0609cedSBarry Smith         PetscErrorCode ierr;
14582a4e142eSMatthew G. Knepley 
14592a4e142eSMatthew G. Knepley         qgeom.dimEmbed = fegeom.dimEmbed;
14602a4e142eSMatthew G. Knepley         qgeom.J        = &fegeom.J[q * coordDim * coordDim];
14612a4e142eSMatthew G. Knepley         qgeom.invJ     = &fegeom.invJ[q * coordDim * coordDim];
14622a4e142eSMatthew G. Knepley         qgeom.detJ     = &fegeom.detJ[q];
146363a3b9bcSJacob Faibussowitsch         PetscCheck(fegeom.detJ[q] > 0.0, PETSC_COMM_SELF, PETSC_ERR_ARG_OUTOFRANGE, "Invalid determinant %g for element %" PetscInt_FMT ", point %" PetscInt_FMT, (double)fegeom.detJ[q], c, q);
1464d3a7d86cSMatthew G. Knepley         if (transform) {
1465d3a7d86cSMatthew G. Knepley           gcoords = &coords[coordDim * Nq];
14669566063dSJacob Faibussowitsch           PetscCall(DMPlexBasisTransformApplyReal_Internal(dm, &coords[coordDim * q], PETSC_TRUE, coordDim, &coords[coordDim * q], gcoords, dm->transformCtx));
1467d3a7d86cSMatthew G. Knepley         } else {
1468d3a7d86cSMatthew G. Knepley           gcoords = &coords[coordDim * q];
1469d3a7d86cSMatthew G. Knepley         }
14709566063dSJacob Faibussowitsch         PetscCall(PetscArrayzero(funcVal, Nc));
1471ca3d3a14SMatthew G. Knepley         ierr = (*funcs[field])(coordDim, time, gcoords, Nc, funcVal, ctx);
1472e735a8a9SMatthew G. Knepley         if (ierr) {
14739566063dSJacob Faibussowitsch           PetscCall(DMPlexVecRestoreClosure(dm, NULL, localX, c, NULL, &x));
14749566063dSJacob Faibussowitsch           PetscCall(DMRestoreLocalVector(dm, &localX));
14759566063dSJacob Faibussowitsch           PetscCall(PetscFree6(funcVal, interpolant, coords, fegeom.detJ, fegeom.J, fegeom.invJ));
1476e735a8a9SMatthew G. Knepley         }
14779566063dSJacob Faibussowitsch         if (transform) PetscCall(DMPlexBasisTransformApply_Internal(dm, &coords[coordDim * q], PETSC_FALSE, Nc, funcVal, funcVal, dm->transformCtx));
14789566063dSJacob Faibussowitsch         if (id == PETSCFE_CLASSID) PetscCall(PetscFEInterpolate_Static((PetscFE)obj, &x[fieldOffset], &qgeom, q, interpolant));
14799566063dSJacob Faibussowitsch         else if (id == PETSCFV_CLASSID) PetscCall(PetscFVInterpolate_Static((PetscFV)obj, &x[fieldOffset], q, interpolant));
14802df84da0SMatthew G. Knepley         else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, field);
148115496722SMatthew G. Knepley         for (fc = 0; fc < Nc; ++fc) {
1482beaa55a6SMatthew G. Knepley           const PetscReal wt = quadWeights[q * qNc + (qNc == 1 ? 0 : qc + fc)];
14839371c9d4SSatish Balay           if (debug)
14849371c9d4SSatish Balay             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.),
14859371c9d4SSatish Balay                                   (double)(PetscSqr(PetscRealPart(interpolant[fc] - funcVal[fc])) * wt * fegeom.detJ[q]), (double)PetscRealPart(interpolant[fc]), (double)PetscRealPart(funcVal[fc])));
14864bee2e38SMatthew G. Knepley           elemDiff += PetscSqr(PetscRealPart(interpolant[fc] - funcVal[fc])) * wt * fegeom.detJ[q];
1487cb1e1211SMatthew G Knepley         }
1488cb1e1211SMatthew G Knepley       }
14899c3cf19fSMatthew G. Knepley       fieldOffset += Nb;
1490beaa55a6SMatthew G. Knepley       qc += Nc;
1491cb1e1211SMatthew G Knepley     }
14929566063dSJacob Faibussowitsch     PetscCall(DMPlexVecRestoreClosure(dm, NULL, localX, c, NULL, &x));
14939566063dSJacob Faibussowitsch     if (debug) PetscCall(PetscPrintf(PETSC_COMM_SELF, "  elem %" PetscInt_FMT " diff %g\n", c, (double)elemDiff));
1494cb1e1211SMatthew G Knepley     localDiff += elemDiff;
1495cb1e1211SMatthew G Knepley   }
14969566063dSJacob Faibussowitsch   PetscCall(PetscFree6(funcVal, interpolant, coords, fegeom.detJ, fegeom.J, fegeom.invJ));
1497462c564dSBarry Smith   PetscCallMPI(MPIU_Allreduce(&localDiff, diff, 1, MPIU_REAL, MPIU_SUM, PetscObjectComm((PetscObject)dm)));
1498cb1e1211SMatthew G Knepley   *diff = PetscSqrtReal(*diff);
14993ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
1500cb1e1211SMatthew G Knepley }
1501cb1e1211SMatthew G Knepley 
1502d71ae5a4SJacob Faibussowitsch 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)
1503d71ae5a4SJacob Faibussowitsch {
15040f09c10fSMatthew G. Knepley   const PetscInt   debug = ((DM_Plex *)dm->data)->printL2;
1505ca3d3a14SMatthew G. Knepley   DM               tdm;
1506cb1e1211SMatthew G Knepley   PetscSection     section;
150740e14135SMatthew G. Knepley   PetscQuadrature  quad;
1508ca3d3a14SMatthew G. Knepley   Vec              localX, tv;
15099c3cf19fSMatthew G. Knepley   PetscScalar     *funcVal, *interpolant;
15102a4e142eSMatthew G. Knepley   const PetscReal *quadWeights;
15114bee2e38SMatthew G. Knepley   PetscFEGeom      fegeom;
15124bee2e38SMatthew G. Knepley   PetscReal       *coords, *gcoords;
151340e14135SMatthew G. Knepley   PetscReal        localDiff = 0.0;
1514485ad865SMatthew G. Knepley   PetscInt         dim, coordDim, qNc = 0, Nq = 0, numFields, numComponents = 0, cStart, cEnd, c, field, fieldOffset;
1515ca3d3a14SMatthew G. Knepley   PetscBool        transform;
1516cb1e1211SMatthew G Knepley 
1517cb1e1211SMatthew G Knepley   PetscFunctionBegin;
15189566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
15199566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateDim(dm, &coordDim));
15204bee2e38SMatthew G. Knepley   fegeom.dimEmbed = coordDim;
15219566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
15229566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetNumFields(section, &numFields));
15239566063dSJacob Faibussowitsch   PetscCall(DMGetLocalVector(dm, &localX));
15249566063dSJacob Faibussowitsch   PetscCall(DMGlobalToLocalBegin(dm, X, INSERT_VALUES, localX));
15259566063dSJacob Faibussowitsch   PetscCall(DMGlobalToLocalEnd(dm, X, INSERT_VALUES, localX));
15269566063dSJacob Faibussowitsch   PetscCall(DMGetBasisTransformDM_Internal(dm, &tdm));
15279566063dSJacob Faibussowitsch   PetscCall(DMGetBasisTransformVec_Internal(dm, &tv));
15289566063dSJacob Faibussowitsch   PetscCall(DMHasBasisTransform(dm, &transform));
1529652b88e8SMatthew G. Knepley   for (field = 0; field < numFields; ++field) {
15300f2d7e86SMatthew G. Knepley     PetscFE  fe;
153140e14135SMatthew G. Knepley     PetscInt Nc;
1532652b88e8SMatthew G. Knepley 
15339566063dSJacob Faibussowitsch     PetscCall(DMGetField(dm, field, NULL, (PetscObject *)&fe));
15349566063dSJacob Faibussowitsch     PetscCall(PetscFEGetQuadrature(fe, &quad));
15359566063dSJacob Faibussowitsch     PetscCall(PetscFEGetNumComponents(fe, &Nc));
153640e14135SMatthew G. Knepley     numComponents += Nc;
1537652b88e8SMatthew G. Knepley   }
15389566063dSJacob Faibussowitsch   PetscCall(PetscQuadratureGetData(quad, NULL, &qNc, &Nq, NULL, &quadWeights));
153963a3b9bcSJacob Faibussowitsch   PetscCheck(!(qNc != 1) || !(qNc != numComponents), PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_SIZ, "Quadrature components %" PetscInt_FMT " != %" PetscInt_FMT " field components", qNc, numComponents);
15409566063dSJacob Faibussowitsch   /* PetscCall(DMProjectFunctionLocal(dm, fe, funcs, INSERT_BC_VALUES, localX)); */
1541c9cb6370SYANG Zongze   PetscCall(PetscMalloc6(numComponents, &funcVal, coordDim * (Nq + 1), &coords, coordDim * coordDim * Nq, &fegeom.J, coordDim * coordDim * Nq, &fegeom.invJ, numComponents * coordDim, &interpolant, Nq, &fegeom.detJ));
15429566063dSJacob Faibussowitsch   PetscCall(DMPlexGetSimplexOrBoxCells(dm, 0, &cStart, &cEnd));
154340e14135SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
154440e14135SMatthew G. Knepley     PetscScalar *x        = NULL;
154540e14135SMatthew G. Knepley     PetscReal    elemDiff = 0.0;
15469c3cf19fSMatthew G. Knepley     PetscInt     qc       = 0;
1547652b88e8SMatthew G. Knepley 
15489566063dSJacob Faibussowitsch     PetscCall(DMPlexComputeCellGeometryFEM(dm, c, quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
1549e8e188d2SZach Atkins     PetscCall(DMPlexVecGetOrientedClosure_Internal(dm, NULL, PETSC_FALSE, localX, c, 0, NULL, &x));
155040e14135SMatthew G. Knepley 
15519c3cf19fSMatthew G. Knepley     for (field = 0, fieldOffset = 0; field < numFields; ++field) {
15520f2d7e86SMatthew G. Knepley       PetscFE     fe;
155351259fa3SMatthew G. Knepley       void *const ctx = ctxs ? ctxs[field] : NULL;
15549c3cf19fSMatthew G. Knepley       PetscInt    Nb, Nc, q, fc;
155540e14135SMatthew G. Knepley 
15569566063dSJacob Faibussowitsch       PetscCall(DMGetField(dm, field, NULL, (PetscObject *)&fe));
15579566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDimension(fe, &Nb));
15589566063dSJacob Faibussowitsch       PetscCall(PetscFEGetNumComponents(fe, &Nc));
155940e14135SMatthew G. Knepley       if (debug) {
156040e14135SMatthew G. Knepley         char title[1024];
15619566063dSJacob Faibussowitsch         PetscCall(PetscSNPrintf(title, 1023, "Solution for Field %" PetscInt_FMT, field));
15629566063dSJacob Faibussowitsch         PetscCall(DMPrintCellVector(c, title, Nb, &x[fieldOffset]));
1563652b88e8SMatthew G. Knepley       }
15649c3cf19fSMatthew G. Knepley       for (q = 0; q < Nq; ++q) {
15652a4e142eSMatthew G. Knepley         PetscFEGeom    qgeom;
1566d0609cedSBarry Smith         PetscErrorCode ierr;
15672a4e142eSMatthew G. Knepley 
15682a4e142eSMatthew G. Knepley         qgeom.dimEmbed = fegeom.dimEmbed;
15692a4e142eSMatthew G. Knepley         qgeom.J        = &fegeom.J[q * coordDim * coordDim];
15702a4e142eSMatthew G. Knepley         qgeom.invJ     = &fegeom.invJ[q * coordDim * coordDim];
15712a4e142eSMatthew G. Knepley         qgeom.detJ     = &fegeom.detJ[q];
15722df84da0SMatthew 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);
1573d3a7d86cSMatthew G. Knepley         if (transform) {
1574d3a7d86cSMatthew G. Knepley           gcoords = &coords[coordDim * Nq];
15759566063dSJacob Faibussowitsch           PetscCall(DMPlexBasisTransformApplyReal_Internal(dm, &coords[coordDim * q], PETSC_TRUE, coordDim, &coords[coordDim * q], gcoords, dm->transformCtx));
1576d3a7d86cSMatthew G. Knepley         } else {
1577d3a7d86cSMatthew G. Knepley           gcoords = &coords[coordDim * q];
1578d3a7d86cSMatthew G. Knepley         }
15799566063dSJacob Faibussowitsch         PetscCall(PetscArrayzero(funcVal, Nc));
15804bee2e38SMatthew G. Knepley         ierr = (*funcs[field])(coordDim, time, gcoords, n, Nc, funcVal, ctx);
1581e735a8a9SMatthew G. Knepley         if (ierr) {
15829566063dSJacob Faibussowitsch           PetscCall(DMPlexVecRestoreClosure(dm, NULL, localX, c, NULL, &x));
15839566063dSJacob Faibussowitsch           PetscCall(DMRestoreLocalVector(dm, &localX));
15849566063dSJacob Faibussowitsch           PetscCall(PetscFree6(funcVal, coords, fegeom.J, fegeom.invJ, interpolant, fegeom.detJ));
1585e735a8a9SMatthew G. Knepley         }
15869566063dSJacob Faibussowitsch         if (transform) PetscCall(DMPlexBasisTransformApply_Internal(dm, &coords[coordDim * q], PETSC_FALSE, Nc, funcVal, funcVal, dm->transformCtx));
15879566063dSJacob Faibussowitsch         PetscCall(PetscFEInterpolateGradient_Static(fe, 1, &x[fieldOffset], &qgeom, q, interpolant));
15884bee2e38SMatthew G. Knepley         /* Overwrite with the dot product if the normal is given */
15894bee2e38SMatthew G. Knepley         if (n) {
15904bee2e38SMatthew G. Knepley           for (fc = 0; fc < Nc; ++fc) {
15914bee2e38SMatthew G. Knepley             PetscScalar sum = 0.0;
15924bee2e38SMatthew G. Knepley             PetscInt    d;
15934bee2e38SMatthew G. Knepley             for (d = 0; d < dim; ++d) sum += interpolant[fc * dim + d] * n[d];
15944bee2e38SMatthew G. Knepley             interpolant[fc] = sum;
15954bee2e38SMatthew G. Knepley           }
15964bee2e38SMatthew G. Knepley         }
15979c3cf19fSMatthew G. Knepley         for (fc = 0; fc < Nc; ++fc) {
1598beaa55a6SMatthew G. Knepley           const PetscReal wt = quadWeights[q * qNc + (qNc == 1 ? 0 : qc + fc)];
159963a3b9bcSJacob Faibussowitsch           if (debug) PetscCall(PetscPrintf(PETSC_COMM_SELF, "    elem %" PetscInt_FMT " fieldDer %" PetscInt_FMT ",%" PetscInt_FMT " diff %g\n", c, field, fc, (double)(PetscSqr(PetscRealPart(interpolant[fc] - funcVal[fc])) * wt * fegeom.detJ[q])));
16004bee2e38SMatthew G. Knepley           elemDiff += PetscSqr(PetscRealPart(interpolant[fc] - funcVal[fc])) * wt * fegeom.detJ[q];
160140e14135SMatthew G. Knepley         }
160240e14135SMatthew G. Knepley       }
16039c3cf19fSMatthew G. Knepley       fieldOffset += Nb;
16049c3cf19fSMatthew G. Knepley       qc += Nc;
160540e14135SMatthew G. Knepley     }
16069566063dSJacob Faibussowitsch     PetscCall(DMPlexVecRestoreClosure(dm, NULL, localX, c, NULL, &x));
160763a3b9bcSJacob Faibussowitsch     if (debug) PetscCall(PetscPrintf(PETSC_COMM_SELF, "  elem %" PetscInt_FMT " diff %g\n", c, (double)elemDiff));
160840e14135SMatthew G. Knepley     localDiff += elemDiff;
160940e14135SMatthew G. Knepley   }
16109566063dSJacob Faibussowitsch   PetscCall(PetscFree6(funcVal, coords, fegeom.J, fegeom.invJ, interpolant, fegeom.detJ));
16119566063dSJacob Faibussowitsch   PetscCall(DMRestoreLocalVector(dm, &localX));
1612462c564dSBarry Smith   PetscCallMPI(MPIU_Allreduce(&localDiff, diff, 1, MPIU_REAL, MPIU_SUM, PetscObjectComm((PetscObject)dm)));
161340e14135SMatthew G. Knepley   *diff = PetscSqrtReal(*diff);
16143ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
1615cb1e1211SMatthew G Knepley }
1616cb1e1211SMatthew G Knepley 
1617d71ae5a4SJacob Faibussowitsch PetscErrorCode DMComputeL2FieldDiff_Plex(DM dm, PetscReal time, PetscErrorCode (**funcs)(PetscInt, PetscReal, const PetscReal[], PetscInt, PetscScalar *, void *), void **ctxs, Vec X, PetscReal *diff)
1618d71ae5a4SJacob Faibussowitsch {
16190f09c10fSMatthew G. Knepley   const PetscInt debug = ((DM_Plex *)dm->data)->printL2;
1620ca3d3a14SMatthew G. Knepley   DM             tdm;
1621083401c6SMatthew G. Knepley   DMLabel        depthLabel;
162273d901b8SMatthew G. Knepley   PetscSection   section;
1623ca3d3a14SMatthew G. Knepley   Vec            localX, tv;
162473d901b8SMatthew G. Knepley   PetscReal     *localDiff;
1625083401c6SMatthew G. Knepley   PetscInt       dim, depth, dE, Nf, f, Nds, s;
1626ca3d3a14SMatthew G. Knepley   PetscBool      transform;
162773d901b8SMatthew G. Knepley 
162873d901b8SMatthew G. Knepley   PetscFunctionBegin;
16299566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
16309566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateDim(dm, &dE));
16319566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
16329566063dSJacob Faibussowitsch   PetscCall(DMGetLocalVector(dm, &localX));
16339566063dSJacob Faibussowitsch   PetscCall(DMGetBasisTransformDM_Internal(dm, &tdm));
16349566063dSJacob Faibussowitsch   PetscCall(DMGetBasisTransformVec_Internal(dm, &tv));
16359566063dSJacob Faibussowitsch   PetscCall(DMHasBasisTransform(dm, &transform));
16369566063dSJacob Faibussowitsch   PetscCall(DMGetNumFields(dm, &Nf));
16379566063dSJacob Faibussowitsch   PetscCall(DMPlexGetDepthLabel(dm, &depthLabel));
16389566063dSJacob Faibussowitsch   PetscCall(DMLabelGetNumValues(depthLabel, &depth));
1639083401c6SMatthew G. Knepley 
16409566063dSJacob Faibussowitsch   PetscCall(VecSet(localX, 0.0));
16419566063dSJacob Faibussowitsch   PetscCall(DMGlobalToLocalBegin(dm, X, INSERT_VALUES, localX));
16429566063dSJacob Faibussowitsch   PetscCall(DMGlobalToLocalEnd(dm, X, INSERT_VALUES, localX));
16439566063dSJacob Faibussowitsch   PetscCall(DMProjectFunctionLocal(dm, time, funcs, ctxs, INSERT_BC_VALUES, localX));
16449566063dSJacob Faibussowitsch   PetscCall(DMGetNumDS(dm, &Nds));
16459566063dSJacob Faibussowitsch   PetscCall(PetscCalloc1(Nf, &localDiff));
1646083401c6SMatthew G. Knepley   for (s = 0; s < Nds; ++s) {
1647083401c6SMatthew G. Knepley     PetscDS          ds;
1648083401c6SMatthew G. Knepley     DMLabel          label;
1649083401c6SMatthew G. Knepley     IS               fieldIS, pointIS;
1650083401c6SMatthew G. Knepley     const PetscInt  *fields, *points = NULL;
1651083401c6SMatthew G. Knepley     PetscQuadrature  quad;
1652083401c6SMatthew G. Knepley     const PetscReal *quadPoints, *quadWeights;
1653083401c6SMatthew G. Knepley     PetscFEGeom      fegeom;
1654083401c6SMatthew G. Knepley     PetscReal       *coords, *gcoords;
1655083401c6SMatthew G. Knepley     PetscScalar     *funcVal, *interpolant;
16565fedec97SMatthew G. Knepley     PetscBool        isCohesive;
1657083401c6SMatthew G. Knepley     PetscInt         qNc, Nq, totNc, cStart = 0, cEnd, c, dsNf;
165873d901b8SMatthew G. Knepley 
165907218a29SMatthew G. Knepley     PetscCall(DMGetRegionNumDS(dm, s, &label, &fieldIS, &ds, NULL));
16609566063dSJacob Faibussowitsch     PetscCall(ISGetIndices(fieldIS, &fields));
16619566063dSJacob Faibussowitsch     PetscCall(PetscDSIsCohesive(ds, &isCohesive));
16629566063dSJacob Faibussowitsch     PetscCall(PetscDSGetNumFields(ds, &dsNf));
16639566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalComponents(ds, &totNc));
16649566063dSJacob Faibussowitsch     PetscCall(PetscDSGetQuadrature(ds, &quad));
16659566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureGetData(quad, NULL, &qNc, &Nq, &quadPoints, &quadWeights));
166663a3b9bcSJacob Faibussowitsch     PetscCheck(!(qNc != 1) || !(qNc != totNc), PETSC_COMM_SELF, PETSC_ERR_ARG_SIZ, "Quadrature components %" PetscInt_FMT " != %" PetscInt_FMT " field components", qNc, totNc);
16679566063dSJacob Faibussowitsch     PetscCall(PetscCalloc6(totNc, &funcVal, totNc, &interpolant, dE * (Nq + 1), &coords, Nq, &fegeom.detJ, dE * dE * Nq, &fegeom.J, dE * dE * Nq, &fegeom.invJ));
1668083401c6SMatthew G. Knepley     if (!label) {
16699566063dSJacob Faibussowitsch       PetscCall(DMPlexGetSimplexOrBoxCells(dm, 0, &cStart, &cEnd));
1670083401c6SMatthew G. Knepley     } else {
16719566063dSJacob Faibussowitsch       PetscCall(DMLabelGetStratumIS(label, 1, &pointIS));
16729566063dSJacob Faibussowitsch       PetscCall(ISGetLocalSize(pointIS, &cEnd));
16739566063dSJacob Faibussowitsch       PetscCall(ISGetIndices(pointIS, &points));
1674083401c6SMatthew G. Knepley     }
167573d901b8SMatthew G. Knepley     for (c = cStart; c < cEnd; ++c) {
1676083401c6SMatthew G. Knepley       const PetscInt  cell = points ? points[c] : c;
167773d901b8SMatthew G. Knepley       PetscScalar    *x    = NULL;
16785fedec97SMatthew G. Knepley       const PetscInt *cone;
16795fedec97SMatthew G. Knepley       PetscInt        qc = 0, fOff = 0, dep;
168073d901b8SMatthew G. Knepley 
16819566063dSJacob Faibussowitsch       PetscCall(DMLabelGetValue(depthLabel, cell, &dep));
1682083401c6SMatthew G. Knepley       if (dep != depth - 1) continue;
16835fedec97SMatthew G. Knepley       if (isCohesive) {
16849566063dSJacob Faibussowitsch         PetscCall(DMPlexGetCone(dm, cell, &cone));
16859566063dSJacob Faibussowitsch         PetscCall(DMPlexComputeCellGeometryFEM(dm, cone[0], quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
168696959cd1SMatthew G. Knepley       } else {
16879566063dSJacob Faibussowitsch         PetscCall(DMPlexComputeCellGeometryFEM(dm, cell, quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
168896959cd1SMatthew G. Knepley       }
1689e8e188d2SZach Atkins       PetscCall(DMPlexVecGetOrientedClosure_Internal(dm, NULL, PETSC_FALSE, localX, cell, 0, NULL, &x));
16905fedec97SMatthew G. Knepley       for (f = 0; f < dsNf; ++f) {
169115496722SMatthew G. Knepley         PetscObject  obj;
169215496722SMatthew G. Knepley         PetscClassId id;
1693083401c6SMatthew G. Knepley         void *const  ctx = ctxs ? ctxs[fields[f]] : NULL;
169415496722SMatthew G. Knepley         PetscInt     Nb, Nc, q, fc;
169515496722SMatthew G. Knepley         PetscReal    elemDiff = 0.0;
16965fedec97SMatthew G. Knepley         PetscBool    cohesive;
169715496722SMatthew G. Knepley 
16989566063dSJacob Faibussowitsch         PetscCall(PetscDSGetCohesive(ds, f, &cohesive));
16999566063dSJacob Faibussowitsch         PetscCall(PetscDSGetDiscretization(ds, f, &obj));
17009566063dSJacob Faibussowitsch         PetscCall(PetscObjectGetClassId(obj, &id));
17019371c9d4SSatish Balay         if (id == PETSCFE_CLASSID) {
17029371c9d4SSatish Balay           PetscCall(PetscFEGetNumComponents((PetscFE)obj, &Nc));
17039371c9d4SSatish Balay           PetscCall(PetscFEGetDimension((PetscFE)obj, &Nb));
17049371c9d4SSatish Balay         } else if (id == PETSCFV_CLASSID) {
17059371c9d4SSatish Balay           PetscCall(PetscFVGetNumComponents((PetscFV)obj, &Nc));
17069371c9d4SSatish Balay           Nb = 1;
17079371c9d4SSatish Balay         } else SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, fields[f]);
1708c82db6dbSMatthew G. Knepley         if (isCohesive && !cohesive) {
1709c82db6dbSMatthew G. Knepley           fOff += Nb * 2;
1710c82db6dbSMatthew G. Knepley           qc += Nc;
1711c82db6dbSMatthew G. Knepley           continue;
1712c82db6dbSMatthew G. Knepley         }
171373d901b8SMatthew G. Knepley         if (debug) {
171473d901b8SMatthew G. Knepley           char title[1024];
171563a3b9bcSJacob Faibussowitsch           PetscCall(PetscSNPrintf(title, 1023, "Solution for Field %" PetscInt_FMT, fields[f]));
17169566063dSJacob Faibussowitsch           PetscCall(DMPrintCellVector(cell, title, Nb, &x[fOff]));
171773d901b8SMatthew G. Knepley         }
17187318780aSToby Isaac         for (q = 0; q < Nq; ++q) {
17192a4e142eSMatthew G. Knepley           PetscFEGeom    qgeom;
1720d0609cedSBarry Smith           PetscErrorCode ierr;
17212a4e142eSMatthew G. Knepley 
17222a4e142eSMatthew G. Knepley           qgeom.dimEmbed = fegeom.dimEmbed;
1723083401c6SMatthew G. Knepley           qgeom.J        = &fegeom.J[q * dE * dE];
1724083401c6SMatthew G. Knepley           qgeom.invJ     = &fegeom.invJ[q * dE * dE];
17252a4e142eSMatthew G. Knepley           qgeom.detJ     = &fegeom.detJ[q];
172663a3b9bcSJacob Faibussowitsch           PetscCheck(fegeom.detJ[q] > 0.0, PETSC_COMM_SELF, PETSC_ERR_ARG_OUTOFRANGE, "Invalid determinant %g for cell %" PetscInt_FMT ", quadrature point %" PetscInt_FMT, (double)fegeom.detJ[q], cell, q);
1727d3a7d86cSMatthew G. Knepley           if (transform) {
1728083401c6SMatthew G. Knepley             gcoords = &coords[dE * Nq];
17299566063dSJacob Faibussowitsch             PetscCall(DMPlexBasisTransformApplyReal_Internal(dm, &coords[dE * q], PETSC_TRUE, dE, &coords[dE * q], gcoords, dm->transformCtx));
1730d3a7d86cSMatthew G. Knepley           } else {
1731083401c6SMatthew G. Knepley             gcoords = &coords[dE * q];
1732d3a7d86cSMatthew G. Knepley           }
17332df84da0SMatthew G. Knepley           for (fc = 0; fc < Nc; ++fc) funcVal[fc] = 0.;
1734083401c6SMatthew G. Knepley           ierr = (*funcs[fields[f]])(dE, time, gcoords, Nc, funcVal, ctx);
1735e735a8a9SMatthew G. Knepley           if (ierr) {
17369566063dSJacob Faibussowitsch             PetscCall(DMPlexVecRestoreClosure(dm, NULL, localX, cell, NULL, &x));
17379566063dSJacob Faibussowitsch             PetscCall(DMRestoreLocalVector(dm, &localX));
17389566063dSJacob Faibussowitsch             PetscCall(PetscFree6(funcVal, interpolant, coords, fegeom.detJ, fegeom.J, fegeom.invJ));
1739e735a8a9SMatthew G. Knepley           }
17409566063dSJacob Faibussowitsch           if (transform) PetscCall(DMPlexBasisTransformApply_Internal(dm, &coords[dE * q], PETSC_FALSE, Nc, funcVal, funcVal, dm->transformCtx));
174196959cd1SMatthew G. Knepley           /* Call once for each face, except for lagrange field */
17429566063dSJacob Faibussowitsch           if (id == PETSCFE_CLASSID) PetscCall(PetscFEInterpolate_Static((PetscFE)obj, &x[fOff], &qgeom, q, interpolant));
17439566063dSJacob Faibussowitsch           else if (id == PETSCFV_CLASSID) PetscCall(PetscFVInterpolate_Static((PetscFV)obj, &x[fOff], q, interpolant));
174463a3b9bcSJacob Faibussowitsch           else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, fields[f]);
174515496722SMatthew G. Knepley           for (fc = 0; fc < Nc; ++fc) {
1746beaa55a6SMatthew G. Knepley             const PetscReal wt = quadWeights[q * qNc + (qNc == 1 ? 0 : qc + fc)];
17479371c9d4SSatish Balay             if (debug)
17489371c9d4SSatish Balay               PetscCall(PetscPrintf(PETSC_COMM_SELF, "    cell %" PetscInt_FMT " field %" PetscInt_FMT ",%" PetscInt_FMT " point %g %g %g diff %g\n", cell, fields[f], fc, (double)(dE > 0 ? coords[dE * q] : 0.), (double)(dE > 1 ? coords[dE * q + 1] : 0.), (double)(dE > 2 ? coords[dE * q + 2] : 0.),
17499371c9d4SSatish Balay                                     (double)(PetscSqr(PetscRealPart(interpolant[fc] - funcVal[fc])) * wt * fegeom.detJ[q])));
17504bee2e38SMatthew G. Knepley             elemDiff += PetscSqr(PetscRealPart(interpolant[fc] - funcVal[fc])) * wt * fegeom.detJ[q];
175173d901b8SMatthew G. Knepley           }
175273d901b8SMatthew G. Knepley         }
1753083401c6SMatthew G. Knepley         fOff += Nb;
17549c3cf19fSMatthew G. Knepley         qc += Nc;
1755083401c6SMatthew G. Knepley         localDiff[fields[f]] += elemDiff;
175663a3b9bcSJacob Faibussowitsch         if (debug) PetscCall(PetscPrintf(PETSC_COMM_SELF, "  cell %" PetscInt_FMT " field %" PetscInt_FMT " cum diff %g\n", cell, fields[f], (double)localDiff[fields[f]]));
175773d901b8SMatthew G. Knepley       }
17589566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(dm, NULL, localX, cell, NULL, &x));
1759083401c6SMatthew G. Knepley     }
1760083401c6SMatthew G. Knepley     if (label) {
17619566063dSJacob Faibussowitsch       PetscCall(ISRestoreIndices(pointIS, &points));
17629566063dSJacob Faibussowitsch       PetscCall(ISDestroy(&pointIS));
1763083401c6SMatthew G. Knepley     }
17649566063dSJacob Faibussowitsch     PetscCall(ISRestoreIndices(fieldIS, &fields));
17659566063dSJacob Faibussowitsch     PetscCall(PetscFree6(funcVal, interpolant, coords, fegeom.detJ, fegeom.J, fegeom.invJ));
176673d901b8SMatthew G. Knepley   }
17679566063dSJacob Faibussowitsch   PetscCall(DMRestoreLocalVector(dm, &localX));
1768462c564dSBarry Smith   PetscCallMPI(MPIU_Allreduce(localDiff, diff, (PetscMPIInt)Nf, MPIU_REAL, MPIU_SUM, PetscObjectComm((PetscObject)dm)));
17699566063dSJacob Faibussowitsch   PetscCall(PetscFree(localDiff));
1770083401c6SMatthew G. Knepley   for (f = 0; f < Nf; ++f) diff[f] = PetscSqrtReal(diff[f]);
17713ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
177273d901b8SMatthew G. Knepley }
177373d901b8SMatthew G. Knepley 
1774e729f68cSMatthew G. Knepley /*@C
1775e729f68cSMatthew 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.
1776e729f68cSMatthew G. Knepley 
177720f4b53cSBarry Smith   Collective
1778c0f8e1fdSMatthew G. Knepley 
1779e729f68cSMatthew G. Knepley   Input Parameters:
1780a1cb98faSBarry Smith + dm    - The `DM`
17810163fd50SMatthew G. Knepley . time  - The time
178220f4b53cSBarry Smith . funcs - The functions to evaluate for each field component: `NULL` means that component does not contribute to error calculation
178320f4b53cSBarry Smith . ctxs  - Optional array of contexts to pass to each function, or `NULL`.
1784e729f68cSMatthew G. Knepley - X     - The coefficient vector u_h
1785e729f68cSMatthew G. Knepley 
1786e729f68cSMatthew G. Knepley   Output Parameter:
178720f4b53cSBarry Smith . D - A `Vec` which holds the difference ||u - u_h||_2 for each cell
1788e729f68cSMatthew G. Knepley 
1789e729f68cSMatthew G. Knepley   Level: developer
1790e729f68cSMatthew G. Knepley 
17911cc06b55SBarry Smith .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `DMProjectFunction()`, `DMComputeL2Diff()`, `DMPlexComputeL2FieldDiff()`, `DMComputeL2GradientDiff()`
1792e729f68cSMatthew G. Knepley @*/
1793d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexComputeL2DiffVec(DM dm, PetscReal time, PetscErrorCode (**funcs)(PetscInt, PetscReal, const PetscReal[], PetscInt, PetscScalar *, void *), void **ctxs, Vec X, Vec D)
1794d71ae5a4SJacob Faibussowitsch {
1795e729f68cSMatthew G. Knepley   PetscSection     section;
1796e729f68cSMatthew G. Knepley   PetscQuadrature  quad;
1797e729f68cSMatthew G. Knepley   Vec              localX;
17984bee2e38SMatthew G. Knepley   PetscFEGeom      fegeom;
1799e729f68cSMatthew G. Knepley   PetscScalar     *funcVal, *interpolant;
18004bee2e38SMatthew G. Knepley   PetscReal       *coords;
1801e729f68cSMatthew G. Knepley   const PetscReal *quadPoints, *quadWeights;
1802485ad865SMatthew G. Knepley   PetscInt         dim, coordDim, numFields, numComponents = 0, qNc, Nq, cStart, cEnd, c, field, fieldOffset;
1803e729f68cSMatthew G. Knepley 
1804e729f68cSMatthew G. Knepley   PetscFunctionBegin;
18059566063dSJacob Faibussowitsch   PetscCall(VecSet(D, 0.0));
18069566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
18079566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateDim(dm, &coordDim));
18089566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
18099566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetNumFields(section, &numFields));
18109566063dSJacob Faibussowitsch   PetscCall(DMGetLocalVector(dm, &localX));
18119566063dSJacob Faibussowitsch   PetscCall(DMProjectFunctionLocal(dm, time, funcs, ctxs, INSERT_BC_VALUES, localX));
18129566063dSJacob Faibussowitsch   PetscCall(DMGlobalToLocalBegin(dm, X, INSERT_VALUES, localX));
18139566063dSJacob Faibussowitsch   PetscCall(DMGlobalToLocalEnd(dm, X, INSERT_VALUES, localX));
1814e729f68cSMatthew G. Knepley   for (field = 0; field < numFields; ++field) {
1815e729f68cSMatthew G. Knepley     PetscObject  obj;
1816e729f68cSMatthew G. Knepley     PetscClassId id;
1817e729f68cSMatthew G. Knepley     PetscInt     Nc;
1818e729f68cSMatthew G. Knepley 
18199566063dSJacob Faibussowitsch     PetscCall(DMGetField(dm, field, NULL, &obj));
18209566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
1821e729f68cSMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
1822e729f68cSMatthew G. Knepley       PetscFE fe = (PetscFE)obj;
1823e729f68cSMatthew G. Knepley 
18249566063dSJacob Faibussowitsch       PetscCall(PetscFEGetQuadrature(fe, &quad));
18259566063dSJacob Faibussowitsch       PetscCall(PetscFEGetNumComponents(fe, &Nc));
1826e729f68cSMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
1827e729f68cSMatthew G. Knepley       PetscFV fv = (PetscFV)obj;
1828e729f68cSMatthew G. Knepley 
18299566063dSJacob Faibussowitsch       PetscCall(PetscFVGetQuadrature(fv, &quad));
18309566063dSJacob Faibussowitsch       PetscCall(PetscFVGetNumComponents(fv, &Nc));
183163a3b9bcSJacob Faibussowitsch     } else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, field);
1832e729f68cSMatthew G. Knepley     numComponents += Nc;
1833e729f68cSMatthew G. Knepley   }
18349566063dSJacob Faibussowitsch   PetscCall(PetscQuadratureGetData(quad, NULL, &qNc, &Nq, &quadPoints, &quadWeights));
183563a3b9bcSJacob Faibussowitsch   PetscCheck(!(qNc != 1) || !(qNc != numComponents), PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_SIZ, "Quadrature components %" PetscInt_FMT " != %" PetscInt_FMT " field components", qNc, numComponents);
18369566063dSJacob Faibussowitsch   PetscCall(PetscMalloc6(numComponents, &funcVal, numComponents, &interpolant, coordDim * Nq, &coords, Nq, &fegeom.detJ, coordDim * coordDim * Nq, &fegeom.J, coordDim * coordDim * Nq, &fegeom.invJ));
18379566063dSJacob Faibussowitsch   PetscCall(DMPlexGetSimplexOrBoxCells(dm, 0, &cStart, &cEnd));
1838e729f68cSMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
1839e729f68cSMatthew G. Knepley     PetscScalar *x        = NULL;
18406f288a59SMatthew G. Knepley     PetscScalar  elemDiff = 0.0;
18419c3cf19fSMatthew G. Knepley     PetscInt     qc       = 0;
1842e729f68cSMatthew G. Knepley 
18439566063dSJacob Faibussowitsch     PetscCall(DMPlexComputeCellGeometryFEM(dm, c, quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
1844e8e188d2SZach Atkins     PetscCall(DMPlexVecGetOrientedClosure_Internal(dm, NULL, PETSC_FALSE, localX, c, 0, NULL, &x));
1845e729f68cSMatthew G. Knepley 
1846e729f68cSMatthew G. Knepley     for (field = 0, fieldOffset = 0; field < numFields; ++field) {
1847e729f68cSMatthew G. Knepley       PetscObject  obj;
1848e729f68cSMatthew G. Knepley       PetscClassId id;
1849e729f68cSMatthew G. Knepley       void *const  ctx = ctxs ? ctxs[field] : NULL;
1850e729f68cSMatthew G. Knepley       PetscInt     Nb, Nc, q, fc;
1851e729f68cSMatthew G. Knepley 
18529566063dSJacob Faibussowitsch       PetscCall(DMGetField(dm, field, NULL, &obj));
18539566063dSJacob Faibussowitsch       PetscCall(PetscObjectGetClassId(obj, &id));
18549371c9d4SSatish Balay       if (id == PETSCFE_CLASSID) {
18559371c9d4SSatish Balay         PetscCall(PetscFEGetNumComponents((PetscFE)obj, &Nc));
18569371c9d4SSatish Balay         PetscCall(PetscFEGetDimension((PetscFE)obj, &Nb));
18579371c9d4SSatish Balay       } else if (id == PETSCFV_CLASSID) {
18589371c9d4SSatish Balay         PetscCall(PetscFVGetNumComponents((PetscFV)obj, &Nc));
18599371c9d4SSatish Balay         Nb = 1;
18609371c9d4SSatish Balay       } else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, field);
186123f34ed2SToby Isaac       if (funcs[field]) {
18627318780aSToby Isaac         for (q = 0; q < Nq; ++q) {
18632a4e142eSMatthew G. Knepley           PetscFEGeom qgeom;
18642a4e142eSMatthew G. Knepley 
18652a4e142eSMatthew G. Knepley           qgeom.dimEmbed = fegeom.dimEmbed;
18662a4e142eSMatthew G. Knepley           qgeom.J        = &fegeom.J[q * coordDim * coordDim];
18672a4e142eSMatthew G. Knepley           qgeom.invJ     = &fegeom.invJ[q * coordDim * coordDim];
18682a4e142eSMatthew G. Knepley           qgeom.detJ     = &fegeom.detJ[q];
186963a3b9bcSJacob Faibussowitsch           PetscCheck(fegeom.detJ[q] > 0.0, PETSC_COMM_SELF, PETSC_ERR_ARG_OUTOFRANGE, "Invalid determinant %g for element %" PetscInt_FMT ", quadrature points %" PetscInt_FMT, (double)fegeom.detJ[q], c, q);
18709566063dSJacob Faibussowitsch           PetscCall((*funcs[field])(coordDim, time, &coords[q * coordDim], Nc, funcVal, ctx));
1871c3e24edfSBarry Smith #if defined(needs_fix_with_return_code_argument)
1872e735a8a9SMatthew G. Knepley           if (ierr) {
18739566063dSJacob Faibussowitsch             PetscCall(DMPlexVecRestoreClosure(dm, NULL, localX, c, NULL, &x));
18749566063dSJacob Faibussowitsch             PetscCall(PetscFree6(funcVal, interpolant, coords, fegeom.detJ, fegeom.J, fegeom.invJ));
18759566063dSJacob Faibussowitsch             PetscCall(DMRestoreLocalVector(dm, &localX));
1876e735a8a9SMatthew G. Knepley           }
1877c3e24edfSBarry Smith #endif
18789566063dSJacob Faibussowitsch           if (id == PETSCFE_CLASSID) PetscCall(PetscFEInterpolate_Static((PetscFE)obj, &x[fieldOffset], &qgeom, q, interpolant));
18799566063dSJacob Faibussowitsch           else if (id == PETSCFV_CLASSID) PetscCall(PetscFVInterpolate_Static((PetscFV)obj, &x[fieldOffset], q, interpolant));
188063a3b9bcSJacob Faibussowitsch           else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, field);
1881e729f68cSMatthew G. Knepley           for (fc = 0; fc < Nc; ++fc) {
1882beaa55a6SMatthew G. Knepley             const PetscReal wt = quadWeights[q * qNc + (qNc == 1 ? 0 : qc + fc)];
18834bee2e38SMatthew G. Knepley             elemDiff += PetscSqr(PetscRealPart(interpolant[fc] - funcVal[fc])) * wt * fegeom.detJ[q];
1884e729f68cSMatthew G. Knepley           }
1885e729f68cSMatthew G. Knepley         }
188623f34ed2SToby Isaac       }
1887beaa55a6SMatthew G. Knepley       fieldOffset += Nb;
18889c3cf19fSMatthew G. Knepley       qc += Nc;
1889e729f68cSMatthew G. Knepley     }
18909566063dSJacob Faibussowitsch     PetscCall(DMPlexVecRestoreClosure(dm, NULL, localX, c, NULL, &x));
18919566063dSJacob Faibussowitsch     PetscCall(VecSetValue(D, c - cStart, elemDiff, INSERT_VALUES));
1892e729f68cSMatthew G. Knepley   }
18939566063dSJacob Faibussowitsch   PetscCall(PetscFree6(funcVal, interpolant, coords, fegeom.detJ, fegeom.J, fegeom.invJ));
18949566063dSJacob Faibussowitsch   PetscCall(DMRestoreLocalVector(dm, &localX));
18959566063dSJacob Faibussowitsch   PetscCall(VecSqrtAbs(D));
18963ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
1897e729f68cSMatthew G. Knepley }
1898e729f68cSMatthew G. Knepley 
18995f0b18bfSMatthew G. Knepley /*@
19002353bfffSMatthew G. Knepley   DMPlexComputeL2FluxDiffVecLocal - This function computes the integral of the difference between the gradient of field `f`in `u` and field `mf` in `mu`
19012353bfffSMatthew G. Knepley 
19022353bfffSMatthew G. Knepley   Collective
19032353bfffSMatthew G. Knepley 
19042353bfffSMatthew G. Knepley   Input Parameters:
19052353bfffSMatthew G. Knepley + lu  - The local `Vec` containing the primal solution
19062353bfffSMatthew G. Knepley . f   - The field number for the potential
19072353bfffSMatthew G. Knepley . lmu - The local `Vec` containing the mixed solution
19082353bfffSMatthew G. Knepley - mf  - The field number for the flux
19092353bfffSMatthew G. Knepley 
19102353bfffSMatthew G. Knepley   Output Parameter:
19112353bfffSMatthew G. Knepley . eFlux - A global `Vec` which holds $||\nabla u_f - \mu_{mf}||$
19122353bfffSMatthew G. Knepley 
19132353bfffSMatthew G. Knepley   Level: advanced
19142353bfffSMatthew G. Knepley 
19152353bfffSMatthew G. Knepley   Notes:
19162353bfffSMatthew G. Knepley   We assume that the `DM` for each solution has the same topology, geometry, and quadrature.
19172353bfffSMatthew G. Knepley 
19182353bfffSMatthew G. Knepley   This is usually used to get an error estimate for the primal solution, using the flux from a mixed solution.
19192353bfffSMatthew G. Knepley 
19202353bfffSMatthew G. Knepley .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `DMPlexComputeL2FluxDiffVec()`, `DMProjectFunction()`, `DMComputeL2Diff()`, `DMPlexComputeL2FieldDiff()`, `DMComputeL2GradientDiff()`
19212353bfffSMatthew G. Knepley @*/
19222353bfffSMatthew G. Knepley PetscErrorCode DMPlexComputeL2FluxDiffVecLocal(Vec lu, PetscInt f, Vec lmu, PetscInt mf, Vec eFlux)
19232353bfffSMatthew G. Knepley {
19242353bfffSMatthew G. Knepley   DM               dm, mdm, edm;
19252353bfffSMatthew G. Knepley   PetscFE          fe, mfe;
19262353bfffSMatthew G. Knepley   PetscFEGeom      fegeom;
19272353bfffSMatthew G. Knepley   PetscQuadrature  quad;
19282353bfffSMatthew G. Knepley   const PetscReal *quadWeights;
19292353bfffSMatthew G. Knepley   PetscReal       *coords;
19302353bfffSMatthew G. Knepley   PetscScalar     *interpolant, *minterpolant, *earray;
19312353bfffSMatthew G. Knepley   PetscInt         cdim, mcdim, cStart, cEnd, Nc, mNc, qNc, Nq;
19322353bfffSMatthew G. Knepley   MPI_Comm         comm;
19332353bfffSMatthew G. Knepley 
19342353bfffSMatthew G. Knepley   PetscFunctionBegin;
19352353bfffSMatthew G. Knepley   PetscCall(VecGetDM(lu, &dm));
19362353bfffSMatthew G. Knepley   PetscCall(VecGetDM(lmu, &mdm));
19372353bfffSMatthew G. Knepley   PetscCall(VecGetDM(eFlux, &edm));
19382353bfffSMatthew G. Knepley   PetscCall(PetscObjectGetComm((PetscObject)dm, &comm));
19392353bfffSMatthew G. Knepley   PetscCall(VecSet(eFlux, 0.0));
19402353bfffSMatthew G. Knepley 
19412353bfffSMatthew G. Knepley   // Check if the both problems are on the same mesh
19422353bfffSMatthew G. Knepley   PetscCall(DMGetCoordinateDim(dm, &cdim));
19432353bfffSMatthew G. Knepley   PetscCall(DMGetCoordinateDim(mdm, &mcdim));
19442353bfffSMatthew G. Knepley   PetscCheck(cdim == mcdim, comm, PETSC_ERR_ARG_SIZ, "primal coordinate Dim %" PetscInt_FMT " != %" PetscInt_FMT " mixed coordinate Dim", cdim, mcdim);
19452353bfffSMatthew G. Knepley   fegeom.dimEmbed = cdim;
19462353bfffSMatthew G. Knepley 
19472353bfffSMatthew G. Knepley   PetscCall(DMGetField(dm, f, NULL, (PetscObject *)&fe));
19482353bfffSMatthew G. Knepley   PetscCall(DMGetField(mdm, mf, NULL, (PetscObject *)&mfe));
19492353bfffSMatthew G. Knepley   PetscCall(PetscFEGetNumComponents(fe, &Nc));
19502353bfffSMatthew G. Knepley   PetscCall(PetscFEGetNumComponents(mfe, &mNc));
19512353bfffSMatthew G. Knepley   PetscCall(PetscFEGetQuadrature(fe, &quad));
19522353bfffSMatthew G. Knepley   PetscCall(PetscQuadratureGetData(quad, NULL, &qNc, &Nq, NULL, &quadWeights));
19532353bfffSMatthew G. Knepley   PetscCheck(qNc == 1 || qNc == mNc, comm, PETSC_ERR_ARG_SIZ, "Quadrature components %" PetscInt_FMT " != %" PetscInt_FMT " field components", qNc, mNc);
19542353bfffSMatthew G. Knepley 
19552353bfffSMatthew G. Knepley   PetscCall(DMPlexGetSimplexOrBoxCells(dm, 0, &cStart, &cEnd));
19562353bfffSMatthew G. Knepley   PetscCall(VecGetArrayWrite(eFlux, &earray));
19572353bfffSMatthew G. Knepley   PetscCall(PetscMalloc6(Nc * cdim, &interpolant, mNc * cdim, &minterpolant, cdim * (Nq + 1), &coords, cdim * cdim * Nq, &fegeom.J, cdim * cdim * Nq, &fegeom.invJ, Nq, &fegeom.detJ));
19582353bfffSMatthew G. Knepley   for (PetscInt c = cStart; c < cEnd; ++c) {
19592353bfffSMatthew G. Knepley     PetscScalar *x            = NULL;
19602353bfffSMatthew G. Knepley     PetscScalar *mx           = NULL;
19612353bfffSMatthew G. Knepley     PetscScalar *eval         = NULL;
19622353bfffSMatthew G. Knepley     PetscReal    fluxElemDiff = 0.0;
19632353bfffSMatthew G. Knepley 
19642353bfffSMatthew G. Knepley     PetscCall(DMPlexComputeCellGeometryFEM(dm, c, quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
19652353bfffSMatthew G. Knepley     PetscCall(DMPlexVecGetClosure(dm, NULL, lu, c, NULL, &x));
19662353bfffSMatthew G. Knepley     PetscCall(DMPlexVecGetClosure(mdm, NULL, lmu, c, NULL, &mx));
19672353bfffSMatthew G. Knepley 
19682353bfffSMatthew G. Knepley     for (PetscInt q = 0; q < Nq; ++q) {
19692353bfffSMatthew G. Knepley       PetscFEGeom qgeom;
19702353bfffSMatthew G. Knepley 
19712353bfffSMatthew G. Knepley       qgeom.dimEmbed = fegeom.dimEmbed;
19722353bfffSMatthew G. Knepley       qgeom.J        = &fegeom.J[q * cdim * cdim];
19732353bfffSMatthew G. Knepley       qgeom.invJ     = &fegeom.invJ[q * cdim * cdim];
19742353bfffSMatthew G. Knepley       qgeom.detJ     = &fegeom.detJ[q];
19752353bfffSMatthew G. Knepley 
19762353bfffSMatthew 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);
19772353bfffSMatthew G. Knepley 
19782353bfffSMatthew G. Knepley       PetscCall(PetscFEInterpolate_Static(mfe, &mx[0], &qgeom, q, minterpolant));
19792353bfffSMatthew G. Knepley       PetscCall(PetscFEInterpolateGradient_Static(fe, 1, &x[0], &qgeom, q, interpolant));
19802353bfffSMatthew G. Knepley 
19812353bfffSMatthew G. Knepley       /* Now take the elementwise difference and store that in a vector. */
19822353bfffSMatthew G. Knepley       for (PetscInt fc = 0; fc < mNc; ++fc) {
19832353bfffSMatthew G. Knepley         const PetscReal wt = quadWeights[q * qNc + (qNc == 1 ? 0 : fc)];
19842353bfffSMatthew G. Knepley         fluxElemDiff += PetscSqr(PetscRealPart(interpolant[fc] - minterpolant[fc])) * wt * fegeom.detJ[q];
19852353bfffSMatthew G. Knepley       }
19862353bfffSMatthew G. Knepley     }
19872353bfffSMatthew G. Knepley     PetscCall(DMPlexVecRestoreClosure(dm, NULL, lu, c, NULL, &x));
19882353bfffSMatthew G. Knepley     PetscCall(DMPlexVecRestoreClosure(mdm, NULL, lmu, c, NULL, &mx));
19892353bfffSMatthew G. Knepley     PetscCall(DMPlexPointGlobalRef(edm, c, earray, (void *)&eval));
19902353bfffSMatthew G. Knepley     if (eval) eval[0] = fluxElemDiff;
19912353bfffSMatthew G. Knepley   }
19922353bfffSMatthew G. Knepley   PetscCall(PetscFree6(interpolant, minterpolant, coords, fegeom.detJ, fegeom.J, fegeom.invJ));
19932353bfffSMatthew G. Knepley   PetscCall(VecRestoreArrayWrite(eFlux, &earray));
19942353bfffSMatthew G. Knepley 
19952353bfffSMatthew G. Knepley   PetscCall(VecAssemblyBegin(eFlux));
19962353bfffSMatthew G. Knepley   PetscCall(VecAssemblyEnd(eFlux));
19972353bfffSMatthew G. Knepley   PetscCall(VecSqrtAbs(eFlux));
19982353bfffSMatthew G. Knepley   PetscFunctionReturn(PETSC_SUCCESS);
19992353bfffSMatthew G. Knepley }
20002353bfffSMatthew G. Knepley 
20012353bfffSMatthew G. Knepley /*@
20022353bfffSMatthew G. Knepley   DMPlexComputeL2FluxDiffVec - This function computes the integral of the difference between the gradient of field `f`in `u` and field `mf` in `mu`
20032353bfffSMatthew G. Knepley 
20042353bfffSMatthew G. Knepley   Collective
20052353bfffSMatthew G. Knepley 
20062353bfffSMatthew G. Knepley   Input Parameters:
20072353bfffSMatthew G. Knepley + u  - The global `Vec` containing the primal solution
20082353bfffSMatthew G. Knepley . f  - The field number for the potential
20092353bfffSMatthew G. Knepley . mu - The global `Vec` containing the mixed solution
20102353bfffSMatthew G. Knepley - mf - The field number for the flux
20112353bfffSMatthew G. Knepley 
20122353bfffSMatthew G. Knepley   Output Parameter:
20132353bfffSMatthew G. Knepley . eFlux - A global `Vec` which holds $||\nabla u_f - \mu_{mf}||$
20142353bfffSMatthew G. Knepley 
20152353bfffSMatthew G. Knepley   Level: advanced
20162353bfffSMatthew G. Knepley 
20172353bfffSMatthew G. Knepley   Notes:
20182353bfffSMatthew G. Knepley   We assume that the `DM` for each solution has the same topology, geometry, and quadrature.
20192353bfffSMatthew G. Knepley 
20202353bfffSMatthew G. Knepley   This is usually used to get an error estimate for the primal solution, using the flux from a mixed solution.
20212353bfffSMatthew G. Knepley 
20222353bfffSMatthew G. Knepley .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `DMPlexComputeL2FluxDiffVecLocal()`, `DMProjectFunction()`, `DMComputeL2Diff()`, `DMPlexComputeL2FieldDiff()`, `DMComputeL2GradientDiff()`
20232353bfffSMatthew G. Knepley @*/
20242353bfffSMatthew G. Knepley PetscErrorCode DMPlexComputeL2FluxDiffVec(Vec u, PetscInt f, Vec mu, PetscInt mf, Vec eFlux)
20252353bfffSMatthew G. Knepley {
20262353bfffSMatthew G. Knepley   DM  dm, mdm;
20272353bfffSMatthew G. Knepley   Vec lu, lmu;
20282353bfffSMatthew G. Knepley 
20292353bfffSMatthew G. Knepley   PetscFunctionBegin;
20302353bfffSMatthew G. Knepley   PetscCall(VecGetDM(u, &dm));
20312353bfffSMatthew G. Knepley   PetscCall(DMGetLocalVector(dm, &lu));
20322353bfffSMatthew G. Knepley   PetscCall(DMGlobalToLocal(dm, u, INSERT_VALUES, lu));
20332353bfffSMatthew G. Knepley   PetscCall(DMPlexInsertBoundaryValues(dm, PETSC_TRUE, lu, 0.0, NULL, NULL, NULL));
20342353bfffSMatthew G. Knepley 
20352353bfffSMatthew G. Knepley   PetscCall(VecGetDM(mu, &mdm));
20362353bfffSMatthew G. Knepley   PetscCall(DMGetLocalVector(mdm, &lmu));
20372353bfffSMatthew G. Knepley   PetscCall(DMGlobalToLocal(mdm, mu, INSERT_VALUES, lmu));
20382353bfffSMatthew G. Knepley   PetscCall(DMPlexInsertBoundaryValues(mdm, PETSC_TRUE, lmu, 0.0, NULL, NULL, NULL));
20392353bfffSMatthew G. Knepley 
20402353bfffSMatthew G. Knepley   PetscCall(DMPlexComputeL2FluxDiffVecLocal(lu, f, lmu, mf, eFlux));
20412353bfffSMatthew G. Knepley 
20422353bfffSMatthew G. Knepley   PetscCall(DMRestoreLocalVector(dm, &lu));
20432353bfffSMatthew G. Knepley   PetscCall(DMRestoreLocalVector(mdm, &lmu));
20442353bfffSMatthew G. Knepley   PetscFunctionReturn(PETSC_SUCCESS);
20452353bfffSMatthew G. Knepley }
20462353bfffSMatthew G. Knepley 
20472353bfffSMatthew G. Knepley /*@
204820f4b53cSBarry Smith   DMPlexComputeClementInterpolant - This function computes the L2 projection of the cellwise values of a function u onto P1
20495f0b18bfSMatthew G. Knepley 
205020f4b53cSBarry Smith   Collective
20515f0b18bfSMatthew G. Knepley 
20525f0b18bfSMatthew G. Knepley   Input Parameters:
2053a1cb98faSBarry Smith + dm   - The `DM`
20545f0b18bfSMatthew G. Knepley - locX - The coefficient vector u_h
20555f0b18bfSMatthew G. Knepley 
20565f0b18bfSMatthew G. Knepley   Output Parameter:
2057a1cb98faSBarry Smith . locC - A `Vec` which holds the Clement interpolant of the function
20585f0b18bfSMatthew G. Knepley 
20595f0b18bfSMatthew G. Knepley   Level: developer
20605f0b18bfSMatthew G. Knepley 
2061a1cb98faSBarry Smith   Note:
2062a1cb98faSBarry Smith   $ 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
2063a1cb98faSBarry Smith 
20641cc06b55SBarry Smith .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `DMProjectFunction()`, `DMComputeL2Diff()`, `DMPlexComputeL2FieldDiff()`, `DMComputeL2GradientDiff()`
20655f0b18bfSMatthew G. Knepley @*/
2066d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexComputeClementInterpolant(DM dm, Vec locX, Vec locC)
2067d71ae5a4SJacob Faibussowitsch {
20685f0b18bfSMatthew G. Knepley   PetscInt         debug = ((DM_Plex *)dm->data)->printFEM;
20695f0b18bfSMatthew G. Knepley   DM               dmc;
20705f0b18bfSMatthew G. Knepley   PetscQuadrature  quad;
20715f0b18bfSMatthew G. Knepley   PetscScalar     *interpolant, *valsum;
20725f0b18bfSMatthew G. Knepley   PetscFEGeom      fegeom;
20735f0b18bfSMatthew G. Knepley   PetscReal       *coords;
20745f0b18bfSMatthew G. Knepley   const PetscReal *quadPoints, *quadWeights;
20755f0b18bfSMatthew G. Knepley   PetscInt         dim, cdim, Nf, f, Nc = 0, Nq, qNc, cStart, cEnd, vStart, vEnd, v;
20765f0b18bfSMatthew G. Knepley 
20775f0b18bfSMatthew G. Knepley   PetscFunctionBegin;
20789566063dSJacob Faibussowitsch   PetscCall(PetscCitationsRegister(ClementCitation, &Clementcite));
20799566063dSJacob Faibussowitsch   PetscCall(VecGetDM(locC, &dmc));
20809566063dSJacob Faibussowitsch   PetscCall(VecSet(locC, 0.0));
20819566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
20829566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateDim(dm, &cdim));
20835f0b18bfSMatthew G. Knepley   fegeom.dimEmbed = cdim;
20849566063dSJacob Faibussowitsch   PetscCall(DMGetNumFields(dm, &Nf));
20855f0b18bfSMatthew G. Knepley   PetscCheck(Nf > 0, PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of fields is zero!");
20865f0b18bfSMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
20875f0b18bfSMatthew G. Knepley     PetscObject  obj;
20885f0b18bfSMatthew G. Knepley     PetscClassId id;
20895f0b18bfSMatthew G. Knepley     PetscInt     fNc;
20905f0b18bfSMatthew G. Knepley 
20919566063dSJacob Faibussowitsch     PetscCall(DMGetField(dm, f, NULL, &obj));
20929566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
20935f0b18bfSMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
20945f0b18bfSMatthew G. Knepley       PetscFE fe = (PetscFE)obj;
20955f0b18bfSMatthew G. Knepley 
20969566063dSJacob Faibussowitsch       PetscCall(PetscFEGetQuadrature(fe, &quad));
20979566063dSJacob Faibussowitsch       PetscCall(PetscFEGetNumComponents(fe, &fNc));
20985f0b18bfSMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
20995f0b18bfSMatthew G. Knepley       PetscFV fv = (PetscFV)obj;
21005f0b18bfSMatthew G. Knepley 
21019566063dSJacob Faibussowitsch       PetscCall(PetscFVGetQuadrature(fv, &quad));
21029566063dSJacob Faibussowitsch       PetscCall(PetscFVGetNumComponents(fv, &fNc));
210363a3b9bcSJacob Faibussowitsch     } else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, f);
21045f0b18bfSMatthew G. Knepley     Nc += fNc;
21055f0b18bfSMatthew G. Knepley   }
21069566063dSJacob Faibussowitsch   PetscCall(PetscQuadratureGetData(quad, NULL, &qNc, &Nq, &quadPoints, &quadWeights));
210763a3b9bcSJacob Faibussowitsch   PetscCheck(qNc == 1, PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_SIZ, "Quadrature components %" PetscInt_FMT " > 1", qNc);
21089566063dSJacob Faibussowitsch   PetscCall(PetscMalloc6(Nc * 2, &valsum, Nc, &interpolant, cdim * Nq, &coords, Nq, &fegeom.detJ, cdim * cdim * Nq, &fegeom.J, cdim * cdim * Nq, &fegeom.invJ));
21099566063dSJacob Faibussowitsch   PetscCall(DMPlexGetDepthStratum(dm, 0, &vStart, &vEnd));
21109566063dSJacob Faibussowitsch   PetscCall(DMPlexGetSimplexOrBoxCells(dm, 0, &cStart, &cEnd));
21115f0b18bfSMatthew G. Knepley   for (v = vStart; v < vEnd; ++v) {
21125f0b18bfSMatthew G. Knepley     PetscScalar volsum = 0.0;
21135f0b18bfSMatthew G. Knepley     PetscInt   *star   = NULL;
21145f0b18bfSMatthew G. Knepley     PetscInt    starSize, st, fc;
21155f0b18bfSMatthew G. Knepley 
21169566063dSJacob Faibussowitsch     PetscCall(PetscArrayzero(valsum, Nc));
21179566063dSJacob Faibussowitsch     PetscCall(DMPlexGetTransitiveClosure(dm, v, PETSC_FALSE, &starSize, &star));
21185f0b18bfSMatthew G. Knepley     for (st = 0; st < starSize * 2; st += 2) {
21195f0b18bfSMatthew G. Knepley       const PetscInt cell = star[st];
21205f0b18bfSMatthew G. Knepley       PetscScalar   *val  = &valsum[Nc];
21215f0b18bfSMatthew G. Knepley       PetscScalar   *x    = NULL;
21225f0b18bfSMatthew G. Knepley       PetscReal      vol  = 0.0;
21235f0b18bfSMatthew G. Knepley       PetscInt       foff = 0;
21245f0b18bfSMatthew G. Knepley 
21255f0b18bfSMatthew G. Knepley       if ((cell < cStart) || (cell >= cEnd)) continue;
21269566063dSJacob Faibussowitsch       PetscCall(DMPlexComputeCellGeometryFEM(dm, cell, quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
21279566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(dm, NULL, locX, cell, NULL, &x));
21285f0b18bfSMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
21295f0b18bfSMatthew G. Knepley         PetscObject  obj;
21305f0b18bfSMatthew G. Knepley         PetscClassId id;
21315f0b18bfSMatthew G. Knepley         PetscInt     Nb, fNc, q;
21325f0b18bfSMatthew G. Knepley 
21339566063dSJacob Faibussowitsch         PetscCall(PetscArrayzero(val, Nc));
21349566063dSJacob Faibussowitsch         PetscCall(DMGetField(dm, f, NULL, &obj));
21359566063dSJacob Faibussowitsch         PetscCall(PetscObjectGetClassId(obj, &id));
21369371c9d4SSatish Balay         if (id == PETSCFE_CLASSID) {
21379371c9d4SSatish Balay           PetscCall(PetscFEGetNumComponents((PetscFE)obj, &fNc));
21389371c9d4SSatish Balay           PetscCall(PetscFEGetDimension((PetscFE)obj, &Nb));
21399371c9d4SSatish Balay         } else if (id == PETSCFV_CLASSID) {
21409371c9d4SSatish Balay           PetscCall(PetscFVGetNumComponents((PetscFV)obj, &fNc));
21419371c9d4SSatish Balay           Nb = 1;
21429371c9d4SSatish Balay         } else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, f);
21435f0b18bfSMatthew G. Knepley         for (q = 0; q < Nq; ++q) {
21445f0b18bfSMatthew G. Knepley           const PetscReal wt = quadWeights[q] * fegeom.detJ[q];
21455f0b18bfSMatthew G. Knepley           PetscFEGeom     qgeom;
21465f0b18bfSMatthew G. Knepley 
21475f0b18bfSMatthew G. Knepley           qgeom.dimEmbed = fegeom.dimEmbed;
21485f0b18bfSMatthew G. Knepley           qgeom.J        = &fegeom.J[q * cdim * cdim];
21495f0b18bfSMatthew G. Knepley           qgeom.invJ     = &fegeom.invJ[q * cdim * cdim];
21505f0b18bfSMatthew G. Knepley           qgeom.detJ     = &fegeom.detJ[q];
215163a3b9bcSJacob Faibussowitsch           PetscCheck(fegeom.detJ[q] > 0.0, PETSC_COMM_SELF, PETSC_ERR_ARG_OUTOFRANGE, "Invalid determinant %g for element %" PetscInt_FMT ", quadrature points %" PetscInt_FMT, (double)fegeom.detJ[q], cell, q);
21529566063dSJacob Faibussowitsch           if (id == PETSCFE_CLASSID) PetscCall(PetscFEInterpolate_Static((PetscFE)obj, &x[foff], &qgeom, q, interpolant));
215363a3b9bcSJacob Faibussowitsch           else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, f);
21545f0b18bfSMatthew G. Knepley           for (fc = 0; fc < fNc; ++fc) val[foff + fc] += interpolant[fc] * wt;
21555f0b18bfSMatthew G. Knepley           vol += wt;
21565f0b18bfSMatthew G. Knepley         }
21575f0b18bfSMatthew G. Knepley         foff += Nb;
21585f0b18bfSMatthew G. Knepley       }
21599566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(dm, NULL, locX, cell, NULL, &x));
21605f0b18bfSMatthew G. Knepley       for (fc = 0; fc < Nc; ++fc) valsum[fc] += val[fc];
21615f0b18bfSMatthew G. Knepley       volsum += vol;
21625f0b18bfSMatthew G. Knepley       if (debug) {
21639566063dSJacob Faibussowitsch         PetscCall(PetscPrintf(PETSC_COMM_SELF, "Vertex %" PetscInt_FMT " Cell %" PetscInt_FMT " value: [", v, cell));
21645f0b18bfSMatthew G. Knepley         for (fc = 0; fc < Nc; ++fc) {
21659566063dSJacob Faibussowitsch           if (fc) PetscCall(PetscPrintf(PETSC_COMM_SELF, ", "));
21669566063dSJacob Faibussowitsch           PetscCall(PetscPrintf(PETSC_COMM_SELF, "%g", (double)PetscRealPart(val[fc])));
21675f0b18bfSMatthew G. Knepley         }
21689566063dSJacob Faibussowitsch         PetscCall(PetscPrintf(PETSC_COMM_SELF, "]\n"));
21695f0b18bfSMatthew G. Knepley       }
21705f0b18bfSMatthew G. Knepley     }
21715f0b18bfSMatthew G. Knepley     for (fc = 0; fc < Nc; ++fc) valsum[fc] /= volsum;
21729566063dSJacob Faibussowitsch     PetscCall(DMPlexRestoreTransitiveClosure(dm, v, PETSC_FALSE, &starSize, &star));
21739566063dSJacob Faibussowitsch     PetscCall(DMPlexVecSetClosure(dmc, NULL, locC, v, valsum, INSERT_VALUES));
21745f0b18bfSMatthew G. Knepley   }
21759566063dSJacob Faibussowitsch   PetscCall(PetscFree6(valsum, interpolant, coords, fegeom.detJ, fegeom.J, fegeom.invJ));
21763ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
21775f0b18bfSMatthew G. Knepley }
21785f0b18bfSMatthew G. Knepley 
21795f0b18bfSMatthew G. Knepley /*@
218020f4b53cSBarry Smith   DMPlexComputeGradientClementInterpolant - This function computes the L2 projection of the cellwise gradient of a function u onto P1
21811555c271SMatthew G. Knepley 
218220f4b53cSBarry Smith   Collective
2183c0f8e1fdSMatthew G. Knepley 
21841555c271SMatthew G. Knepley   Input Parameters:
2185a1cb98faSBarry Smith + dm   - The `DM`
21865f0b18bfSMatthew G. Knepley - locX - The coefficient vector u_h
21871555c271SMatthew G. Knepley 
21881555c271SMatthew G. Knepley   Output Parameter:
2189a1cb98faSBarry Smith . locC - A `Vec` which holds the Clement interpolant of the gradient
21901555c271SMatthew G. Knepley 
21911555c271SMatthew G. Knepley   Level: developer
21921555c271SMatthew G. Knepley 
2193a1cb98faSBarry Smith   Note:
2194a1cb98faSBarry Smith   $\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
2195a1cb98faSBarry Smith 
21961cc06b55SBarry Smith .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `DMProjectFunction()`, `DMComputeL2Diff()`, `DMPlexComputeL2FieldDiff()`, `DMComputeL2GradientDiff()`
21971555c271SMatthew G. Knepley @*/
2198d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexComputeGradientClementInterpolant(DM dm, Vec locX, Vec locC)
2199d71ae5a4SJacob Faibussowitsch {
2200db1066baSMatthew G. Knepley   DM_Plex         *mesh  = (DM_Plex *)dm->data;
2201db1066baSMatthew G. Knepley   PetscInt         debug = mesh->printFEM;
22021555c271SMatthew G. Knepley   DM               dmC;
22031555c271SMatthew G. Knepley   PetscQuadrature  quad;
22041555c271SMatthew G. Knepley   PetscScalar     *interpolant, *gradsum;
22054bee2e38SMatthew G. Knepley   PetscFEGeom      fegeom;
22064bee2e38SMatthew G. Knepley   PetscReal       *coords;
22071555c271SMatthew G. Knepley   const PetscReal *quadPoints, *quadWeights;
2208485ad865SMatthew G. Knepley   PetscInt         dim, coordDim, numFields, numComponents = 0, qNc, Nq, cStart, cEnd, vStart, vEnd, v, field, fieldOffset;
22091555c271SMatthew G. Knepley 
22101555c271SMatthew G. Knepley   PetscFunctionBegin;
22119566063dSJacob Faibussowitsch   PetscCall(PetscCitationsRegister(ClementCitation, &Clementcite));
22129566063dSJacob Faibussowitsch   PetscCall(VecGetDM(locC, &dmC));
22139566063dSJacob Faibussowitsch   PetscCall(VecSet(locC, 0.0));
22149566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
22159566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateDim(dm, &coordDim));
22164bee2e38SMatthew G. Knepley   fegeom.dimEmbed = coordDim;
22179566063dSJacob Faibussowitsch   PetscCall(DMGetNumFields(dm, &numFields));
22185f80ce2aSJacob Faibussowitsch   PetscCheck(numFields, PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of fields is zero!");
22191555c271SMatthew G. Knepley   for (field = 0; field < numFields; ++field) {
22201555c271SMatthew G. Knepley     PetscObject  obj;
22211555c271SMatthew G. Knepley     PetscClassId id;
22221555c271SMatthew G. Knepley     PetscInt     Nc;
22231555c271SMatthew G. Knepley 
22249566063dSJacob Faibussowitsch     PetscCall(DMGetField(dm, field, NULL, &obj));
22259566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
22261555c271SMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
22271555c271SMatthew G. Knepley       PetscFE fe = (PetscFE)obj;
22281555c271SMatthew G. Knepley 
22299566063dSJacob Faibussowitsch       PetscCall(PetscFEGetQuadrature(fe, &quad));
22309566063dSJacob Faibussowitsch       PetscCall(PetscFEGetNumComponents(fe, &Nc));
22311555c271SMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
22321555c271SMatthew G. Knepley       PetscFV fv = (PetscFV)obj;
22331555c271SMatthew G. Knepley 
22349566063dSJacob Faibussowitsch       PetscCall(PetscFVGetQuadrature(fv, &quad));
22359566063dSJacob Faibussowitsch       PetscCall(PetscFVGetNumComponents(fv, &Nc));
223663a3b9bcSJacob Faibussowitsch     } else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, field);
22371555c271SMatthew G. Knepley     numComponents += Nc;
22381555c271SMatthew G. Knepley   }
22399566063dSJacob Faibussowitsch   PetscCall(PetscQuadratureGetData(quad, NULL, &qNc, &Nq, &quadPoints, &quadWeights));
224063a3b9bcSJacob Faibussowitsch   PetscCheck(!(qNc != 1) || !(qNc != numComponents), PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_SIZ, "Quadrature components %" PetscInt_FMT " != %" PetscInt_FMT " field components", qNc, numComponents);
22419566063dSJacob 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));
22429566063dSJacob Faibussowitsch   PetscCall(DMPlexGetDepthStratum(dm, 0, &vStart, &vEnd));
22439566063dSJacob Faibussowitsch   PetscCall(DMPlexGetSimplexOrBoxCells(dm, 0, &cStart, &cEnd));
22441555c271SMatthew G. Knepley   for (v = vStart; v < vEnd; ++v) {
22451555c271SMatthew G. Knepley     PetscScalar volsum = 0.0;
22461555c271SMatthew G. Knepley     PetscInt   *star   = NULL;
22471555c271SMatthew G. Knepley     PetscInt    starSize, st, d, fc;
22481555c271SMatthew G. Knepley 
22499566063dSJacob Faibussowitsch     PetscCall(PetscArrayzero(gradsum, coordDim * numComponents));
22509566063dSJacob Faibussowitsch     PetscCall(DMPlexGetTransitiveClosure(dm, v, PETSC_FALSE, &starSize, &star));
22511555c271SMatthew G. Knepley     for (st = 0; st < starSize * 2; st += 2) {
22521555c271SMatthew G. Knepley       const PetscInt cell = star[st];
22531555c271SMatthew G. Knepley       PetscScalar   *grad = &gradsum[coordDim * numComponents];
22541555c271SMatthew G. Knepley       PetscScalar   *x    = NULL;
22551555c271SMatthew G. Knepley       PetscReal      vol  = 0.0;
22561555c271SMatthew G. Knepley 
22571555c271SMatthew G. Knepley       if ((cell < cStart) || (cell >= cEnd)) continue;
22589566063dSJacob Faibussowitsch       PetscCall(DMPlexComputeCellGeometryFEM(dm, cell, quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
22599566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(dm, NULL, locX, cell, NULL, &x));
22601555c271SMatthew G. Knepley       for (field = 0, fieldOffset = 0; field < numFields; ++field) {
22611555c271SMatthew G. Knepley         PetscObject  obj;
22621555c271SMatthew G. Knepley         PetscClassId id;
22631555c271SMatthew G. Knepley         PetscInt     Nb, Nc, q, qc = 0;
22641555c271SMatthew G. Knepley 
22659566063dSJacob Faibussowitsch         PetscCall(PetscArrayzero(grad, coordDim * numComponents));
22669566063dSJacob Faibussowitsch         PetscCall(DMGetField(dm, field, NULL, &obj));
22679566063dSJacob Faibussowitsch         PetscCall(PetscObjectGetClassId(obj, &id));
22689371c9d4SSatish Balay         if (id == PETSCFE_CLASSID) {
22699371c9d4SSatish Balay           PetscCall(PetscFEGetNumComponents((PetscFE)obj, &Nc));
22709371c9d4SSatish Balay           PetscCall(PetscFEGetDimension((PetscFE)obj, &Nb));
22719371c9d4SSatish Balay         } else if (id == PETSCFV_CLASSID) {
22729371c9d4SSatish Balay           PetscCall(PetscFVGetNumComponents((PetscFV)obj, &Nc));
22739371c9d4SSatish Balay           Nb = 1;
22749371c9d4SSatish Balay         } else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, field);
22751555c271SMatthew G. Knepley         for (q = 0; q < Nq; ++q) {
22762a4e142eSMatthew G. Knepley           PetscFEGeom qgeom;
22772a4e142eSMatthew G. Knepley 
22782a4e142eSMatthew G. Knepley           qgeom.dimEmbed = fegeom.dimEmbed;
22792a4e142eSMatthew G. Knepley           qgeom.J        = &fegeom.J[q * coordDim * coordDim];
22802a4e142eSMatthew G. Knepley           qgeom.invJ     = &fegeom.invJ[q * coordDim * coordDim];
22812a4e142eSMatthew G. Knepley           qgeom.detJ     = &fegeom.detJ[q];
228263a3b9bcSJacob Faibussowitsch           PetscCheck(fegeom.detJ[q] > 0.0, PETSC_COMM_SELF, PETSC_ERR_ARG_OUTOFRANGE, "Invalid determinant %g for element %" PetscInt_FMT ", quadrature points %" PetscInt_FMT, (double)fegeom.detJ[q], cell, q);
22839566063dSJacob Faibussowitsch           if (id == PETSCFE_CLASSID) PetscCall(PetscFEInterpolateGradient_Static((PetscFE)obj, 1, &x[fieldOffset], &qgeom, q, interpolant));
228463a3b9bcSJacob Faibussowitsch           else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, field);
22851555c271SMatthew G. Knepley           for (fc = 0; fc < Nc; ++fc) {
228653d2db2dSJoe Wallwork             const PetscReal wt = quadWeights[q * qNc + qc];
22871555c271SMatthew G. Knepley 
22884bee2e38SMatthew G. Knepley             for (d = 0; d < coordDim; ++d) grad[fc * coordDim + d] += interpolant[fc * dim + d] * wt * fegeom.detJ[q];
22891555c271SMatthew G. Knepley           }
22904bee2e38SMatthew G. Knepley           vol += quadWeights[q * qNc] * fegeom.detJ[q];
22911555c271SMatthew G. Knepley         }
22921555c271SMatthew G. Knepley         fieldOffset += Nb;
22931555c271SMatthew G. Knepley         qc += Nc;
22941555c271SMatthew G. Knepley       }
22959566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(dm, NULL, locX, cell, NULL, &x));
2296f8527842SMatthew G. Knepley       for (fc = 0; fc < numComponents; ++fc) {
2297ad540459SPierre Jolivet         for (d = 0; d < coordDim; ++d) gradsum[fc * coordDim + d] += grad[fc * coordDim + d];
2298f8527842SMatthew G. Knepley       }
2299f8527842SMatthew G. Knepley       volsum += vol;
2300db1066baSMatthew G. Knepley       if (debug) {
23019566063dSJacob Faibussowitsch         PetscCall(PetscPrintf(PETSC_COMM_SELF, "Vertex %" PetscInt_FMT " Cell %" PetscInt_FMT " gradient: [", v, cell));
23021555c271SMatthew G. Knepley         for (fc = 0; fc < numComponents; ++fc) {
23031555c271SMatthew G. Knepley           for (d = 0; d < coordDim; ++d) {
23049566063dSJacob Faibussowitsch             if (fc || d > 0) PetscCall(PetscPrintf(PETSC_COMM_SELF, ", "));
23059566063dSJacob Faibussowitsch             PetscCall(PetscPrintf(PETSC_COMM_SELF, "%g", (double)PetscRealPart(grad[fc * coordDim + d])));
23061555c271SMatthew G. Knepley           }
23071555c271SMatthew G. Knepley         }
23089566063dSJacob Faibussowitsch         PetscCall(PetscPrintf(PETSC_COMM_SELF, "]\n"));
2309db1066baSMatthew G. Knepley       }
23101555c271SMatthew G. Knepley     }
23111555c271SMatthew G. Knepley     for (fc = 0; fc < numComponents; ++fc) {
23121555c271SMatthew G. Knepley       for (d = 0; d < coordDim; ++d) gradsum[fc * coordDim + d] /= volsum;
23131555c271SMatthew G. Knepley     }
23149566063dSJacob Faibussowitsch     PetscCall(DMPlexRestoreTransitiveClosure(dm, v, PETSC_FALSE, &starSize, &star));
23159566063dSJacob Faibussowitsch     PetscCall(DMPlexVecSetClosure(dmC, NULL, locC, v, gradsum, INSERT_VALUES));
23161555c271SMatthew G. Knepley   }
23179566063dSJacob Faibussowitsch   PetscCall(PetscFree6(gradsum, interpolant, coords, fegeom.detJ, fegeom.J, fegeom.invJ));
23183ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
23191555c271SMatthew G. Knepley }
23201555c271SMatthew G. Knepley 
23216493148fSStefano Zampini PetscErrorCode DMPlexComputeIntegral_Internal(DM dm, Vec locX, PetscInt cStart, PetscInt cEnd, PetscScalar *cintegral, void *user)
2322d71ae5a4SJacob Faibussowitsch {
2323cbf8eb3cSStefano Zampini   DM           dmAux = NULL, plexA = NULL;
232461aaff12SToby Isaac   PetscDS      prob, probAux       = NULL;
232573d901b8SMatthew G. Knepley   PetscSection section, sectionAux;
23266493148fSStefano Zampini   Vec          locA;
2327c330f8ffSToby Isaac   PetscInt     dim, numCells = cEnd - cStart, c, f;
2328c330f8ffSToby Isaac   PetscBool    useFVM = PETSC_FALSE;
2329338f77d5SMatthew G. Knepley   /* DS */
2330338f77d5SMatthew G. Knepley   PetscInt           Nf, totDim, *uOff, *uOff_x, numConstants;
2331338f77d5SMatthew G. Knepley   PetscInt           NfAux, totDimAux, *aOff;
23328e3a54c0SPierre Jolivet   PetscScalar       *u, *a = NULL;
2333338f77d5SMatthew G. Knepley   const PetscScalar *constants;
2334338f77d5SMatthew G. Knepley   /* Geometry */
2335c330f8ffSToby Isaac   PetscFEGeom       *cgeomFEM;
2336338f77d5SMatthew G. Knepley   DM                 dmGrad;
2337c330f8ffSToby Isaac   PetscQuadrature    affineQuad      = NULL;
2338338f77d5SMatthew G. Knepley   Vec                cellGeometryFVM = NULL, faceGeometryFVM = NULL, locGrad = NULL;
2339b5a3613cSMatthew G. Knepley   PetscFVCellGeom   *cgeomFVM;
2340338f77d5SMatthew G. Knepley   const PetscScalar *lgrad;
2341b7260050SToby Isaac   PetscInt           maxDegree;
2342c330f8ffSToby Isaac   DMField            coordField;
2343c330f8ffSToby Isaac   IS                 cellIS;
234473d901b8SMatthew G. Knepley 
234573d901b8SMatthew G. Knepley   PetscFunctionBegin;
23469566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dm, &prob));
23479566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
23489566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
23499566063dSJacob Faibussowitsch   PetscCall(DMGetNumFields(dm, &Nf));
2350338f77d5SMatthew G. Knepley   /* Determine which discretizations we have */
2351b5a3613cSMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
2352b5a3613cSMatthew G. Knepley     PetscObject  obj;
2353b5a3613cSMatthew G. Knepley     PetscClassId id;
2354b5a3613cSMatthew G. Knepley 
23559566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, f, &obj));
23569566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
2357338f77d5SMatthew G. Knepley     if (id == PETSCFV_CLASSID) useFVM = PETSC_TRUE;
2358338f77d5SMatthew G. Knepley   }
2359338f77d5SMatthew G. Knepley   /* Read DS information */
23609566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(prob, &totDim));
23619566063dSJacob Faibussowitsch   PetscCall(PetscDSGetComponentOffsets(prob, &uOff));
23629566063dSJacob Faibussowitsch   PetscCall(PetscDSGetComponentDerivativeOffsets(prob, &uOff_x));
23639566063dSJacob Faibussowitsch   PetscCall(ISCreateStride(PETSC_COMM_SELF, numCells, cStart, 1, &cellIS));
23649566063dSJacob Faibussowitsch   PetscCall(PetscDSGetConstants(prob, &numConstants, &constants));
2365338f77d5SMatthew G. Knepley   /* Read Auxiliary DS information */
23669566063dSJacob Faibussowitsch   PetscCall(DMGetAuxiliaryVec(dm, NULL, 0, 0, &locA));
23679a2a23afSMatthew G. Knepley   if (locA) {
23689566063dSJacob Faibussowitsch     PetscCall(VecGetDM(locA, &dmAux));
2369cbf8eb3cSStefano Zampini     PetscCall(DMConvert(dmAux, DMPLEX, &plexA));
23709566063dSJacob Faibussowitsch     PetscCall(DMGetDS(dmAux, &probAux));
23719566063dSJacob Faibussowitsch     PetscCall(PetscDSGetNumFields(probAux, &NfAux));
23729566063dSJacob Faibussowitsch     PetscCall(DMGetLocalSection(dmAux, &sectionAux));
23739566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalDimension(probAux, &totDimAux));
23749566063dSJacob Faibussowitsch     PetscCall(PetscDSGetComponentOffsets(probAux, &aOff));
2375338f77d5SMatthew G. Knepley   }
2376338f77d5SMatthew G. Knepley   /* Allocate data  arrays */
23779566063dSJacob Faibussowitsch   PetscCall(PetscCalloc1(numCells * totDim, &u));
23789566063dSJacob Faibussowitsch   if (dmAux) PetscCall(PetscMalloc1(numCells * totDimAux, &a));
2379338f77d5SMatthew G. Knepley   /* Read out geometry */
23809566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateField(dm, &coordField));
23819566063dSJacob Faibussowitsch   PetscCall(DMFieldGetDegree(coordField, cellIS, NULL, &maxDegree));
2382b7260050SToby Isaac   if (maxDegree <= 1) {
23839566063dSJacob Faibussowitsch     PetscCall(DMFieldCreateDefaultQuadrature(coordField, cellIS, &affineQuad));
238448a46eb9SPierre Jolivet     if (affineQuad) PetscCall(DMFieldCreateFEGeom(coordField, cellIS, affineQuad, PETSC_FALSE, &cgeomFEM));
2385b5a3613cSMatthew G. Knepley   }
2386b5a3613cSMatthew G. Knepley   if (useFVM) {
2387338f77d5SMatthew G. Knepley     PetscFV   fv = NULL;
2388b5a3613cSMatthew G. Knepley     Vec       grad;
2389b5a3613cSMatthew G. Knepley     PetscInt  fStart, fEnd;
2390b5a3613cSMatthew G. Knepley     PetscBool compGrad;
2391b5a3613cSMatthew G. Knepley 
2392338f77d5SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
2393338f77d5SMatthew G. Knepley       PetscObject  obj;
2394338f77d5SMatthew G. Knepley       PetscClassId id;
2395338f77d5SMatthew G. Knepley 
23969566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(prob, f, &obj));
23979566063dSJacob Faibussowitsch       PetscCall(PetscObjectGetClassId(obj, &id));
23989371c9d4SSatish Balay       if (id == PETSCFV_CLASSID) {
23999371c9d4SSatish Balay         fv = (PetscFV)obj;
24009371c9d4SSatish Balay         break;
24019371c9d4SSatish Balay       }
2402338f77d5SMatthew G. Knepley     }
24039566063dSJacob Faibussowitsch     PetscCall(PetscFVGetComputeGradients(fv, &compGrad));
24049566063dSJacob Faibussowitsch     PetscCall(PetscFVSetComputeGradients(fv, PETSC_TRUE));
24059566063dSJacob Faibussowitsch     PetscCall(DMPlexComputeGeometryFVM(dm, &cellGeometryFVM, &faceGeometryFVM));
24069566063dSJacob Faibussowitsch     PetscCall(DMPlexComputeGradientFVM(dm, fv, faceGeometryFVM, cellGeometryFVM, &dmGrad));
24079566063dSJacob Faibussowitsch     PetscCall(PetscFVSetComputeGradients(fv, compGrad));
24089566063dSJacob Faibussowitsch     PetscCall(VecGetArrayRead(cellGeometryFVM, (const PetscScalar **)&cgeomFVM));
2409b5a3613cSMatthew G. Knepley     /* Reconstruct and limit cell gradients */
24109566063dSJacob Faibussowitsch     PetscCall(DMPlexGetHeightStratum(dm, 1, &fStart, &fEnd));
24119566063dSJacob Faibussowitsch     PetscCall(DMGetGlobalVector(dmGrad, &grad));
24129566063dSJacob Faibussowitsch     PetscCall(DMPlexReconstructGradients_Internal(dm, fv, fStart, fEnd, faceGeometryFVM, cellGeometryFVM, locX, grad));
2413b5a3613cSMatthew G. Knepley     /* Communicate gradient values */
24149566063dSJacob Faibussowitsch     PetscCall(DMGetLocalVector(dmGrad, &locGrad));
24159566063dSJacob Faibussowitsch     PetscCall(DMGlobalToLocalBegin(dmGrad, grad, INSERT_VALUES, locGrad));
24169566063dSJacob Faibussowitsch     PetscCall(DMGlobalToLocalEnd(dmGrad, grad, INSERT_VALUES, locGrad));
24179566063dSJacob Faibussowitsch     PetscCall(DMRestoreGlobalVector(dmGrad, &grad));
2418b5a3613cSMatthew G. Knepley     /* Handle non-essential (e.g. outflow) boundary values */
24199566063dSJacob Faibussowitsch     PetscCall(DMPlexInsertBoundaryValues(dm, PETSC_FALSE, locX, 0.0, faceGeometryFVM, cellGeometryFVM, locGrad));
24209566063dSJacob Faibussowitsch     PetscCall(VecGetArrayRead(locGrad, &lgrad));
2421b5a3613cSMatthew G. Knepley   }
2422338f77d5SMatthew G. Knepley   /* Read out data from inputs */
242373d901b8SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
242473d901b8SMatthew G. Knepley     PetscScalar *x = NULL;
242573d901b8SMatthew G. Knepley     PetscInt     i;
242673d901b8SMatthew G. Knepley 
24279566063dSJacob Faibussowitsch     PetscCall(DMPlexVecGetClosure(dm, section, locX, c, NULL, &x));
24280f2d7e86SMatthew G. Knepley     for (i = 0; i < totDim; ++i) u[c * totDim + i] = x[i];
24299566063dSJacob Faibussowitsch     PetscCall(DMPlexVecRestoreClosure(dm, section, locX, c, NULL, &x));
243073d901b8SMatthew G. Knepley     if (dmAux) {
2431cbf8eb3cSStefano Zampini       PetscCall(DMPlexVecGetClosure(plexA, sectionAux, locA, c, NULL, &x));
24320f2d7e86SMatthew G. Knepley       for (i = 0; i < totDimAux; ++i) a[c * totDimAux + i] = x[i];
2433cbf8eb3cSStefano Zampini       PetscCall(DMPlexVecRestoreClosure(plexA, sectionAux, locA, c, NULL, &x));
243473d901b8SMatthew G. Knepley     }
243573d901b8SMatthew G. Knepley   }
2436338f77d5SMatthew G. Knepley   /* Do integration for each field */
243773d901b8SMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
2438c1f031eeSMatthew G. Knepley     PetscObject  obj;
2439c1f031eeSMatthew G. Knepley     PetscClassId id;
2440c1f031eeSMatthew G. Knepley     PetscInt     numChunks, numBatches, batchSize, numBlocks, blockSize, Ne, Nr, offset;
244173d901b8SMatthew G. Knepley 
24429566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, f, &obj));
24439566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
2444c1f031eeSMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
2445c1f031eeSMatthew G. Knepley       PetscFE         fe = (PetscFE)obj;
2446c1f031eeSMatthew G. Knepley       PetscQuadrature q;
2447c330f8ffSToby Isaac       PetscFEGeom    *chunkGeom = NULL;
2448c1f031eeSMatthew G. Knepley       PetscInt        Nq, Nb;
2449c1f031eeSMatthew G. Knepley 
24509566063dSJacob Faibussowitsch       PetscCall(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
24519566063dSJacob Faibussowitsch       PetscCall(PetscFEGetQuadrature(fe, &q));
24529566063dSJacob Faibussowitsch       PetscCall(PetscQuadratureGetData(q, NULL, NULL, &Nq, NULL, NULL));
24539566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDimension(fe, &Nb));
2454c1f031eeSMatthew G. Knepley       blockSize = Nb * Nq;
245573d901b8SMatthew G. Knepley       batchSize = numBlocks * blockSize;
24569566063dSJacob Faibussowitsch       PetscCall(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
245773d901b8SMatthew G. Knepley       numChunks = numCells / (numBatches * batchSize);
245873d901b8SMatthew G. Knepley       Ne        = numChunks * numBatches * batchSize;
245973d901b8SMatthew G. Knepley       Nr        = numCells % (numBatches * batchSize);
246073d901b8SMatthew G. Knepley       offset    = numCells - Nr;
246148a46eb9SPierre Jolivet       if (!affineQuad) PetscCall(DMFieldCreateFEGeom(coordField, cellIS, q, PETSC_FALSE, &cgeomFEM));
24629566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomGetChunk(cgeomFEM, 0, offset, &chunkGeom));
24639566063dSJacob Faibussowitsch       PetscCall(PetscFEIntegrate(prob, f, Ne, chunkGeom, u, probAux, a, cintegral));
24649566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomGetChunk(cgeomFEM, offset, numCells, &chunkGeom));
24658e3a54c0SPierre Jolivet       PetscCall(PetscFEIntegrate(prob, f, Nr, chunkGeom, &u[offset * totDim], probAux, PetscSafePointerPlusOffset(a, offset * totDimAux), &cintegral[offset * Nf]));
24669566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomRestoreChunk(cgeomFEM, offset, numCells, &chunkGeom));
246748a46eb9SPierre Jolivet       if (!affineQuad) PetscCall(PetscFEGeomDestroy(&cgeomFEM));
2468c1f031eeSMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
2469c1f031eeSMatthew G. Knepley       PetscInt       foff;
2470420e96edSMatthew G. Knepley       PetscPointFunc obj_func;
2471c1f031eeSMatthew G. Knepley 
24729566063dSJacob Faibussowitsch       PetscCall(PetscDSGetObjective(prob, f, &obj_func));
24739566063dSJacob Faibussowitsch       PetscCall(PetscDSGetFieldOffset(prob, f, &foff));
2474c1f031eeSMatthew G. Knepley       if (obj_func) {
2475c1f031eeSMatthew G. Knepley         for (c = 0; c < numCells; ++c) {
2476b5a3613cSMatthew G. Knepley           PetscScalar *u_x;
2477d627b919SMatthew G. Knepley           PetscScalar  lint = 0.;
2478b5a3613cSMatthew G. Knepley 
24799566063dSJacob Faibussowitsch           PetscCall(DMPlexPointLocalRead(dmGrad, c, lgrad, &u_x));
248055bffe1bSPierre Jolivet           obj_func(dim, Nf, NfAux, uOff, uOff_x, &u[totDim * c + foff], NULL, u_x, aOff, NULL, PetscSafePointerPlusOffset(a, totDimAux * c), NULL, NULL, 0.0, cgeomFVM[c].centroid, numConstants, constants, &lint);
2481338f77d5SMatthew G. Knepley           cintegral[c * Nf + f] += PetscRealPart(lint) * cgeomFVM[c].volume;
248273d901b8SMatthew G. Knepley         }
2483c1f031eeSMatthew G. Knepley       }
248463a3b9bcSJacob Faibussowitsch     } else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, f);
2485c1f031eeSMatthew G. Knepley   }
2486338f77d5SMatthew G. Knepley   /* Cleanup data arrays */
2487b5a3613cSMatthew G. Knepley   if (useFVM) {
24889566063dSJacob Faibussowitsch     PetscCall(VecRestoreArrayRead(locGrad, &lgrad));
24899566063dSJacob Faibussowitsch     PetscCall(VecRestoreArrayRead(cellGeometryFVM, (const PetscScalar **)&cgeomFVM));
24909566063dSJacob Faibussowitsch     PetscCall(DMRestoreLocalVector(dmGrad, &locGrad));
24919566063dSJacob Faibussowitsch     PetscCall(VecDestroy(&faceGeometryFVM));
24929566063dSJacob Faibussowitsch     PetscCall(VecDestroy(&cellGeometryFVM));
24939566063dSJacob Faibussowitsch     PetscCall(DMDestroy(&dmGrad));
2494b5a3613cSMatthew G. Knepley   }
24959566063dSJacob Faibussowitsch   if (dmAux) PetscCall(PetscFree(a));
2496cbf8eb3cSStefano Zampini   PetscCall(DMDestroy(&plexA));
24979566063dSJacob Faibussowitsch   PetscCall(PetscFree(u));
2498338f77d5SMatthew G. Knepley   /* Cleanup */
249948a46eb9SPierre Jolivet   if (affineQuad) PetscCall(PetscFEGeomDestroy(&cgeomFEM));
25009566063dSJacob Faibussowitsch   PetscCall(PetscQuadratureDestroy(&affineQuad));
25019566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&cellIS));
25023ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
2503338f77d5SMatthew G. Knepley }
2504338f77d5SMatthew G. Knepley 
2505338f77d5SMatthew G. Knepley /*@
2506338f77d5SMatthew G. Knepley   DMPlexComputeIntegralFEM - Form the integral over the domain from the global input X using pointwise functions specified by the user
2507338f77d5SMatthew G. Knepley 
2508338f77d5SMatthew G. Knepley   Input Parameters:
2509338f77d5SMatthew G. Knepley + dm   - The mesh
2510338f77d5SMatthew G. Knepley . X    - Global input vector
2511338f77d5SMatthew G. Knepley - user - The user context
2512338f77d5SMatthew G. Knepley 
2513338f77d5SMatthew G. Knepley   Output Parameter:
2514338f77d5SMatthew G. Knepley . integral - Integral for each field
2515338f77d5SMatthew G. Knepley 
2516338f77d5SMatthew G. Knepley   Level: developer
2517338f77d5SMatthew G. Knepley 
25181cc06b55SBarry Smith .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `DMPlexSNESComputeResidualFEM()`
2519338f77d5SMatthew G. Knepley @*/
2520d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexComputeIntegralFEM(DM dm, Vec X, PetscScalar *integral, void *user)
2521d71ae5a4SJacob Faibussowitsch {
2522cbf8eb3cSStefano Zampini   PetscInt     printFEM;
2523b8feb594SMatthew G. Knepley   PetscScalar *cintegral, *lintegral;
2524412e9a14SMatthew G. Knepley   PetscInt     Nf, f, cellHeight, cStart, cEnd, cell;
25256493148fSStefano Zampini   Vec          locX;
2526338f77d5SMatthew G. Knepley 
2527338f77d5SMatthew G. Knepley   PetscFunctionBegin;
2528338f77d5SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
2529338f77d5SMatthew G. Knepley   PetscValidHeaderSpecific(X, VEC_CLASSID, 2);
25304f572ea9SToby Isaac   PetscAssertPointer(integral, 3);
25319566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_IntegralFEM, dm, 0, 0, 0));
2532cbf8eb3cSStefano Zampini   PetscCall(DMPlexConvertPlex(dm, &dm, PETSC_TRUE));
25339566063dSJacob Faibussowitsch   PetscCall(DMGetNumFields(dm, &Nf));
25349566063dSJacob Faibussowitsch   PetscCall(DMPlexGetVTKCellHeight(dm, &cellHeight));
25359566063dSJacob Faibussowitsch   PetscCall(DMPlexGetSimplexOrBoxCells(dm, cellHeight, &cStart, &cEnd));
2536338f77d5SMatthew G. Knepley   /* TODO Introduce a loop over large chunks (right now this is a single chunk) */
25379566063dSJacob Faibussowitsch   PetscCall(PetscCalloc2(Nf, &lintegral, (cEnd - cStart) * Nf, &cintegral));
25386493148fSStefano Zampini   /* Get local solution with boundary values */
25396493148fSStefano Zampini   PetscCall(DMGetLocalVector(dm, &locX));
25406493148fSStefano Zampini   PetscCall(DMPlexInsertBoundaryValues(dm, PETSC_TRUE, locX, 0.0, NULL, NULL, NULL));
25416493148fSStefano Zampini   PetscCall(DMGlobalToLocalBegin(dm, X, INSERT_VALUES, locX));
25426493148fSStefano Zampini   PetscCall(DMGlobalToLocalEnd(dm, X, INSERT_VALUES, locX));
25436493148fSStefano Zampini   PetscCall(DMPlexComputeIntegral_Internal(dm, locX, cStart, cEnd, cintegral, user));
25446493148fSStefano Zampini   PetscCall(DMRestoreLocalVector(dm, &locX));
2545cbf8eb3cSStefano Zampini   printFEM = ((DM_Plex *)dm->data)->printFEM;
2546338f77d5SMatthew G. Knepley   /* Sum up values */
2547338f77d5SMatthew G. Knepley   for (cell = cStart; cell < cEnd; ++cell) {
2548338f77d5SMatthew G. Knepley     const PetscInt c = cell - cStart;
2549338f77d5SMatthew G. Knepley 
2550cbf8eb3cSStefano Zampini     if (printFEM > 1) PetscCall(DMPrintCellVector(cell, "Cell Integral", Nf, &cintegral[c * Nf]));
2551b8feb594SMatthew G. Knepley     for (f = 0; f < Nf; ++f) lintegral[f] += cintegral[c * Nf + f];
2552338f77d5SMatthew G. Knepley   }
2553462c564dSBarry Smith   PetscCallMPI(MPIU_Allreduce(lintegral, integral, (PetscMPIInt)Nf, MPIU_SCALAR, MPIU_SUM, PetscObjectComm((PetscObject)dm)));
2554cbf8eb3cSStefano Zampini   if (printFEM) {
25559566063dSJacob Faibussowitsch     PetscCall(PetscPrintf(PetscObjectComm((PetscObject)dm), "Integral:"));
25569566063dSJacob Faibussowitsch     for (f = 0; f < Nf; ++f) PetscCall(PetscPrintf(PetscObjectComm((PetscObject)dm), " %g", (double)PetscRealPart(integral[f])));
25579566063dSJacob Faibussowitsch     PetscCall(PetscPrintf(PetscObjectComm((PetscObject)dm), "\n"));
255873d901b8SMatthew G. Knepley   }
25599566063dSJacob Faibussowitsch   PetscCall(PetscFree2(lintegral, cintegral));
25609566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_IntegralFEM, dm, 0, 0, 0));
2561cbf8eb3cSStefano Zampini   PetscCall(DMDestroy(&dm));
25623ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
2563338f77d5SMatthew G. Knepley }
2564338f77d5SMatthew G. Knepley 
2565338f77d5SMatthew G. Knepley /*@
2566338f77d5SMatthew G. Knepley   DMPlexComputeCellwiseIntegralFEM - Form the vector of cellwise integrals F from the global input X using pointwise functions specified by the user
2567338f77d5SMatthew G. Knepley 
2568338f77d5SMatthew G. Knepley   Input Parameters:
2569338f77d5SMatthew G. Knepley + dm   - The mesh
2570338f77d5SMatthew G. Knepley . X    - Global input vector
2571338f77d5SMatthew G. Knepley - user - The user context
2572338f77d5SMatthew G. Knepley 
2573338f77d5SMatthew G. Knepley   Output Parameter:
257460225df5SJacob Faibussowitsch . F - Cellwise integrals for each field
2575338f77d5SMatthew G. Knepley 
2576338f77d5SMatthew G. Knepley   Level: developer
2577338f77d5SMatthew G. Knepley 
25781cc06b55SBarry Smith .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `DMPlexSNESComputeResidualFEM()`
2579338f77d5SMatthew G. Knepley @*/
2580d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexComputeCellwiseIntegralFEM(DM dm, Vec X, Vec F, void *user)
2581d71ae5a4SJacob Faibussowitsch {
2582cbf8eb3cSStefano Zampini   PetscInt     printFEM;
2583338f77d5SMatthew G. Knepley   DM           dmF;
25849c8ab049SStefano Zampini   PetscSection sectionF = NULL;
2585338f77d5SMatthew G. Knepley   PetscScalar *cintegral, *af;
25869c8ab049SStefano Zampini   PetscInt     Nf, f, cellHeight, cStart, cEnd, cell, n;
25876493148fSStefano Zampini   Vec          locX;
2588338f77d5SMatthew G. Knepley 
2589338f77d5SMatthew G. Knepley   PetscFunctionBegin;
2590338f77d5SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
2591338f77d5SMatthew G. Knepley   PetscValidHeaderSpecific(X, VEC_CLASSID, 2);
2592338f77d5SMatthew G. Knepley   PetscValidHeaderSpecific(F, VEC_CLASSID, 3);
25939566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_IntegralFEM, dm, 0, 0, 0));
2594cbf8eb3cSStefano Zampini   PetscCall(DMPlexConvertPlex(dm, &dm, PETSC_TRUE));
25959566063dSJacob Faibussowitsch   PetscCall(DMGetNumFields(dm, &Nf));
25969566063dSJacob Faibussowitsch   PetscCall(DMPlexGetVTKCellHeight(dm, &cellHeight));
25979566063dSJacob Faibussowitsch   PetscCall(DMPlexGetSimplexOrBoxCells(dm, cellHeight, &cStart, &cEnd));
2598338f77d5SMatthew G. Knepley   /* TODO Introduce a loop over large chunks (right now this is a single chunk) */
25999566063dSJacob Faibussowitsch   PetscCall(PetscCalloc1((cEnd - cStart) * Nf, &cintegral));
26006493148fSStefano Zampini   /* Get local solution with boundary values */
26016493148fSStefano Zampini   PetscCall(DMGetLocalVector(dm, &locX));
26026493148fSStefano Zampini   PetscCall(DMPlexInsertBoundaryValues(dm, PETSC_TRUE, locX, 0.0, NULL, NULL, NULL));
26036493148fSStefano Zampini   PetscCall(DMGlobalToLocalBegin(dm, X, INSERT_VALUES, locX));
26046493148fSStefano Zampini   PetscCall(DMGlobalToLocalEnd(dm, X, INSERT_VALUES, locX));
26056493148fSStefano Zampini   PetscCall(DMPlexComputeIntegral_Internal(dm, locX, cStart, cEnd, cintegral, user));
26066493148fSStefano Zampini   PetscCall(DMRestoreLocalVector(dm, &locX));
2607338f77d5SMatthew G. Knepley   /* Put values in F */
26089566063dSJacob Faibussowitsch   PetscCall(VecGetArray(F, &af));
26099c8ab049SStefano Zampini   PetscCall(VecGetDM(F, &dmF));
26109c8ab049SStefano Zampini   if (dmF) PetscCall(DMGetLocalSection(dmF, &sectionF));
26119c8ab049SStefano Zampini   PetscCall(VecGetLocalSize(F, &n));
26129c8ab049SStefano Zampini   PetscCheck(n >= (cEnd - cStart) * Nf, PETSC_COMM_SELF, PETSC_ERR_ARG_SIZ, "Vector size %" PetscInt_FMT " < %" PetscInt_FMT, n, (cEnd - cStart) * Nf);
2613cbf8eb3cSStefano Zampini   printFEM = ((DM_Plex *)dm->data)->printFEM;
2614338f77d5SMatthew G. Knepley   for (cell = cStart; cell < cEnd; ++cell) {
2615338f77d5SMatthew G. Knepley     const PetscInt c   = cell - cStart;
26169c8ab049SStefano Zampini     PetscInt       dof = Nf, off = c * Nf;
2617338f77d5SMatthew G. Knepley 
2618cbf8eb3cSStefano Zampini     if (printFEM > 1) PetscCall(DMPrintCellVector(cell, "Cell Integral", Nf, &cintegral[c * Nf]));
26199c8ab049SStefano Zampini     if (sectionF) {
26209566063dSJacob Faibussowitsch       PetscCall(PetscSectionGetDof(sectionF, cell, &dof));
26219566063dSJacob Faibussowitsch       PetscCall(PetscSectionGetOffset(sectionF, cell, &off));
26229c8ab049SStefano Zampini     }
262363a3b9bcSJacob Faibussowitsch     PetscCheck(dof == Nf, PETSC_COMM_SELF, PETSC_ERR_ARG_SIZ, "The number of cell dofs %" PetscInt_FMT " != %" PetscInt_FMT, dof, Nf);
2624338f77d5SMatthew G. Knepley     for (f = 0; f < Nf; ++f) af[off + f] = cintegral[c * Nf + f];
2625338f77d5SMatthew G. Knepley   }
26269566063dSJacob Faibussowitsch   PetscCall(VecRestoreArray(F, &af));
26279566063dSJacob Faibussowitsch   PetscCall(PetscFree(cintegral));
26289566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_IntegralFEM, dm, 0, 0, 0));
2629cbf8eb3cSStefano Zampini   PetscCall(DMDestroy(&dm));
26303ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
263173d901b8SMatthew G. Knepley }
263273d901b8SMatthew G. Knepley 
263379ab67a3SMatthew G. Knepley static PetscErrorCode DMPlexComputeBdIntegral_Internal(DM dm, Vec locX, IS pointIS, void (**funcs)(PetscInt, PetscInt, PetscInt, const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[], PetscReal, const PetscReal[], const PetscReal[], PetscInt, const PetscScalar[], PetscScalar[]), PetscScalar *fintegral, void *user)
2634d71ae5a4SJacob Faibussowitsch {
26359b6f715bSMatthew G. Knepley   DM                 plex = NULL, plexA = NULL;
2636a6e0b375SMatthew G. Knepley   DMEnclosureType    encAux;
26379b6f715bSMatthew G. Knepley   PetscDS            prob, probAux       = NULL;
26389b6f715bSMatthew G. Knepley   PetscSection       section, sectionAux = NULL;
26399b6f715bSMatthew G. Knepley   Vec                locA = NULL;
26409b6f715bSMatthew G. Knepley   DMField            coordField;
26419b6f715bSMatthew G. Knepley   PetscInt           Nf, totDim, *uOff, *uOff_x;
26429b6f715bSMatthew G. Knepley   PetscInt           NfAux = 0, totDimAux = 0, *aOff = NULL;
26439b6f715bSMatthew G. Knepley   PetscScalar       *u, *a = NULL;
264464c72086SMatthew G. Knepley   const PetscScalar *constants;
26459b6f715bSMatthew G. Knepley   PetscInt           numConstants, f;
264664c72086SMatthew G. Knepley 
264764c72086SMatthew G. Knepley   PetscFunctionBegin;
26489566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateField(dm, &coordField));
26499566063dSJacob Faibussowitsch   PetscCall(DMConvert(dm, DMPLEX, &plex));
26509566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dm, &prob));
26519566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
26529566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetNumFields(section, &Nf));
265364c72086SMatthew G. Knepley   /* Determine which discretizations we have */
26549b6f715bSMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
265564c72086SMatthew G. Knepley     PetscObject  obj;
265664c72086SMatthew G. Knepley     PetscClassId id;
265764c72086SMatthew G. Knepley 
26589566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, f, &obj));
26599566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
266063a3b9bcSJacob Faibussowitsch     PetscCheck(id != PETSCFV_CLASSID, PetscObjectComm((PetscObject)dm), PETSC_ERR_SUP, "Not supported for FVM (field %" PetscInt_FMT ")", f);
266164c72086SMatthew G. Knepley   }
266264c72086SMatthew G. Knepley   /* Read DS information */
26639566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(prob, &totDim));
26649566063dSJacob Faibussowitsch   PetscCall(PetscDSGetComponentOffsets(prob, &uOff));
26659566063dSJacob Faibussowitsch   PetscCall(PetscDSGetComponentDerivativeOffsets(prob, &uOff_x));
26669566063dSJacob Faibussowitsch   PetscCall(PetscDSGetConstants(prob, &numConstants, &constants));
266764c72086SMatthew G. Knepley   /* Read Auxiliary DS information */
26689566063dSJacob Faibussowitsch   PetscCall(DMGetAuxiliaryVec(dm, NULL, 0, 0, &locA));
26699b6f715bSMatthew G. Knepley   if (locA) {
26709b6f715bSMatthew G. Knepley     DM dmAux;
26719b6f715bSMatthew G. Knepley 
26729566063dSJacob Faibussowitsch     PetscCall(VecGetDM(locA, &dmAux));
26739566063dSJacob Faibussowitsch     PetscCall(DMGetEnclosureRelation(dmAux, dm, &encAux));
26749566063dSJacob Faibussowitsch     PetscCall(DMConvert(dmAux, DMPLEX, &plexA));
26759566063dSJacob Faibussowitsch     PetscCall(DMGetDS(dmAux, &probAux));
26769566063dSJacob Faibussowitsch     PetscCall(PetscDSGetNumFields(probAux, &NfAux));
26779566063dSJacob Faibussowitsch     PetscCall(DMGetLocalSection(dmAux, &sectionAux));
26789566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalDimension(probAux, &totDimAux));
26799566063dSJacob Faibussowitsch     PetscCall(PetscDSGetComponentOffsets(probAux, &aOff));
268064c72086SMatthew G. Knepley   }
26819b6f715bSMatthew G. Knepley   /* Integrate over points */
26829b6f715bSMatthew G. Knepley   {
26839b6f715bSMatthew G. Knepley     PetscFEGeom    *fgeom, *chunkGeom = NULL;
2684b7260050SToby Isaac     PetscInt        maxDegree;
26859b6f715bSMatthew G. Knepley     PetscQuadrature qGeom = NULL;
26869b6f715bSMatthew G. Knepley     const PetscInt *points;
26879b6f715bSMatthew G. Knepley     PetscInt        numFaces, face, Nq, field;
26889b6f715bSMatthew G. Knepley     PetscInt        numChunks, chunkSize, chunk, Nr, offset;
268964c72086SMatthew G. Knepley 
26909566063dSJacob Faibussowitsch     PetscCall(ISGetLocalSize(pointIS, &numFaces));
26919566063dSJacob Faibussowitsch     PetscCall(ISGetIndices(pointIS, &points));
26929566063dSJacob Faibussowitsch     PetscCall(PetscCalloc2(numFaces * totDim, &u, locA ? numFaces * totDimAux : 0, &a));
26939566063dSJacob Faibussowitsch     PetscCall(DMFieldGetDegree(coordField, pointIS, NULL, &maxDegree));
269479ab67a3SMatthew G. Knepley     for (face = 0; face < numFaces; ++face) {
269579ab67a3SMatthew G. Knepley       const PetscInt point = points[face], *support;
269679ab67a3SMatthew G. Knepley       PetscScalar   *x     = NULL;
269779ab67a3SMatthew G. Knepley 
269879ab67a3SMatthew G. Knepley       PetscCall(DMPlexGetSupport(dm, point, &support));
269979ab67a3SMatthew G. Knepley       PetscCall(DMPlexVecGetClosure(plex, section, locX, support[0], NULL, &x));
270079ab67a3SMatthew G. Knepley       for (PetscInt i = 0; i < totDim; ++i) u[face * totDim + i] = x[i];
270179ab67a3SMatthew G. Knepley       PetscCall(DMPlexVecRestoreClosure(plex, section, locX, support[0], NULL, &x));
270279ab67a3SMatthew G. Knepley       if (locA) {
270379ab67a3SMatthew G. Knepley         PetscInt subp;
270479ab67a3SMatthew G. Knepley         PetscCall(DMGetEnclosurePoint(plexA, dm, encAux, support[0], &subp));
270579ab67a3SMatthew G. Knepley         PetscCall(DMPlexVecGetClosure(plexA, sectionAux, locA, subp, NULL, &x));
270679ab67a3SMatthew G. Knepley         for (PetscInt i = 0; i < totDimAux; ++i) a[f * totDimAux + i] = x[i];
270779ab67a3SMatthew G. Knepley         PetscCall(DMPlexVecRestoreClosure(plexA, sectionAux, locA, subp, NULL, &x));
270879ab67a3SMatthew G. Knepley       }
270979ab67a3SMatthew G. Knepley     }
271064c72086SMatthew G. Knepley     for (field = 0; field < Nf; ++field) {
271164c72086SMatthew G. Knepley       PetscFE fe;
271264c72086SMatthew G. Knepley 
27139566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(prob, field, (PetscObject *)&fe));
27149566063dSJacob Faibussowitsch       if (maxDegree <= 1) PetscCall(DMFieldCreateDefaultQuadrature(coordField, pointIS, &qGeom));
27159b6f715bSMatthew G. Knepley       if (!qGeom) {
27169566063dSJacob Faibussowitsch         PetscCall(PetscFEGetFaceQuadrature(fe, &qGeom));
27179566063dSJacob Faibussowitsch         PetscCall(PetscObjectReference((PetscObject)qGeom));
27189b6f715bSMatthew G. Knepley       }
27199566063dSJacob Faibussowitsch       PetscCall(PetscQuadratureGetData(qGeom, NULL, NULL, &Nq, NULL, NULL));
27209566063dSJacob Faibussowitsch       PetscCall(DMPlexGetFEGeom(coordField, pointIS, qGeom, PETSC_TRUE, &fgeom));
27219b6f715bSMatthew G. Knepley       /* Get blocking */
27229b6f715bSMatthew G. Knepley       {
27239b6f715bSMatthew G. Knepley         PetscQuadrature q;
27249b6f715bSMatthew G. Knepley         PetscInt        numBatches, batchSize, numBlocks, blockSize;
27259b6f715bSMatthew G. Knepley         PetscInt        Nq, Nb;
27269b6f715bSMatthew G. Knepley 
27279566063dSJacob Faibussowitsch         PetscCall(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
27289566063dSJacob Faibussowitsch         PetscCall(PetscFEGetQuadrature(fe, &q));
27299566063dSJacob Faibussowitsch         PetscCall(PetscQuadratureGetData(q, NULL, NULL, &Nq, NULL, NULL));
27309566063dSJacob Faibussowitsch         PetscCall(PetscFEGetDimension(fe, &Nb));
273164c72086SMatthew G. Knepley         blockSize = Nb * Nq;
273264c72086SMatthew G. Knepley         batchSize = numBlocks * blockSize;
27339b6f715bSMatthew G. Knepley         chunkSize = numBatches * batchSize;
27349566063dSJacob Faibussowitsch         PetscCall(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
27359b6f715bSMatthew G. Knepley         numChunks = numFaces / chunkSize;
27369b6f715bSMatthew G. Knepley         Nr        = numFaces % chunkSize;
273764c72086SMatthew G. Knepley         offset    = numFaces - Nr;
273864c72086SMatthew G. Knepley       }
27399b6f715bSMatthew G. Knepley       /* Do integration for each field */
27409b6f715bSMatthew G. Knepley       for (chunk = 0; chunk < numChunks; ++chunk) {
27419566063dSJacob Faibussowitsch         PetscCall(PetscFEGeomGetChunk(fgeom, chunk * chunkSize, (chunk + 1) * chunkSize, &chunkGeom));
274279ab67a3SMatthew G. Knepley         PetscCall(PetscFEIntegrateBd(prob, field, funcs[field], chunkSize, chunkGeom, &u[chunk * chunkSize * totDim], probAux, PetscSafePointerPlusOffset(a, chunk * chunkSize * totDimAux), &fintegral[chunk * chunkSize * Nf]));
27439566063dSJacob Faibussowitsch         PetscCall(PetscFEGeomRestoreChunk(fgeom, 0, offset, &chunkGeom));
274464c72086SMatthew G. Knepley       }
27459566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomGetChunk(fgeom, offset, numFaces, &chunkGeom));
274679ab67a3SMatthew G. Knepley       PetscCall(PetscFEIntegrateBd(prob, field, funcs[field], Nr, chunkGeom, &u[offset * totDim], probAux, PetscSafePointerPlusOffset(a, offset * totDimAux), &fintegral[offset * Nf]));
27479566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomRestoreChunk(fgeom, offset, numFaces, &chunkGeom));
274864c72086SMatthew G. Knepley       /* Cleanup data arrays */
27499566063dSJacob Faibussowitsch       PetscCall(DMPlexRestoreFEGeom(coordField, pointIS, qGeom, PETSC_TRUE, &fgeom));
27509566063dSJacob Faibussowitsch       PetscCall(PetscQuadratureDestroy(&qGeom));
275179ab67a3SMatthew G. Knepley     }
27529566063dSJacob Faibussowitsch     PetscCall(PetscFree2(u, a));
27539566063dSJacob Faibussowitsch     PetscCall(ISRestoreIndices(pointIS, &points));
275464c72086SMatthew G. Knepley   }
27559566063dSJacob Faibussowitsch   if (plex) PetscCall(DMDestroy(&plex));
27569566063dSJacob Faibussowitsch   if (plexA) PetscCall(DMDestroy(&plexA));
27573ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
27589b6f715bSMatthew G. Knepley }
27599b6f715bSMatthew G. Knepley 
276060225df5SJacob Faibussowitsch /*@C
27619b6f715bSMatthew G. Knepley   DMPlexComputeBdIntegral - Form the integral over the specified boundary from the global input X using pointwise functions specified by the user
27629b6f715bSMatthew G. Knepley 
27639b6f715bSMatthew G. Knepley   Input Parameters:
27649b6f715bSMatthew G. Knepley + dm      - The mesh
27659b6f715bSMatthew G. Knepley . X       - Global input vector
2766a1cb98faSBarry Smith . label   - The boundary `DMLabel`
2767a1cb98faSBarry Smith . numVals - The number of label values to use, or `PETSC_DETERMINE` for all values
2768a1cb98faSBarry Smith . vals    - The label values to use, or NULL for all values
276979ab67a3SMatthew G. Knepley . funcs   - The functions to integrate along the boundary for each field
27709b6f715bSMatthew G. Knepley - user    - The user context
27719b6f715bSMatthew G. Knepley 
27729b6f715bSMatthew G. Knepley   Output Parameter:
27739b6f715bSMatthew G. Knepley . integral - Integral for each field
27749b6f715bSMatthew G. Knepley 
27759b6f715bSMatthew G. Knepley   Level: developer
27769b6f715bSMatthew G. Knepley 
27771cc06b55SBarry Smith .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `DMPlexComputeIntegralFEM()`, `DMPlexComputeBdResidualFEM()`
27789b6f715bSMatthew G. Knepley @*/
277979ab67a3SMatthew G. Knepley PetscErrorCode DMPlexComputeBdIntegral(DM dm, Vec X, DMLabel label, PetscInt numVals, const PetscInt vals[], void (**funcs)(PetscInt, PetscInt, PetscInt, const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[], PetscReal, const PetscReal[], const PetscReal[], PetscInt, const PetscScalar[], PetscScalar[]), PetscScalar *integral, void *user)
2780d71ae5a4SJacob Faibussowitsch {
27819b6f715bSMatthew G. Knepley   Vec          locX;
27829b6f715bSMatthew G. Knepley   PetscSection section;
27839b6f715bSMatthew G. Knepley   DMLabel      depthLabel;
27849b6f715bSMatthew G. Knepley   IS           facetIS;
27859b6f715bSMatthew G. Knepley   PetscInt     dim, Nf, f, v;
27869b6f715bSMatthew G. Knepley 
27879b6f715bSMatthew G. Knepley   PetscFunctionBegin;
27889b6f715bSMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
27899b6f715bSMatthew G. Knepley   PetscValidHeaderSpecific(X, VEC_CLASSID, 2);
2790292bffcbSToby Isaac   PetscValidHeaderSpecific(label, DMLABEL_CLASSID, 3);
27914f572ea9SToby Isaac   if (vals) PetscAssertPointer(vals, 5);
27924f572ea9SToby Isaac   PetscAssertPointer(integral, 7);
27939566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_IntegralFEM, dm, 0, 0, 0));
27949566063dSJacob Faibussowitsch   PetscCall(DMPlexGetDepthLabel(dm, &depthLabel));
27959566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
27969566063dSJacob Faibussowitsch   PetscCall(DMLabelGetStratumIS(depthLabel, dim - 1, &facetIS));
27979566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
27989566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetNumFields(section, &Nf));
27999b6f715bSMatthew G. Knepley   /* Get local solution with boundary values */
28009566063dSJacob Faibussowitsch   PetscCall(DMGetLocalVector(dm, &locX));
28019566063dSJacob Faibussowitsch   PetscCall(DMPlexInsertBoundaryValues(dm, PETSC_TRUE, locX, 0.0, NULL, NULL, NULL));
28029566063dSJacob Faibussowitsch   PetscCall(DMGlobalToLocalBegin(dm, X, INSERT_VALUES, locX));
28039566063dSJacob Faibussowitsch   PetscCall(DMGlobalToLocalEnd(dm, X, INSERT_VALUES, locX));
28049b6f715bSMatthew G. Knepley   /* Loop over label values */
28059566063dSJacob Faibussowitsch   PetscCall(PetscArrayzero(integral, Nf));
28069b6f715bSMatthew G. Knepley   for (v = 0; v < numVals; ++v) {
28079b6f715bSMatthew G. Knepley     IS           pointIS;
28089b6f715bSMatthew G. Knepley     PetscInt     numFaces, face;
28099b6f715bSMatthew G. Knepley     PetscScalar *fintegral;
28109b6f715bSMatthew G. Knepley 
28119566063dSJacob Faibussowitsch     PetscCall(DMLabelGetStratumIS(label, vals[v], &pointIS));
28129b6f715bSMatthew G. Knepley     if (!pointIS) continue; /* No points with that id on this process */
28139b6f715bSMatthew G. Knepley     {
28149b6f715bSMatthew G. Knepley       IS isectIS;
28159b6f715bSMatthew G. Knepley 
28169b6f715bSMatthew G. Knepley       /* TODO: Special cases of ISIntersect where it is quick to check a priori if one is a superset of the other */
28179566063dSJacob Faibussowitsch       PetscCall(ISIntersect_Caching_Internal(facetIS, pointIS, &isectIS));
28189566063dSJacob Faibussowitsch       PetscCall(ISDestroy(&pointIS));
28199b6f715bSMatthew G. Knepley       pointIS = isectIS;
28209b6f715bSMatthew G. Knepley     }
28219566063dSJacob Faibussowitsch     PetscCall(ISGetLocalSize(pointIS, &numFaces));
28229566063dSJacob Faibussowitsch     PetscCall(PetscCalloc1(numFaces * Nf, &fintegral));
282379ab67a3SMatthew G. Knepley     PetscCall(DMPlexComputeBdIntegral_Internal(dm, locX, pointIS, funcs, fintegral, user));
28249b6f715bSMatthew G. Knepley     /* Sum point contributions into integral */
28259371c9d4SSatish Balay     for (f = 0; f < Nf; ++f)
28269371c9d4SSatish Balay       for (face = 0; face < numFaces; ++face) integral[f] += fintegral[face * Nf + f];
28279566063dSJacob Faibussowitsch     PetscCall(PetscFree(fintegral));
28289566063dSJacob Faibussowitsch     PetscCall(ISDestroy(&pointIS));
28299b6f715bSMatthew G. Knepley   }
28309566063dSJacob Faibussowitsch   PetscCall(DMRestoreLocalVector(dm, &locX));
28319566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&facetIS));
28329566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_IntegralFEM, dm, 0, 0, 0));
28333ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
283464c72086SMatthew G. Knepley }
283564c72086SMatthew G. Knepley 
2836d69c5d34SMatthew G. Knepley /*@
28370318f8a0SStefano Zampini   DMPlexComputeInterpolatorNested - Form the local portion of the interpolation matrix from the coarse `DM` to a uniformly refined `DM`.
2838d69c5d34SMatthew G. Knepley 
2839d69c5d34SMatthew G. Knepley   Input Parameters:
2840cf51de39SMatthew G. Knepley + dmc       - The coarse mesh
2841cf51de39SMatthew G. Knepley . dmf       - The fine mesh
2842cf51de39SMatthew G. Knepley . isRefined - Flag indicating regular refinement, rather than the same topology
2843d69c5d34SMatthew G. Knepley - user      - The user context
2844d69c5d34SMatthew G. Knepley 
2845d69c5d34SMatthew G. Knepley   Output Parameter:
2846934789fcSMatthew G. Knepley . In - The interpolation matrix
2847d69c5d34SMatthew G. Knepley 
2848d69c5d34SMatthew G. Knepley   Level: developer
2849d69c5d34SMatthew G. Knepley 
2850ae3cf2c1SStefano Zampini .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `DMPlexComputeInterpolatorGeneral()`
2851d69c5d34SMatthew G. Knepley @*/
2852d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexComputeInterpolatorNested(DM dmc, DM dmf, PetscBool isRefined, Mat In, void *user)
2853d71ae5a4SJacob Faibussowitsch {
2854d69c5d34SMatthew G. Knepley   DM_Plex     *mesh = (DM_Plex *)dmc->data;
2855d69c5d34SMatthew G. Knepley   const char  *name = "Interpolator";
2856d69c5d34SMatthew G. Knepley   PetscFE     *feRef;
285797c42addSMatthew G. Knepley   PetscFV     *fvRef;
2858d69c5d34SMatthew G. Knepley   PetscSection fsection, fglobalSection;
2859d69c5d34SMatthew G. Knepley   PetscSection csection, cglobalSection;
2860d69c5d34SMatthew G. Knepley   PetscScalar *elemMat;
2861485ad865SMatthew G. Knepley   PetscInt     dim, Nf, f, fieldI, fieldJ, offsetI, offsetJ, cStart, cEnd, c;
28622ea9c922SToby Isaac   PetscInt     cTotDim = 0, rTotDim = 0;
2863d69c5d34SMatthew G. Knepley 
2864d69c5d34SMatthew G. Knepley   PetscFunctionBegin;
28659566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_InterpolatorFEM, dmc, dmf, 0, 0));
28669566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dmf, &dim));
28679566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dmf, &fsection));
28689566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dmf, &fglobalSection));
28699566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dmc, &csection));
28709566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dmc, &cglobalSection));
28719566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetNumFields(fsection, &Nf));
28729566063dSJacob Faibussowitsch   PetscCall(DMPlexGetSimplexOrBoxCells(dmc, 0, &cStart, &cEnd));
28739566063dSJacob Faibussowitsch   PetscCall(PetscCalloc2(Nf, &feRef, Nf, &fvRef));
2874d69c5d34SMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
28752ea9c922SToby Isaac     PetscObject  obj, objc;
28762ea9c922SToby Isaac     PetscClassId id, idc;
28772ea9c922SToby Isaac     PetscInt     rNb = 0, Nc = 0, cNb = 0;
2878d69c5d34SMatthew G. Knepley 
28799566063dSJacob Faibussowitsch     PetscCall(DMGetField(dmf, f, NULL, &obj));
28809566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
288197c42addSMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
288297c42addSMatthew G. Knepley       PetscFE fe = (PetscFE)obj;
288397c42addSMatthew G. Knepley 
2884cf51de39SMatthew G. Knepley       if (isRefined) {
28859566063dSJacob Faibussowitsch         PetscCall(PetscFERefine(fe, &feRef[f]));
2886cf51de39SMatthew G. Knepley       } else {
28879566063dSJacob Faibussowitsch         PetscCall(PetscObjectReference((PetscObject)fe));
2888cf51de39SMatthew G. Knepley         feRef[f] = fe;
2889cf51de39SMatthew G. Knepley       }
28909566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDimension(feRef[f], &rNb));
28919566063dSJacob Faibussowitsch       PetscCall(PetscFEGetNumComponents(fe, &Nc));
289297c42addSMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
289397c42addSMatthew G. Knepley       PetscFV        fv = (PetscFV)obj;
289497c42addSMatthew G. Knepley       PetscDualSpace Q;
289597c42addSMatthew G. Knepley 
2896cf51de39SMatthew G. Knepley       if (isRefined) {
28979566063dSJacob Faibussowitsch         PetscCall(PetscFVRefine(fv, &fvRef[f]));
2898cf51de39SMatthew G. Knepley       } else {
28999566063dSJacob Faibussowitsch         PetscCall(PetscObjectReference((PetscObject)fv));
2900cf51de39SMatthew G. Knepley         fvRef[f] = fv;
2901cf51de39SMatthew G. Knepley       }
29029566063dSJacob Faibussowitsch       PetscCall(PetscFVGetDualSpace(fvRef[f], &Q));
29039566063dSJacob Faibussowitsch       PetscCall(PetscDualSpaceGetDimension(Q, &rNb));
29049566063dSJacob Faibussowitsch       PetscCall(PetscFVGetDualSpace(fv, &Q));
29059566063dSJacob Faibussowitsch       PetscCall(PetscFVGetNumComponents(fv, &Nc));
290697c42addSMatthew G. Knepley     }
29079566063dSJacob Faibussowitsch     PetscCall(DMGetField(dmc, f, NULL, &objc));
29089566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(objc, &idc));
29092ea9c922SToby Isaac     if (idc == PETSCFE_CLASSID) {
29102ea9c922SToby Isaac       PetscFE fe = (PetscFE)objc;
29112ea9c922SToby Isaac 
29129566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDimension(fe, &cNb));
29132ea9c922SToby Isaac     } else if (id == PETSCFV_CLASSID) {
29142ea9c922SToby Isaac       PetscFV        fv = (PetscFV)obj;
29152ea9c922SToby Isaac       PetscDualSpace Q;
29162ea9c922SToby Isaac 
29179566063dSJacob Faibussowitsch       PetscCall(PetscFVGetDualSpace(fv, &Q));
29189566063dSJacob Faibussowitsch       PetscCall(PetscDualSpaceGetDimension(Q, &cNb));
2919d69c5d34SMatthew G. Knepley     }
29202ea9c922SToby Isaac     rTotDim += rNb;
29212ea9c922SToby Isaac     cTotDim += cNb;
29222ea9c922SToby Isaac   }
29239566063dSJacob Faibussowitsch   PetscCall(PetscMalloc1(rTotDim * cTotDim, &elemMat));
29249566063dSJacob Faibussowitsch   PetscCall(PetscArrayzero(elemMat, rTotDim * cTotDim));
2925d69c5d34SMatthew G. Knepley   for (fieldI = 0, offsetI = 0; fieldI < Nf; ++fieldI) {
2926d69c5d34SMatthew G. Knepley     PetscDualSpace   Qref;
2927d69c5d34SMatthew G. Knepley     PetscQuadrature  f;
2928d69c5d34SMatthew G. Knepley     const PetscReal *qpoints, *qweights;
2929d69c5d34SMatthew G. Knepley     PetscReal       *points;
2930d69c5d34SMatthew G. Knepley     PetscInt         npoints = 0, Nc, Np, fpdim, i, k, p, d;
2931d69c5d34SMatthew G. Knepley 
2932d69c5d34SMatthew G. Knepley     /* Compose points from all dual basis functionals */
293397c42addSMatthew G. Knepley     if (feRef[fieldI]) {
29349566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDualSpace(feRef[fieldI], &Qref));
29359566063dSJacob Faibussowitsch       PetscCall(PetscFEGetNumComponents(feRef[fieldI], &Nc));
293697c42addSMatthew G. Knepley     } else {
29379566063dSJacob Faibussowitsch       PetscCall(PetscFVGetDualSpace(fvRef[fieldI], &Qref));
29389566063dSJacob Faibussowitsch       PetscCall(PetscFVGetNumComponents(fvRef[fieldI], &Nc));
293997c42addSMatthew G. Knepley     }
29409566063dSJacob Faibussowitsch     PetscCall(PetscDualSpaceGetDimension(Qref, &fpdim));
2941d69c5d34SMatthew G. Knepley     for (i = 0; i < fpdim; ++i) {
29429566063dSJacob Faibussowitsch       PetscCall(PetscDualSpaceGetFunctional(Qref, i, &f));
29439566063dSJacob Faibussowitsch       PetscCall(PetscQuadratureGetData(f, NULL, NULL, &Np, NULL, NULL));
2944d69c5d34SMatthew G. Knepley       npoints += Np;
2945d69c5d34SMatthew G. Knepley     }
29469566063dSJacob Faibussowitsch     PetscCall(PetscMalloc1(npoints * dim, &points));
2947d69c5d34SMatthew G. Knepley     for (i = 0, k = 0; i < fpdim; ++i) {
29489566063dSJacob Faibussowitsch       PetscCall(PetscDualSpaceGetFunctional(Qref, i, &f));
29499566063dSJacob Faibussowitsch       PetscCall(PetscQuadratureGetData(f, NULL, NULL, &Np, &qpoints, NULL));
29509371c9d4SSatish Balay       for (p = 0; p < Np; ++p, ++k)
29519371c9d4SSatish Balay         for (d = 0; d < dim; ++d) points[k * dim + d] = qpoints[p * dim + d];
2952d69c5d34SMatthew G. Knepley     }
2953d69c5d34SMatthew G. Knepley 
2954d69c5d34SMatthew G. Knepley     for (fieldJ = 0, offsetJ = 0; fieldJ < Nf; ++fieldJ) {
295597c42addSMatthew G. Knepley       PetscObject  obj;
295697c42addSMatthew G. Knepley       PetscClassId id;
29579c3cf19fSMatthew G. Knepley       PetscInt     NcJ = 0, cpdim = 0, j, qNc;
2958d69c5d34SMatthew G. Knepley 
29599566063dSJacob Faibussowitsch       PetscCall(DMGetField(dmc, fieldJ, NULL, &obj));
29609566063dSJacob Faibussowitsch       PetscCall(PetscObjectGetClassId(obj, &id));
296197c42addSMatthew G. Knepley       if (id == PETSCFE_CLASSID) {
296297c42addSMatthew G. Knepley         PetscFE         fe = (PetscFE)obj;
2963ef0bb6c7SMatthew G. Knepley         PetscTabulation T  = NULL;
2964d69c5d34SMatthew G. Knepley 
2965d69c5d34SMatthew G. Knepley         /* Evaluate basis at points */
29669566063dSJacob Faibussowitsch         PetscCall(PetscFEGetNumComponents(fe, &NcJ));
29679566063dSJacob Faibussowitsch         PetscCall(PetscFEGetDimension(fe, &cpdim));
2968ffe73a53SMatthew G. Knepley         /* For now, fields only interpolate themselves */
2969ffe73a53SMatthew G. Knepley         if (fieldI == fieldJ) {
297063a3b9bcSJacob Faibussowitsch           PetscCheck(Nc == NcJ, PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of components in fine space field %" PetscInt_FMT " does not match coarse field %" PetscInt_FMT, Nc, NcJ);
29719566063dSJacob Faibussowitsch           PetscCall(PetscFECreateTabulation(fe, 1, npoints, points, 0, &T));
2972d69c5d34SMatthew G. Knepley           for (i = 0, k = 0; i < fpdim; ++i) {
29739566063dSJacob Faibussowitsch             PetscCall(PetscDualSpaceGetFunctional(Qref, i, &f));
29749566063dSJacob Faibussowitsch             PetscCall(PetscQuadratureGetData(f, NULL, &qNc, &Np, NULL, &qweights));
297563a3b9bcSJacob Faibussowitsch             PetscCheck(qNc == NcJ, PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of components in quadrature %" PetscInt_FMT " does not match coarse field %" PetscInt_FMT, qNc, NcJ);
2976d69c5d34SMatthew G. Knepley             for (p = 0; p < Np; ++p, ++k) {
297736a6d9c0SMatthew G. Knepley               for (j = 0; j < cpdim; ++j) {
2978d172c84bSMatthew G. Knepley                 /*
2979d172c84bSMatthew G. Knepley                    cTotDim:            Total columns in element interpolation matrix, sum of number of dual basis functionals in each field
2980d172c84bSMatthew G. Knepley                    offsetI, offsetJ:   Offsets into the larger element interpolation matrix for different fields
2981d172c84bSMatthew G. Knepley                    fpdim, i, cpdim, j: Dofs for fine and coarse grids, correspond to dual space basis functionals
2982d172c84bSMatthew G. Knepley                    qNC, Nc, Ncj, c:    Number of components in this field
2983d172c84bSMatthew G. Knepley                    Np, p:              Number of quad points in the fine grid functional i
2984d172c84bSMatthew G. Knepley                    k:                  i*Np + p, overall point number for the interpolation
2985d172c84bSMatthew G. Knepley                 */
2986ef0bb6c7SMatthew 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];
298736a6d9c0SMatthew G. Knepley               }
2988d69c5d34SMatthew G. Knepley             }
2989d69c5d34SMatthew G. Knepley           }
29909566063dSJacob Faibussowitsch           PetscCall(PetscTabulationDestroy(&T));
2991ffe73a53SMatthew G. Knepley         }
299297c42addSMatthew G. Knepley       } else if (id == PETSCFV_CLASSID) {
299397c42addSMatthew G. Knepley         PetscFV fv = (PetscFV)obj;
299497c42addSMatthew G. Knepley 
299597c42addSMatthew G. Knepley         /* Evaluate constant function at points */
29969566063dSJacob Faibussowitsch         PetscCall(PetscFVGetNumComponents(fv, &NcJ));
299797c42addSMatthew G. Knepley         cpdim = 1;
299897c42addSMatthew G. Knepley         /* For now, fields only interpolate themselves */
299997c42addSMatthew G. Knepley         if (fieldI == fieldJ) {
300063a3b9bcSJacob Faibussowitsch           PetscCheck(Nc == NcJ, PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of components in fine space field %" PetscInt_FMT " does not match coarse field %" PetscInt_FMT, Nc, NcJ);
300197c42addSMatthew G. Knepley           for (i = 0, k = 0; i < fpdim; ++i) {
30029566063dSJacob Faibussowitsch             PetscCall(PetscDualSpaceGetFunctional(Qref, i, &f));
30039566063dSJacob Faibussowitsch             PetscCall(PetscQuadratureGetData(f, NULL, &qNc, &Np, NULL, &qweights));
300463a3b9bcSJacob Faibussowitsch             PetscCheck(qNc == NcJ, PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of components in quadrature %" PetscInt_FMT " does not match coarse field %" PetscInt_FMT, qNc, NcJ);
300597c42addSMatthew G. Knepley             for (p = 0; p < Np; ++p, ++k) {
300697c42addSMatthew G. Knepley               for (j = 0; j < cpdim; ++j) {
3007458eb97cSMatthew G. Knepley                 for (c = 0; c < Nc; ++c) elemMat[(offsetI + i) * cTotDim + offsetJ + j] += 1.0 * qweights[p * qNc + c];
300897c42addSMatthew G. Knepley               }
300997c42addSMatthew G. Knepley             }
301097c42addSMatthew G. Knepley           }
301197c42addSMatthew G. Knepley         }
301297c42addSMatthew G. Knepley       }
3013d172c84bSMatthew G. Knepley       offsetJ += cpdim;
3014d69c5d34SMatthew G. Knepley     }
3015d172c84bSMatthew G. Knepley     offsetI += fpdim;
30169566063dSJacob Faibussowitsch     PetscCall(PetscFree(points));
3017d69c5d34SMatthew G. Knepley   }
30189566063dSJacob Faibussowitsch   if (mesh->printFEM > 1) PetscCall(DMPrintCellMatrix(0, name, rTotDim, cTotDim, elemMat));
30197f5b169aSMatthew G. Knepley   /* Preallocate matrix */
30207f5b169aSMatthew G. Knepley   {
3021c094ef40SMatthew G. Knepley     Mat          preallocator;
3022c094ef40SMatthew G. Knepley     PetscScalar *vals;
3023c094ef40SMatthew G. Knepley     PetscInt    *cellCIndices, *cellFIndices;
3024c094ef40SMatthew G. Knepley     PetscInt     locRows, locCols, cell;
30257f5b169aSMatthew G. Knepley 
30269566063dSJacob Faibussowitsch     PetscCall(MatGetLocalSize(In, &locRows, &locCols));
30279566063dSJacob Faibussowitsch     PetscCall(MatCreate(PetscObjectComm((PetscObject)In), &preallocator));
30289566063dSJacob Faibussowitsch     PetscCall(MatSetType(preallocator, MATPREALLOCATOR));
30299566063dSJacob Faibussowitsch     PetscCall(MatSetSizes(preallocator, locRows, locCols, PETSC_DETERMINE, PETSC_DETERMINE));
30309566063dSJacob Faibussowitsch     PetscCall(MatSetUp(preallocator));
30319566063dSJacob Faibussowitsch     PetscCall(PetscCalloc3(rTotDim * cTotDim, &vals, cTotDim, &cellCIndices, rTotDim, &cellFIndices));
30327f5b169aSMatthew G. Knepley     for (cell = cStart; cell < cEnd; ++cell) {
3033cf51de39SMatthew G. Knepley       if (isRefined) {
30349566063dSJacob Faibussowitsch         PetscCall(DMPlexMatGetClosureIndicesRefined(dmf, fsection, fglobalSection, dmc, csection, cglobalSection, cell, cellCIndices, cellFIndices));
30359566063dSJacob Faibussowitsch         PetscCall(MatSetValues(preallocator, rTotDim, cellFIndices, cTotDim, cellCIndices, vals, INSERT_VALUES));
3036cf51de39SMatthew G. Knepley       } else {
3037e8e188d2SZach Atkins         PetscCall(DMPlexMatSetClosureGeneral(dmf, fsection, fglobalSection, PETSC_FALSE, dmc, csection, cglobalSection, PETSC_FALSE, preallocator, cell, vals, INSERT_VALUES));
3038cf51de39SMatthew G. Knepley       }
30397f5b169aSMatthew G. Knepley     }
30409566063dSJacob Faibussowitsch     PetscCall(PetscFree3(vals, cellCIndices, cellFIndices));
30419566063dSJacob Faibussowitsch     PetscCall(MatAssemblyBegin(preallocator, MAT_FINAL_ASSEMBLY));
30429566063dSJacob Faibussowitsch     PetscCall(MatAssemblyEnd(preallocator, MAT_FINAL_ASSEMBLY));
30439566063dSJacob Faibussowitsch     PetscCall(MatPreallocatorPreallocate(preallocator, PETSC_TRUE, In));
30449566063dSJacob Faibussowitsch     PetscCall(MatDestroy(&preallocator));
30457f5b169aSMatthew G. Knepley   }
30467f5b169aSMatthew G. Knepley   /* Fill matrix */
30479566063dSJacob Faibussowitsch   PetscCall(MatZeroEntries(In));
3048d69c5d34SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
3049cf51de39SMatthew G. Knepley     if (isRefined) {
30509566063dSJacob Faibussowitsch       PetscCall(DMPlexMatSetClosureRefined(dmf, fsection, fglobalSection, dmc, csection, cglobalSection, In, c, elemMat, INSERT_VALUES));
3051cf51de39SMatthew G. Knepley     } else {
3052e8e188d2SZach Atkins       PetscCall(DMPlexMatSetClosureGeneral(dmf, fsection, fglobalSection, PETSC_FALSE, dmc, csection, cglobalSection, PETSC_FALSE, In, c, elemMat, INSERT_VALUES));
3053cf51de39SMatthew G. Knepley     }
3054d69c5d34SMatthew G. Knepley   }
30559566063dSJacob Faibussowitsch   for (f = 0; f < Nf; ++f) PetscCall(PetscFEDestroy(&feRef[f]));
30569566063dSJacob Faibussowitsch   PetscCall(PetscFree2(feRef, fvRef));
30579566063dSJacob Faibussowitsch   PetscCall(PetscFree(elemMat));
30589566063dSJacob Faibussowitsch   PetscCall(MatAssemblyBegin(In, MAT_FINAL_ASSEMBLY));
30599566063dSJacob Faibussowitsch   PetscCall(MatAssemblyEnd(In, MAT_FINAL_ASSEMBLY));
30609318fe57SMatthew G. Knepley   if (mesh->printFEM > 1) {
30619566063dSJacob Faibussowitsch     PetscCall(PetscPrintf(PetscObjectComm((PetscObject)In), "%s:\n", name));
30622ce66baaSPierre Jolivet     PetscCall(MatFilter(In, 1.0e-10, PETSC_FALSE, PETSC_FALSE));
30639566063dSJacob Faibussowitsch     PetscCall(MatView(In, NULL));
3064d69c5d34SMatthew G. Knepley   }
30659566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_InterpolatorFEM, dmc, dmf, 0, 0));
30663ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
3067d69c5d34SMatthew G. Knepley }
30686c73c22cSMatthew G. Knepley 
3069d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexComputeMassMatrixNested(DM dmc, DM dmf, Mat mass, void *user)
3070d71ae5a4SJacob Faibussowitsch {
3071bd041c0cSMatthew G. Knepley   SETERRQ(PetscObjectComm((PetscObject)dmc), PETSC_ERR_SUP, "Laziness");
3072bd041c0cSMatthew G. Knepley }
3073bd041c0cSMatthew G. Knepley 
307468132eb9SMatthew G. Knepley /*@
30750318f8a0SStefano Zampini   DMPlexComputeInterpolatorGeneral - Form the local portion of the interpolation matrix from the coarse `DM` to a non-nested fine `DM`.
307668132eb9SMatthew G. Knepley 
307768132eb9SMatthew G. Knepley   Input Parameters:
307868132eb9SMatthew G. Knepley + dmf  - The fine mesh
307968132eb9SMatthew G. Knepley . dmc  - The coarse mesh
308068132eb9SMatthew G. Knepley - user - The user context
308168132eb9SMatthew G. Knepley 
308268132eb9SMatthew G. Knepley   Output Parameter:
308368132eb9SMatthew G. Knepley . In - The interpolation matrix
308468132eb9SMatthew G. Knepley 
308568132eb9SMatthew G. Knepley   Level: developer
308668132eb9SMatthew G. Knepley 
3087ae3cf2c1SStefano Zampini .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `DMPlexComputeInterpolatorNested()`
308868132eb9SMatthew G. Knepley @*/
3089d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexComputeInterpolatorGeneral(DM dmc, DM dmf, Mat In, void *user)
3090d71ae5a4SJacob Faibussowitsch {
309164e98e1dSMatthew G. Knepley   DM_Plex     *mesh = (DM_Plex *)dmf->data;
309264e98e1dSMatthew G. Knepley   const char  *name = "Interpolator";
30934ef9d792SMatthew G. Knepley   PetscDS      prob;
3094a0806964SMatthew G. Knepley   Mat          interp;
3095a0806964SMatthew G. Knepley   PetscSection fsection, globalFSection;
3096a0806964SMatthew G. Knepley   PetscSection csection, globalCSection;
3097a0806964SMatthew G. Knepley   PetscInt     locRows, locCols;
30984ef9d792SMatthew G. Knepley   PetscReal   *x, *v0, *J, *invJ, detJ;
30994ef9d792SMatthew G. Knepley   PetscReal   *v0c, *Jc, *invJc, detJc;
31004ef9d792SMatthew G. Knepley   PetscScalar *elemMat;
3101a0806964SMatthew G. Knepley   PetscInt     dim, Nf, field, totDim, cStart, cEnd, cell, ccell, s;
31024ef9d792SMatthew G. Knepley 
31034ef9d792SMatthew G. Knepley   PetscFunctionBegin;
31049566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_InterpolatorFEM, dmc, dmf, 0, 0));
31059566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateDim(dmc, &dim));
31069566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dmc, &prob));
31079566063dSJacob Faibussowitsch   PetscCall(PetscDSGetWorkspace(prob, &x, NULL, NULL, NULL, NULL));
31089566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumFields(prob, &Nf));
31099566063dSJacob Faibussowitsch   PetscCall(PetscMalloc3(dim, &v0, dim * dim, &J, dim * dim, &invJ));
31109566063dSJacob Faibussowitsch   PetscCall(PetscMalloc3(dim, &v0c, dim * dim, &Jc, dim * dim, &invJc));
31119566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dmf, &fsection));
31129566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dmf, &globalFSection));
31139566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dmc, &csection));
31149566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dmc, &globalCSection));
3115a0806964SMatthew G. Knepley   PetscCall(DMPlexGetSimplexOrBoxCells(dmf, 0, &cStart, &cEnd));
31169566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(prob, &totDim));
31179566063dSJacob Faibussowitsch   PetscCall(PetscMalloc1(totDim, &elemMat));
31184ef9d792SMatthew G. Knepley 
3119a0806964SMatthew G. Knepley   PetscCall(MatGetLocalSize(In, &locRows, &locCols));
3120a0806964SMatthew G. Knepley   PetscCall(MatCreate(PetscObjectComm((PetscObject)In), &interp));
3121a0806964SMatthew G. Knepley   PetscCall(MatSetType(interp, MATPREALLOCATOR));
3122a0806964SMatthew G. Knepley   PetscCall(MatSetSizes(interp, locRows, locCols, PETSC_DETERMINE, PETSC_DETERMINE));
3123a0806964SMatthew G. Knepley   PetscCall(MatSetUp(interp));
3124a0806964SMatthew G. Knepley   for (s = 0; s < 2; ++s) {
31254ef9d792SMatthew G. Knepley     for (field = 0; field < Nf; ++field) {
31264ef9d792SMatthew G. Knepley       PetscObject      obj;
31274ef9d792SMatthew G. Knepley       PetscClassId     id;
3128c0d7054bSMatthew G. Knepley       PetscDualSpace   Q = NULL;
3129ef0bb6c7SMatthew G. Knepley       PetscTabulation  T = NULL;
31304ef9d792SMatthew G. Knepley       PetscQuadrature  f;
31314ef9d792SMatthew G. Knepley       const PetscReal *qpoints, *qweights;
3132d0f6233fSMatthew G. Knepley       PetscInt         Nc, qNc, Np, fpdim, off, i, d;
31334ef9d792SMatthew G. Knepley 
3134d0f6233fSMatthew G. Knepley       PetscCall(PetscDSGetFieldOffset(prob, field, &off));
31359566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(prob, field, &obj));
31369566063dSJacob Faibussowitsch       PetscCall(PetscObjectGetClassId(obj, &id));
31374ef9d792SMatthew G. Knepley       if (id == PETSCFE_CLASSID) {
31384ef9d792SMatthew G. Knepley         PetscFE fe = (PetscFE)obj;
31394ef9d792SMatthew G. Knepley 
31409566063dSJacob Faibussowitsch         PetscCall(PetscFEGetDualSpace(fe, &Q));
31419566063dSJacob Faibussowitsch         PetscCall(PetscFEGetNumComponents(fe, &Nc));
3142a0806964SMatthew G. Knepley         if (s) PetscCall(PetscFECreateTabulation(fe, 1, 1, x, 0, &T));
31434ef9d792SMatthew G. Knepley       } else if (id == PETSCFV_CLASSID) {
31444ef9d792SMatthew G. Knepley         PetscFV fv = (PetscFV)obj;
31454ef9d792SMatthew G. Knepley 
31469566063dSJacob Faibussowitsch         PetscCall(PetscFVGetDualSpace(fv, &Q));
31474ef9d792SMatthew G. Knepley         Nc = 1;
314863a3b9bcSJacob Faibussowitsch       } else SETERRQ(PetscObjectComm((PetscObject)dmc), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, field);
31499566063dSJacob Faibussowitsch       PetscCall(PetscDualSpaceGetDimension(Q, &fpdim));
31504ef9d792SMatthew G. Knepley       /* For each fine grid cell */
31514ef9d792SMatthew G. Knepley       for (cell = cStart; cell < cEnd; ++cell) {
31524ef9d792SMatthew G. Knepley         PetscInt *findices, *cindices;
31534ef9d792SMatthew G. Knepley         PetscInt  numFIndices, numCIndices;
31544ef9d792SMatthew G. Knepley 
31559566063dSJacob Faibussowitsch         PetscCall(DMPlexGetClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
31569566063dSJacob Faibussowitsch         PetscCall(DMPlexComputeCellGeometryFEM(dmf, cell, NULL, v0, J, invJ, &detJ));
3157d0f6233fSMatthew G. Knepley         PetscCheck(numFIndices == totDim, PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of fine indices %" PetscInt_FMT " != %" PetscInt_FMT " dual basis vecs", numFIndices, totDim);
31584ef9d792SMatthew G. Knepley         for (i = 0; i < fpdim; ++i) {
31594ef9d792SMatthew G. Knepley           Vec                pointVec;
31604ef9d792SMatthew G. Knepley           PetscScalar       *pV;
316112111d7cSToby Isaac           PetscSF            coarseCellSF = NULL;
31623a93e3b7SToby Isaac           const PetscSFNode *coarseCells;
3163d0f6233fSMatthew G. Knepley           PetscInt           numCoarseCells, cpdim, row = findices[i + off], q, c, j;
31644ef9d792SMatthew G. Knepley 
31654ef9d792SMatthew G. Knepley           /* Get points from the dual basis functional quadrature */
31669566063dSJacob Faibussowitsch           PetscCall(PetscDualSpaceGetFunctional(Q, i, &f));
31679566063dSJacob Faibussowitsch           PetscCall(PetscQuadratureGetData(f, NULL, &qNc, &Np, &qpoints, &qweights));
316863a3b9bcSJacob Faibussowitsch           PetscCheck(qNc == Nc, PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of components in quadrature %" PetscInt_FMT " does not match coarse field %" PetscInt_FMT, qNc, Nc);
31699566063dSJacob Faibussowitsch           PetscCall(VecCreateSeq(PETSC_COMM_SELF, Np * dim, &pointVec));
31709566063dSJacob Faibussowitsch           PetscCall(VecSetBlockSize(pointVec, dim));
31719566063dSJacob Faibussowitsch           PetscCall(VecGetArray(pointVec, &pV));
31724ef9d792SMatthew G. Knepley           for (q = 0; q < Np; ++q) {
3173c330f8ffSToby Isaac             const PetscReal xi0[3] = {-1., -1., -1.};
3174c330f8ffSToby Isaac 
31754ef9d792SMatthew G. Knepley             /* Transform point to real space */
3176c330f8ffSToby Isaac             CoordinatesRefToReal(dim, dim, xi0, v0, J, &qpoints[q * dim], x);
31774ef9d792SMatthew G. Knepley             for (d = 0; d < dim; ++d) pV[q * dim + d] = x[d];
31784ef9d792SMatthew G. Knepley           }
31799566063dSJacob Faibussowitsch           PetscCall(VecRestoreArray(pointVec, &pV));
31804ef9d792SMatthew G. Knepley           /* Get set of coarse cells that overlap points (would like to group points by coarse cell) */
31811555c271SMatthew G. Knepley           /* OPT: Read this out from preallocation information */
31829566063dSJacob Faibussowitsch           PetscCall(DMLocatePoints(dmc, pointVec, DM_POINTLOCATION_NEAREST, &coarseCellSF));
31834ef9d792SMatthew G. Knepley           /* Update preallocation info */
31849566063dSJacob Faibussowitsch           PetscCall(PetscSFGetGraph(coarseCellSF, NULL, &numCoarseCells, NULL, &coarseCells));
31855f80ce2aSJacob Faibussowitsch           PetscCheck(numCoarseCells == Np, PETSC_COMM_SELF, PETSC_ERR_PLIB, "Not all closure points located");
31869566063dSJacob Faibussowitsch           PetscCall(VecGetArray(pointVec, &pV));
31874ef9d792SMatthew G. Knepley           for (ccell = 0; ccell < numCoarseCells; ++ccell) {
3188826eb36dSMatthew G. Knepley             PetscReal       pVReal[3];
3189c330f8ffSToby Isaac             const PetscReal xi0[3] = {-1., -1., -1.};
3190826eb36dSMatthew G. Knepley 
31919566063dSJacob Faibussowitsch             PetscCall(DMPlexGetClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
3192a0806964SMatthew G. Knepley             if (id == PETSCFE_CLASSID) PetscCall(PetscFEGetDimension((PetscFE)obj, &cpdim));
3193a0806964SMatthew G. Knepley             else cpdim = 1;
3194a0806964SMatthew G. Knepley 
3195a0806964SMatthew G. Knepley             if (s) {
31964ef9d792SMatthew G. Knepley               /* Transform points from real space to coarse reference space */
31979566063dSJacob Faibussowitsch               PetscCall(DMPlexComputeCellGeometryFEM(dmc, coarseCells[ccell].index, NULL, v0c, Jc, invJc, &detJc));
3198e2d86523SMatthew G. Knepley               for (d = 0; d < dim; ++d) pVReal[d] = PetscRealPart(pV[ccell * dim + d]);
3199c330f8ffSToby Isaac               CoordinatesRealToRef(dim, dim, xi0, v0c, invJc, pVReal, x);
32004ef9d792SMatthew G. Knepley 
32014ef9d792SMatthew G. Knepley               if (id == PETSCFE_CLASSID) {
32024ef9d792SMatthew G. Knepley                 /* Evaluate coarse basis on contained point */
3203a0806964SMatthew G. Knepley                 PetscCall(PetscFEComputeTabulation((PetscFE)obj, 1, x, 0, T));
32049566063dSJacob Faibussowitsch                 PetscCall(PetscArrayzero(elemMat, cpdim));
32054ef9d792SMatthew G. Knepley                 /* Get elemMat entries by multiplying by weight */
32064ef9d792SMatthew G. Knepley                 for (j = 0; j < cpdim; ++j) {
3207ef0bb6c7SMatthew G. Knepley                   for (c = 0; c < Nc; ++c) elemMat[j] += T->T[0][j * Nc + c] * qweights[ccell * qNc + c];
32084ef9d792SMatthew G. Knepley                 }
32094ef9d792SMatthew G. Knepley               } else {
32104ef9d792SMatthew G. Knepley                 for (j = 0; j < cpdim; ++j) {
32119c3cf19fSMatthew G. Knepley                   for (c = 0; c < Nc; ++c) elemMat[j] += 1.0 * qweights[ccell * qNc + c];
32124ef9d792SMatthew G. Knepley                 }
32134ef9d792SMatthew G. Knepley               }
32149566063dSJacob Faibussowitsch               if (mesh->printFEM > 1) PetscCall(DMPrintCellMatrix(cell, name, 1, numCIndices, elemMat));
3215a0806964SMatthew G. Knepley             }
3216a0806964SMatthew G. Knepley             /* Update interpolator */
3217d0f6233fSMatthew G. Knepley             PetscCheck(numCIndices == totDim, PETSC_COMM_SELF, PETSC_ERR_PLIB, "Number of element matrix columns %" PetscInt_FMT " != %" PetscInt_FMT, numCIndices, totDim);
3218a0806964SMatthew G. Knepley             PetscCall(MatSetValues(interp, 1, &row, cpdim, &cindices[off], elemMat, INSERT_VALUES));
32199566063dSJacob Faibussowitsch             PetscCall(DMPlexRestoreClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
32204ef9d792SMatthew G. Knepley           }
32219566063dSJacob Faibussowitsch           PetscCall(VecRestoreArray(pointVec, &pV));
32229566063dSJacob Faibussowitsch           PetscCall(PetscSFDestroy(&coarseCellSF));
32239566063dSJacob Faibussowitsch           PetscCall(VecDestroy(&pointVec));
32244ef9d792SMatthew G. Knepley         }
32259566063dSJacob Faibussowitsch         PetscCall(DMPlexRestoreClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
32264ef9d792SMatthew G. Knepley       }
3227a0806964SMatthew G. Knepley       if (s && id == PETSCFE_CLASSID) PetscCall(PetscTabulationDestroy(&T));
3228a0806964SMatthew G. Knepley     }
3229a0806964SMatthew G. Knepley     if (!s) {
3230a0806964SMatthew G. Knepley       PetscCall(MatAssemblyBegin(interp, MAT_FINAL_ASSEMBLY));
3231a0806964SMatthew G. Knepley       PetscCall(MatAssemblyEnd(interp, MAT_FINAL_ASSEMBLY));
3232a0806964SMatthew G. Knepley       PetscCall(MatPreallocatorPreallocate(interp, PETSC_TRUE, In));
3233a0806964SMatthew G. Knepley       PetscCall(MatDestroy(&interp));
3234a0806964SMatthew G. Knepley       interp = In;
3235a0806964SMatthew G. Knepley     }
32364ef9d792SMatthew G. Knepley   }
32379566063dSJacob Faibussowitsch   PetscCall(PetscFree3(v0, J, invJ));
32389566063dSJacob Faibussowitsch   PetscCall(PetscFree3(v0c, Jc, invJc));
32399566063dSJacob Faibussowitsch   PetscCall(PetscFree(elemMat));
32409566063dSJacob Faibussowitsch   PetscCall(MatAssemblyBegin(In, MAT_FINAL_ASSEMBLY));
32419566063dSJacob Faibussowitsch   PetscCall(MatAssemblyEnd(In, MAT_FINAL_ASSEMBLY));
32429566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_InterpolatorFEM, dmc, dmf, 0, 0));
32433ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
32444ef9d792SMatthew G. Knepley }
32454ef9d792SMatthew G. Knepley 
324646fa42a0SMatthew G. Knepley /*@
32470318f8a0SStefano Zampini   DMPlexComputeMassMatrixGeneral - Form the local portion of the mass matrix from the coarse `DM` to a non-nested fine `DM`.
3248bd041c0cSMatthew G. Knepley 
3249bd041c0cSMatthew G. Knepley   Input Parameters:
3250bd041c0cSMatthew G. Knepley + dmf  - The fine mesh
3251bd041c0cSMatthew G. Knepley . dmc  - The coarse mesh
3252bd041c0cSMatthew G. Knepley - user - The user context
3253bd041c0cSMatthew G. Knepley 
3254bd041c0cSMatthew G. Knepley   Output Parameter:
3255bd041c0cSMatthew G. Knepley . mass - The mass matrix
3256bd041c0cSMatthew G. Knepley 
3257bd041c0cSMatthew G. Knepley   Level: developer
3258bd041c0cSMatthew G. Knepley 
3259ae3cf2c1SStefano Zampini .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `DMPlexComputeMassMatrixNested()`, `DMPlexComputeInterpolatorNested()`, `DMPlexComputeInterpolatorGeneral()`
3260bd041c0cSMatthew G. Knepley @*/
3261d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexComputeMassMatrixGeneral(DM dmc, DM dmf, Mat mass, void *user)
3262d71ae5a4SJacob Faibussowitsch {
3263bd041c0cSMatthew G. Knepley   DM_Plex     *mesh = (DM_Plex *)dmf->data;
3264bd041c0cSMatthew G. Knepley   const char  *name = "Mass Matrix";
3265bd041c0cSMatthew G. Knepley   PetscDS      prob;
3266bd041c0cSMatthew G. Knepley   PetscSection fsection, csection, globalFSection, globalCSection;
3267e8f14785SLisandro Dalcin   PetscHSetIJ  ht;
3268bd041c0cSMatthew G. Knepley   PetscLayout  rLayout;
3269bd041c0cSMatthew G. Knepley   PetscInt    *dnz, *onz;
3270bd041c0cSMatthew G. Knepley   PetscInt     locRows, rStart, rEnd;
3271bd041c0cSMatthew G. Knepley   PetscReal   *x, *v0, *J, *invJ, detJ;
3272bd041c0cSMatthew G. Knepley   PetscReal   *v0c, *Jc, *invJc, detJc;
3273bd041c0cSMatthew G. Knepley   PetscScalar *elemMat;
3274bd041c0cSMatthew G. Knepley   PetscInt     dim, Nf, field, totDim, cStart, cEnd, cell, ccell;
3275bd041c0cSMatthew G. Knepley 
3276bd041c0cSMatthew G. Knepley   PetscFunctionBegin;
32779566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateDim(dmc, &dim));
32789566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dmc, &prob));
32799566063dSJacob Faibussowitsch   PetscCall(PetscDSGetWorkspace(prob, &x, NULL, NULL, NULL, NULL));
32809566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumFields(prob, &Nf));
32819566063dSJacob Faibussowitsch   PetscCall(PetscMalloc3(dim, &v0, dim * dim, &J, dim * dim, &invJ));
32829566063dSJacob Faibussowitsch   PetscCall(PetscMalloc3(dim, &v0c, dim * dim, &Jc, dim * dim, &invJc));
32839566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dmf, &fsection));
32849566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dmf, &globalFSection));
32859566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dmc, &csection));
32869566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dmc, &globalCSection));
32879566063dSJacob Faibussowitsch   PetscCall(DMPlexGetHeightStratum(dmf, 0, &cStart, &cEnd));
32889566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(prob, &totDim));
32899566063dSJacob Faibussowitsch   PetscCall(PetscMalloc1(totDim, &elemMat));
3290bd041c0cSMatthew G. Knepley 
32919566063dSJacob Faibussowitsch   PetscCall(MatGetLocalSize(mass, &locRows, NULL));
32929566063dSJacob Faibussowitsch   PetscCall(PetscLayoutCreate(PetscObjectComm((PetscObject)mass), &rLayout));
32939566063dSJacob Faibussowitsch   PetscCall(PetscLayoutSetLocalSize(rLayout, locRows));
32949566063dSJacob Faibussowitsch   PetscCall(PetscLayoutSetBlockSize(rLayout, 1));
32959566063dSJacob Faibussowitsch   PetscCall(PetscLayoutSetUp(rLayout));
32969566063dSJacob Faibussowitsch   PetscCall(PetscLayoutGetRange(rLayout, &rStart, &rEnd));
32979566063dSJacob Faibussowitsch   PetscCall(PetscLayoutDestroy(&rLayout));
32989566063dSJacob Faibussowitsch   PetscCall(PetscCalloc2(locRows, &dnz, locRows, &onz));
32999566063dSJacob Faibussowitsch   PetscCall(PetscHSetIJCreate(&ht));
3300bd041c0cSMatthew G. Knepley   for (field = 0; field < Nf; ++field) {
3301bd041c0cSMatthew G. Knepley     PetscObject      obj;
3302bd041c0cSMatthew G. Knepley     PetscClassId     id;
3303bd041c0cSMatthew G. Knepley     PetscQuadrature  quad;
3304bd041c0cSMatthew G. Knepley     const PetscReal *qpoints;
3305bd041c0cSMatthew G. Knepley     PetscInt         Nq, Nc, i, d;
3306bd041c0cSMatthew G. Knepley 
33079566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, field, &obj));
33089566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
33099566063dSJacob Faibussowitsch     if (id == PETSCFE_CLASSID) PetscCall(PetscFEGetQuadrature((PetscFE)obj, &quad));
33109566063dSJacob Faibussowitsch     else PetscCall(PetscFVGetQuadrature((PetscFV)obj, &quad));
33119566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureGetData(quad, NULL, &Nc, &Nq, &qpoints, NULL));
3312bd041c0cSMatthew G. Knepley     /* For each fine grid cell */
3313bd041c0cSMatthew G. Knepley     for (cell = cStart; cell < cEnd; ++cell) {
3314bd041c0cSMatthew G. Knepley       Vec                pointVec;
3315bd041c0cSMatthew G. Knepley       PetscScalar       *pV;
3316bd041c0cSMatthew G. Knepley       PetscSF            coarseCellSF = NULL;
3317bd041c0cSMatthew G. Knepley       const PetscSFNode *coarseCells;
3318bd041c0cSMatthew G. Knepley       PetscInt           numCoarseCells, q, c;
3319bd041c0cSMatthew G. Knepley       PetscInt          *findices, *cindices;
3320bd041c0cSMatthew G. Knepley       PetscInt           numFIndices, numCIndices;
3321bd041c0cSMatthew G. Knepley 
33229566063dSJacob Faibussowitsch       PetscCall(DMPlexGetClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
33239566063dSJacob Faibussowitsch       PetscCall(DMPlexComputeCellGeometryFEM(dmf, cell, NULL, v0, J, invJ, &detJ));
3324bd041c0cSMatthew G. Knepley       /* Get points from the quadrature */
33259566063dSJacob Faibussowitsch       PetscCall(VecCreateSeq(PETSC_COMM_SELF, Nq * dim, &pointVec));
33269566063dSJacob Faibussowitsch       PetscCall(VecSetBlockSize(pointVec, dim));
33279566063dSJacob Faibussowitsch       PetscCall(VecGetArray(pointVec, &pV));
3328bd041c0cSMatthew G. Knepley       for (q = 0; q < Nq; ++q) {
3329c330f8ffSToby Isaac         const PetscReal xi0[3] = {-1., -1., -1.};
3330c330f8ffSToby Isaac 
3331bd041c0cSMatthew G. Knepley         /* Transform point to real space */
3332c330f8ffSToby Isaac         CoordinatesRefToReal(dim, dim, xi0, v0, J, &qpoints[q * dim], x);
3333bd041c0cSMatthew G. Knepley         for (d = 0; d < dim; ++d) pV[q * dim + d] = x[d];
3334bd041c0cSMatthew G. Knepley       }
33359566063dSJacob Faibussowitsch       PetscCall(VecRestoreArray(pointVec, &pV));
3336bd041c0cSMatthew G. Knepley       /* Get set of coarse cells that overlap points (would like to group points by coarse cell) */
33379566063dSJacob Faibussowitsch       PetscCall(DMLocatePoints(dmc, pointVec, DM_POINTLOCATION_NEAREST, &coarseCellSF));
33389566063dSJacob Faibussowitsch       PetscCall(PetscSFViewFromOptions(coarseCellSF, NULL, "-interp_sf_view"));
3339bd041c0cSMatthew G. Knepley       /* Update preallocation info */
33409566063dSJacob Faibussowitsch       PetscCall(PetscSFGetGraph(coarseCellSF, NULL, &numCoarseCells, NULL, &coarseCells));
33415f80ce2aSJacob Faibussowitsch       PetscCheck(numCoarseCells == Nq, PETSC_COMM_SELF, PETSC_ERR_PLIB, "Not all closure points located");
3342bd041c0cSMatthew G. Knepley       {
3343e8f14785SLisandro Dalcin         PetscHashIJKey key;
3344e8f14785SLisandro Dalcin         PetscBool      missing;
3345bd041c0cSMatthew G. Knepley 
3346bd041c0cSMatthew G. Knepley         for (i = 0; i < numFIndices; ++i) {
3347e8f14785SLisandro Dalcin           key.i = findices[i];
3348e8f14785SLisandro Dalcin           if (key.i >= 0) {
3349bd041c0cSMatthew G. Knepley             /* Get indices for coarse elements */
3350bd041c0cSMatthew G. Knepley             for (ccell = 0; ccell < numCoarseCells; ++ccell) {
33519566063dSJacob Faibussowitsch               PetscCall(DMPlexGetClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
3352bd041c0cSMatthew G. Knepley               for (c = 0; c < numCIndices; ++c) {
3353e8f14785SLisandro Dalcin                 key.j = cindices[c];
3354e8f14785SLisandro Dalcin                 if (key.j < 0) continue;
33559566063dSJacob Faibussowitsch                 PetscCall(PetscHSetIJQueryAdd(ht, key, &missing));
3356bd041c0cSMatthew G. Knepley                 if (missing) {
3357e8f14785SLisandro Dalcin                   if ((key.j >= rStart) && (key.j < rEnd)) ++dnz[key.i - rStart];
3358e8f14785SLisandro Dalcin                   else ++onz[key.i - rStart];
3359bd041c0cSMatthew G. Knepley                 }
3360bd041c0cSMatthew G. Knepley               }
33619566063dSJacob Faibussowitsch               PetscCall(DMPlexRestoreClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
3362bd041c0cSMatthew G. Knepley             }
3363bd041c0cSMatthew G. Knepley           }
3364bd041c0cSMatthew G. Knepley         }
3365bd041c0cSMatthew G. Knepley       }
33669566063dSJacob Faibussowitsch       PetscCall(PetscSFDestroy(&coarseCellSF));
33679566063dSJacob Faibussowitsch       PetscCall(VecDestroy(&pointVec));
33689566063dSJacob Faibussowitsch       PetscCall(DMPlexRestoreClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
3369bd041c0cSMatthew G. Knepley     }
3370bd041c0cSMatthew G. Knepley   }
33719566063dSJacob Faibussowitsch   PetscCall(PetscHSetIJDestroy(&ht));
33729566063dSJacob Faibussowitsch   PetscCall(MatXAIJSetPreallocation(mass, 1, dnz, onz, NULL, NULL));
33739566063dSJacob Faibussowitsch   PetscCall(MatSetOption(mass, MAT_NEW_NONZERO_ALLOCATION_ERR, PETSC_TRUE));
33749566063dSJacob Faibussowitsch   PetscCall(PetscFree2(dnz, onz));
3375bd041c0cSMatthew G. Knepley   for (field = 0; field < Nf; ++field) {
3376bd041c0cSMatthew G. Knepley     PetscObject      obj;
3377bd041c0cSMatthew G. Knepley     PetscClassId     id;
3378ef0bb6c7SMatthew G. Knepley     PetscTabulation  T, Tfine;
3379bd041c0cSMatthew G. Knepley     PetscQuadrature  quad;
3380bd041c0cSMatthew G. Knepley     const PetscReal *qpoints, *qweights;
3381bd041c0cSMatthew G. Knepley     PetscInt         Nq, Nc, i, d;
3382bd041c0cSMatthew G. Knepley 
33839566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, field, &obj));
33849566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
3385ef0bb6c7SMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
33869566063dSJacob Faibussowitsch       PetscCall(PetscFEGetQuadrature((PetscFE)obj, &quad));
33879566063dSJacob Faibussowitsch       PetscCall(PetscFEGetCellTabulation((PetscFE)obj, 1, &Tfine));
33889566063dSJacob Faibussowitsch       PetscCall(PetscFECreateTabulation((PetscFE)obj, 1, 1, x, 0, &T));
3389ef0bb6c7SMatthew G. Knepley     } else {
33909566063dSJacob Faibussowitsch       PetscCall(PetscFVGetQuadrature((PetscFV)obj, &quad));
3391ef0bb6c7SMatthew G. Knepley     }
33929566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureGetData(quad, NULL, &Nc, &Nq, &qpoints, &qweights));
3393bd041c0cSMatthew G. Knepley     /* For each fine grid cell */
3394bd041c0cSMatthew G. Knepley     for (cell = cStart; cell < cEnd; ++cell) {
3395bd041c0cSMatthew G. Knepley       Vec                pointVec;
3396bd041c0cSMatthew G. Knepley       PetscScalar       *pV;
3397bd041c0cSMatthew G. Knepley       PetscSF            coarseCellSF = NULL;
3398bd041c0cSMatthew G. Knepley       const PetscSFNode *coarseCells;
3399bd041c0cSMatthew G. Knepley       PetscInt           numCoarseCells, cpdim, q, c, j;
3400bd041c0cSMatthew G. Knepley       PetscInt          *findices, *cindices;
3401bd041c0cSMatthew G. Knepley       PetscInt           numFIndices, numCIndices;
3402bd041c0cSMatthew G. Knepley 
34039566063dSJacob Faibussowitsch       PetscCall(DMPlexGetClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
34049566063dSJacob Faibussowitsch       PetscCall(DMPlexComputeCellGeometryFEM(dmf, cell, NULL, v0, J, invJ, &detJ));
3405bd041c0cSMatthew G. Knepley       /* Get points from the quadrature */
34069566063dSJacob Faibussowitsch       PetscCall(VecCreateSeq(PETSC_COMM_SELF, Nq * dim, &pointVec));
34079566063dSJacob Faibussowitsch       PetscCall(VecSetBlockSize(pointVec, dim));
34089566063dSJacob Faibussowitsch       PetscCall(VecGetArray(pointVec, &pV));
3409bd041c0cSMatthew G. Knepley       for (q = 0; q < Nq; ++q) {
3410c330f8ffSToby Isaac         const PetscReal xi0[3] = {-1., -1., -1.};
3411c330f8ffSToby Isaac 
3412bd041c0cSMatthew G. Knepley         /* Transform point to real space */
3413c330f8ffSToby Isaac         CoordinatesRefToReal(dim, dim, xi0, v0, J, &qpoints[q * dim], x);
3414bd041c0cSMatthew G. Knepley         for (d = 0; d < dim; ++d) pV[q * dim + d] = x[d];
3415bd041c0cSMatthew G. Knepley       }
34169566063dSJacob Faibussowitsch       PetscCall(VecRestoreArray(pointVec, &pV));
3417bd041c0cSMatthew G. Knepley       /* Get set of coarse cells that overlap points (would like to group points by coarse cell) */
34189566063dSJacob Faibussowitsch       PetscCall(DMLocatePoints(dmc, pointVec, DM_POINTLOCATION_NEAREST, &coarseCellSF));
3419bd041c0cSMatthew G. Knepley       /* Update matrix */
34209566063dSJacob Faibussowitsch       PetscCall(PetscSFGetGraph(coarseCellSF, NULL, &numCoarseCells, NULL, &coarseCells));
34215f80ce2aSJacob Faibussowitsch       PetscCheck(numCoarseCells == Nq, PETSC_COMM_SELF, PETSC_ERR_PLIB, "Not all closure points located");
34229566063dSJacob Faibussowitsch       PetscCall(VecGetArray(pointVec, &pV));
3423bd041c0cSMatthew G. Knepley       for (ccell = 0; ccell < numCoarseCells; ++ccell) {
3424bd041c0cSMatthew G. Knepley         PetscReal       pVReal[3];
3425c330f8ffSToby Isaac         const PetscReal xi0[3] = {-1., -1., -1.};
3426c330f8ffSToby Isaac 
34279566063dSJacob Faibussowitsch         PetscCall(DMPlexGetClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
3428bd041c0cSMatthew G. Knepley         /* Transform points from real space to coarse reference space */
34299566063dSJacob Faibussowitsch         PetscCall(DMPlexComputeCellGeometryFEM(dmc, coarseCells[ccell].index, NULL, v0c, Jc, invJc, &detJc));
3430bd041c0cSMatthew G. Knepley         for (d = 0; d < dim; ++d) pVReal[d] = PetscRealPart(pV[ccell * dim + d]);
3431c330f8ffSToby Isaac         CoordinatesRealToRef(dim, dim, xi0, v0c, invJc, pVReal, x);
3432bd041c0cSMatthew G. Knepley 
3433bd041c0cSMatthew G. Knepley         if (id == PETSCFE_CLASSID) {
3434bd041c0cSMatthew G. Knepley           PetscFE fe = (PetscFE)obj;
3435bd041c0cSMatthew G. Knepley 
3436bd041c0cSMatthew G. Knepley           /* Evaluate coarse basis on contained point */
34379566063dSJacob Faibussowitsch           PetscCall(PetscFEGetDimension(fe, &cpdim));
34389566063dSJacob Faibussowitsch           PetscCall(PetscFEComputeTabulation(fe, 1, x, 0, T));
3439bd041c0cSMatthew G. Knepley           /* Get elemMat entries by multiplying by weight */
3440bd041c0cSMatthew G. Knepley           for (i = 0; i < numFIndices; ++i) {
34419566063dSJacob Faibussowitsch             PetscCall(PetscArrayzero(elemMat, cpdim));
3442bd041c0cSMatthew G. Knepley             for (j = 0; j < cpdim; ++j) {
3443ef0bb6c7SMatthew 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;
3444bd041c0cSMatthew G. Knepley             }
3445bd041c0cSMatthew G. Knepley             /* Update interpolator */
34469566063dSJacob Faibussowitsch             if (mesh->printFEM > 1) PetscCall(DMPrintCellMatrix(cell, name, 1, numCIndices, elemMat));
344763a3b9bcSJacob Faibussowitsch             PetscCheck(numCIndices == cpdim, PETSC_COMM_SELF, PETSC_ERR_PLIB, "Number of element matrix columns %" PetscInt_FMT " != %" PetscInt_FMT, numCIndices, cpdim);
34489566063dSJacob Faibussowitsch             PetscCall(MatSetValues(mass, 1, &findices[i], numCIndices, cindices, elemMat, ADD_VALUES));
3449bd041c0cSMatthew G. Knepley           }
3450bd041c0cSMatthew G. Knepley         } else {
3451bd041c0cSMatthew G. Knepley           cpdim = 1;
3452bd041c0cSMatthew G. Knepley           for (i = 0; i < numFIndices; ++i) {
34539566063dSJacob Faibussowitsch             PetscCall(PetscArrayzero(elemMat, cpdim));
3454bd041c0cSMatthew G. Knepley             for (j = 0; j < cpdim; ++j) {
3455bd041c0cSMatthew G. Knepley               for (c = 0; c < Nc; ++c) elemMat[j] += 1.0 * 1.0 * qweights[ccell * Nc + c] * detJ;
3456bd041c0cSMatthew G. Knepley             }
3457bd041c0cSMatthew G. Knepley             /* Update interpolator */
34589566063dSJacob Faibussowitsch             if (mesh->printFEM > 1) PetscCall(DMPrintCellMatrix(cell, name, 1, numCIndices, elemMat));
345963a3b9bcSJacob Faibussowitsch             PetscCall(PetscPrintf(PETSC_COMM_SELF, "Nq: %" PetscInt_FMT " %" PetscInt_FMT " Nf: %" PetscInt_FMT " %" PetscInt_FMT " Nc: %" PetscInt_FMT " %" PetscInt_FMT "\n", ccell, Nq, i, numFIndices, j, numCIndices));
346063a3b9bcSJacob Faibussowitsch             PetscCheck(numCIndices == cpdim, PETSC_COMM_SELF, PETSC_ERR_PLIB, "Number of element matrix columns %" PetscInt_FMT " != %" PetscInt_FMT, numCIndices, cpdim);
34619566063dSJacob Faibussowitsch             PetscCall(MatSetValues(mass, 1, &findices[i], numCIndices, cindices, elemMat, ADD_VALUES));
3462bd041c0cSMatthew G. Knepley           }
3463bd041c0cSMatthew G. Knepley         }
34649566063dSJacob Faibussowitsch         PetscCall(DMPlexRestoreClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
3465bd041c0cSMatthew G. Knepley       }
34669566063dSJacob Faibussowitsch       PetscCall(VecRestoreArray(pointVec, &pV));
34679566063dSJacob Faibussowitsch       PetscCall(PetscSFDestroy(&coarseCellSF));
34689566063dSJacob Faibussowitsch       PetscCall(VecDestroy(&pointVec));
34699566063dSJacob Faibussowitsch       PetscCall(DMPlexRestoreClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
3470bd041c0cSMatthew G. Knepley     }
34719566063dSJacob Faibussowitsch     if (id == PETSCFE_CLASSID) PetscCall(PetscTabulationDestroy(&T));
3472bd041c0cSMatthew G. Knepley   }
34739566063dSJacob Faibussowitsch   PetscCall(PetscFree3(v0, J, invJ));
34749566063dSJacob Faibussowitsch   PetscCall(PetscFree3(v0c, Jc, invJc));
34759566063dSJacob Faibussowitsch   PetscCall(PetscFree(elemMat));
34769566063dSJacob Faibussowitsch   PetscCall(MatAssemblyBegin(mass, MAT_FINAL_ASSEMBLY));
34779566063dSJacob Faibussowitsch   PetscCall(MatAssemblyEnd(mass, MAT_FINAL_ASSEMBLY));
34783ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
3479bd041c0cSMatthew G. Knepley }
3480bd041c0cSMatthew G. Knepley 
3481bd041c0cSMatthew G. Knepley /*@
348246fa42a0SMatthew G. Knepley   DMPlexComputeInjectorFEM - Compute a mapping from coarse unknowns to fine unknowns
348346fa42a0SMatthew G. Knepley 
348446fa42a0SMatthew G. Knepley   Input Parameters:
348546fa42a0SMatthew G. Knepley + dmc  - The coarse mesh
348660225df5SJacob Faibussowitsch . dmf  - The fine mesh
348746fa42a0SMatthew G. Knepley - user - The user context
348846fa42a0SMatthew G. Knepley 
348946fa42a0SMatthew G. Knepley   Output Parameter:
349046fa42a0SMatthew G. Knepley . sc - The mapping
349146fa42a0SMatthew G. Knepley 
349246fa42a0SMatthew G. Knepley   Level: developer
349346fa42a0SMatthew G. Knepley 
3494ae3cf2c1SStefano Zampini .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `DMPlexComputeInterpolatorNested()`
349546fa42a0SMatthew G. Knepley @*/
3496d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexComputeInjectorFEM(DM dmc, DM dmf, VecScatter *sc, void *user)
3497d71ae5a4SJacob Faibussowitsch {
3498e9d4ef1bSMatthew G. Knepley   PetscDS      prob;
34997c927364SMatthew G. Knepley   PetscFE     *feRef;
350097c42addSMatthew G. Knepley   PetscFV     *fvRef;
35017c927364SMatthew G. Knepley   Vec          fv, cv;
35027c927364SMatthew G. Knepley   IS           fis, cis;
35037c927364SMatthew G. Knepley   PetscSection fsection, fglobalSection, csection, cglobalSection;
35047c927364SMatthew G. Knepley   PetscInt    *cmap, *cellCIndices, *cellFIndices, *cindices, *findices;
3505485ad865SMatthew G. Knepley   PetscInt     cTotDim, fTotDim = 0, Nf, f, field, cStart, cEnd, c, dim, d, startC, endC, offsetC, offsetF, m;
35066f3d3cbcSMatthew G. Knepley   PetscBool   *needAvg;
35077c927364SMatthew G. Knepley 
35087c927364SMatthew G. Knepley   PetscFunctionBegin;
35099566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_InjectorFEM, dmc, dmf, 0, 0));
35109566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dmf, &dim));
35119566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dmf, &fsection));
35129566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dmf, &fglobalSection));
35139566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dmc, &csection));
35149566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dmc, &cglobalSection));
35159566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetNumFields(fsection, &Nf));
35169566063dSJacob Faibussowitsch   PetscCall(DMPlexGetSimplexOrBoxCells(dmc, 0, &cStart, &cEnd));
35179566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dmc, &prob));
35189566063dSJacob Faibussowitsch   PetscCall(PetscCalloc3(Nf, &feRef, Nf, &fvRef, Nf, &needAvg));
35197c927364SMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
352097c42addSMatthew G. Knepley     PetscObject  obj;
352197c42addSMatthew G. Knepley     PetscClassId id;
3522aa7890ccSMatthew G. Knepley     PetscInt     fNb = 0, Nc = 0;
35237c927364SMatthew G. Knepley 
35249566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, f, &obj));
35259566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
352697c42addSMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
352797c42addSMatthew G. Knepley       PetscFE    fe = (PetscFE)obj;
35286f3d3cbcSMatthew G. Knepley       PetscSpace sp;
35299b2fc754SMatthew G. Knepley       PetscInt   maxDegree;
353097c42addSMatthew G. Knepley 
35319566063dSJacob Faibussowitsch       PetscCall(PetscFERefine(fe, &feRef[f]));
35329566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDimension(feRef[f], &fNb));
35339566063dSJacob Faibussowitsch       PetscCall(PetscFEGetNumComponents(fe, &Nc));
35349566063dSJacob Faibussowitsch       PetscCall(PetscFEGetBasisSpace(fe, &sp));
35359566063dSJacob Faibussowitsch       PetscCall(PetscSpaceGetDegree(sp, NULL, &maxDegree));
35369b2fc754SMatthew G. Knepley       if (!maxDegree) needAvg[f] = PETSC_TRUE;
353797c42addSMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
353897c42addSMatthew G. Knepley       PetscFV        fv = (PetscFV)obj;
353997c42addSMatthew G. Knepley       PetscDualSpace Q;
354097c42addSMatthew G. Knepley 
35419566063dSJacob Faibussowitsch       PetscCall(PetscFVRefine(fv, &fvRef[f]));
35429566063dSJacob Faibussowitsch       PetscCall(PetscFVGetDualSpace(fvRef[f], &Q));
35439566063dSJacob Faibussowitsch       PetscCall(PetscDualSpaceGetDimension(Q, &fNb));
35449566063dSJacob Faibussowitsch       PetscCall(PetscFVGetNumComponents(fv, &Nc));
35456f3d3cbcSMatthew G. Knepley       needAvg[f] = PETSC_TRUE;
354697c42addSMatthew G. Knepley     }
3547d172c84bSMatthew G. Knepley     fTotDim += fNb;
35487c927364SMatthew G. Knepley   }
35499566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(prob, &cTotDim));
35509566063dSJacob Faibussowitsch   PetscCall(PetscMalloc1(cTotDim, &cmap));
35517c927364SMatthew G. Knepley   for (field = 0, offsetC = 0, offsetF = 0; field < Nf; ++field) {
35527c927364SMatthew G. Knepley     PetscFE        feC;
355397c42addSMatthew G. Knepley     PetscFV        fvC;
35547c927364SMatthew G. Knepley     PetscDualSpace QF, QC;
3555d172c84bSMatthew G. Knepley     PetscInt       order = -1, NcF, NcC, fpdim, cpdim;
35567c927364SMatthew G. Knepley 
355797c42addSMatthew G. Knepley     if (feRef[field]) {
35589566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(prob, field, (PetscObject *)&feC));
35599566063dSJacob Faibussowitsch       PetscCall(PetscFEGetNumComponents(feC, &NcC));
35609566063dSJacob Faibussowitsch       PetscCall(PetscFEGetNumComponents(feRef[field], &NcF));
35619566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDualSpace(feRef[field], &QF));
35629566063dSJacob Faibussowitsch       PetscCall(PetscDualSpaceGetOrder(QF, &order));
35639566063dSJacob Faibussowitsch       PetscCall(PetscDualSpaceGetDimension(QF, &fpdim));
35649566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDualSpace(feC, &QC));
35659566063dSJacob Faibussowitsch       PetscCall(PetscDualSpaceGetDimension(QC, &cpdim));
356697c42addSMatthew G. Knepley     } else {
35679566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(prob, field, (PetscObject *)&fvC));
35689566063dSJacob Faibussowitsch       PetscCall(PetscFVGetNumComponents(fvC, &NcC));
35699566063dSJacob Faibussowitsch       PetscCall(PetscFVGetNumComponents(fvRef[field], &NcF));
35709566063dSJacob Faibussowitsch       PetscCall(PetscFVGetDualSpace(fvRef[field], &QF));
35719566063dSJacob Faibussowitsch       PetscCall(PetscDualSpaceGetDimension(QF, &fpdim));
35729566063dSJacob Faibussowitsch       PetscCall(PetscFVGetDualSpace(fvC, &QC));
35739566063dSJacob Faibussowitsch       PetscCall(PetscDualSpaceGetDimension(QC, &cpdim));
357497c42addSMatthew G. Knepley     }
357563a3b9bcSJacob Faibussowitsch     PetscCheck(NcF == NcC, PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of components in fine space field %" PetscInt_FMT " does not match coarse field %" PetscInt_FMT, NcF, NcC);
35767c927364SMatthew G. Knepley     for (c = 0; c < cpdim; ++c) {
35777c927364SMatthew G. Knepley       PetscQuadrature  cfunc;
3578d172c84bSMatthew G. Knepley       const PetscReal *cqpoints, *cqweights;
3579d172c84bSMatthew G. Knepley       PetscInt         NqcC, NpC;
358097c42addSMatthew G. Knepley       PetscBool        found = PETSC_FALSE;
35817c927364SMatthew G. Knepley 
35829566063dSJacob Faibussowitsch       PetscCall(PetscDualSpaceGetFunctional(QC, c, &cfunc));
35839566063dSJacob Faibussowitsch       PetscCall(PetscQuadratureGetData(cfunc, NULL, &NqcC, &NpC, &cqpoints, &cqweights));
358463a3b9bcSJacob Faibussowitsch       PetscCheck(NqcC == NcC, PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of quadrature components %" PetscInt_FMT " must match number of field components %" PetscInt_FMT, NqcC, NcC);
35851dca8a05SBarry Smith       PetscCheck(NpC == 1 || !feRef[field], PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Do not know how to do injection for moments");
35867c927364SMatthew G. Knepley       for (f = 0; f < fpdim; ++f) {
35877c927364SMatthew G. Knepley         PetscQuadrature  ffunc;
3588d172c84bSMatthew G. Knepley         const PetscReal *fqpoints, *fqweights;
35897c927364SMatthew G. Knepley         PetscReal        sum = 0.0;
3590d172c84bSMatthew G. Knepley         PetscInt         NqcF, NpF;
35917c927364SMatthew G. Knepley 
35929566063dSJacob Faibussowitsch         PetscCall(PetscDualSpaceGetFunctional(QF, f, &ffunc));
35939566063dSJacob Faibussowitsch         PetscCall(PetscQuadratureGetData(ffunc, NULL, &NqcF, &NpF, &fqpoints, &fqweights));
359463a3b9bcSJacob Faibussowitsch         PetscCheck(NqcF == NcF, PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of quadrature components %" PetscInt_FMT " must match number of field components %" PetscInt_FMT, NqcF, NcF);
35957c927364SMatthew G. Knepley         if (NpC != NpF) continue;
35967c927364SMatthew G. Knepley         for (d = 0; d < dim; ++d) sum += PetscAbsReal(cqpoints[d] - fqpoints[d]);
35977c927364SMatthew G. Knepley         if (sum > 1.0e-9) continue;
3598d172c84bSMatthew G. Knepley         for (d = 0; d < NcC; ++d) sum += PetscAbsReal(cqweights[d] * fqweights[d]);
3599d172c84bSMatthew G. Knepley         if (sum < 1.0e-9) continue;
3600d172c84bSMatthew G. Knepley         cmap[offsetC + c] = offsetF + f;
360197c42addSMatthew G. Knepley         found             = PETSC_TRUE;
36027c927364SMatthew G. Knepley         break;
36037c927364SMatthew G. Knepley       }
360497c42addSMatthew G. Knepley       if (!found) {
360597c42addSMatthew G. Knepley         /* TODO We really want the average here, but some asshole put VecScatter in the interface */
3606d172c84bSMatthew G. Knepley         if (fvRef[field] || (feRef[field] && order == 0)) {
3607d172c84bSMatthew G. Knepley           cmap[offsetC + c] = offsetF + 0;
360897c42addSMatthew G. Knepley         } else SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Could not locate matching functional for injection");
360997c42addSMatthew G. Knepley       }
36107c927364SMatthew G. Knepley     }
3611d172c84bSMatthew G. Knepley     offsetC += cpdim;
3612d172c84bSMatthew G. Knepley     offsetF += fpdim;
36137c927364SMatthew G. Knepley   }
36149371c9d4SSatish Balay   for (f = 0; f < Nf; ++f) {
36159371c9d4SSatish Balay     PetscCall(PetscFEDestroy(&feRef[f]));
36169371c9d4SSatish Balay     PetscCall(PetscFVDestroy(&fvRef[f]));
36179371c9d4SSatish Balay   }
36189566063dSJacob Faibussowitsch   PetscCall(PetscFree3(feRef, fvRef, needAvg));
36197c927364SMatthew G. Knepley 
36209566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalVector(dmf, &fv));
36219566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalVector(dmc, &cv));
36229566063dSJacob Faibussowitsch   PetscCall(VecGetOwnershipRange(cv, &startC, &endC));
36239566063dSJacob Faibussowitsch   PetscCall(PetscSectionGetConstrainedStorageSize(cglobalSection, &m));
36249566063dSJacob Faibussowitsch   PetscCall(PetscMalloc2(cTotDim, &cellCIndices, fTotDim, &cellFIndices));
36259566063dSJacob Faibussowitsch   PetscCall(PetscMalloc1(m, &cindices));
36269566063dSJacob Faibussowitsch   PetscCall(PetscMalloc1(m, &findices));
36277c927364SMatthew G. Knepley   for (d = 0; d < m; ++d) cindices[d] = findices[d] = -1;
36287c927364SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
36299566063dSJacob Faibussowitsch     PetscCall(DMPlexMatGetClosureIndicesRefined(dmf, fsection, fglobalSection, dmc, csection, cglobalSection, c, cellCIndices, cellFIndices));
36307c927364SMatthew G. Knepley     for (d = 0; d < cTotDim; ++d) {
36310bd915a7SMatthew G. Knepley       if ((cellCIndices[d] < startC) || (cellCIndices[d] >= endC)) continue;
3632d2457c26SMatthew G. Knepley       PetscCheck(!(findices[cellCIndices[d] - startC] >= 0) || !(findices[cellCIndices[d] - startC] != cellFIndices[cmap[d]]), PETSC_COMM_SELF, PETSC_ERR_PLIB, "Cell %" PetscInt_FMT " Coarse dof %" PetscInt_FMT " maps to both %" PetscInt_FMT " and %" PetscInt_FMT, c, cindices[cellCIndices[d] - startC], findices[cellCIndices[d] - startC], cellFIndices[cmap[d]]);
36337c927364SMatthew G. Knepley       cindices[cellCIndices[d] - startC] = cellCIndices[d];
36347c927364SMatthew G. Knepley       findices[cellCIndices[d] - startC] = cellFIndices[cmap[d]];
36357c927364SMatthew G. Knepley     }
36367c927364SMatthew G. Knepley   }
36379566063dSJacob Faibussowitsch   PetscCall(PetscFree(cmap));
36389566063dSJacob Faibussowitsch   PetscCall(PetscFree2(cellCIndices, cellFIndices));
36397c927364SMatthew G. Knepley 
36409566063dSJacob Faibussowitsch   PetscCall(ISCreateGeneral(PETSC_COMM_SELF, m, cindices, PETSC_OWN_POINTER, &cis));
36419566063dSJacob Faibussowitsch   PetscCall(ISCreateGeneral(PETSC_COMM_SELF, m, findices, PETSC_OWN_POINTER, &fis));
36429566063dSJacob Faibussowitsch   PetscCall(VecScatterCreate(cv, cis, fv, fis, sc));
36439566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&cis));
36449566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&fis));
36459566063dSJacob Faibussowitsch   PetscCall(DMRestoreGlobalVector(dmf, &fv));
36469566063dSJacob Faibussowitsch   PetscCall(DMRestoreGlobalVector(dmc, &cv));
36479566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_InjectorFEM, dmc, dmf, 0, 0));
36483ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
3649cb1e1211SMatthew G Knepley }
3650a1cf66bbSMatthew G. Knepley 
36512f856554SMatthew G. Knepley /*@C
36522f856554SMatthew G. Knepley   DMPlexGetCellFields - Retrieve the field values values for a chunk of cells
36532f856554SMatthew G. Knepley 
36542f856554SMatthew G. Knepley   Input Parameters:
3655a1cb98faSBarry Smith + dm     - The `DM`
36562f856554SMatthew G. Knepley . cellIS - The cells to include
36572f856554SMatthew G. Knepley . locX   - A local vector with the solution fields
36582f856554SMatthew G. Knepley . locX_t - A local vector with solution field time derivatives, or NULL
36592f856554SMatthew G. Knepley - locA   - A local vector with auxiliary fields, or NULL
36602f856554SMatthew G. Knepley 
36612f856554SMatthew G. Knepley   Output Parameters:
36622f856554SMatthew G. Knepley + u   - The field coefficients
36632f856554SMatthew G. Knepley . u_t - The fields derivative coefficients
36642f856554SMatthew G. Knepley - a   - The auxiliary field coefficients
36652f856554SMatthew G. Knepley 
36662f856554SMatthew G. Knepley   Level: developer
36672f856554SMatthew G. Knepley 
36681cc06b55SBarry Smith .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `DMPlexGetFaceFields()`
36692f856554SMatthew G. Knepley @*/
3670d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexGetCellFields(DM dm, IS cellIS, Vec locX, Vec locX_t, Vec locA, PetscScalar **u, PetscScalar **u_t, PetscScalar **a)
3671d71ae5a4SJacob Faibussowitsch {
36722f856554SMatthew G. Knepley   DM              plex, plexA = NULL;
3673a6e0b375SMatthew G. Knepley   DMEnclosureType encAux;
36742f856554SMatthew G. Knepley   PetscSection    section, sectionAux;
36752f856554SMatthew G. Knepley   PetscDS         prob;
36762f856554SMatthew G. Knepley   const PetscInt *cells;
36772f856554SMatthew G. Knepley   PetscInt        cStart, cEnd, numCells, totDim, totDimAux, c;
36782f856554SMatthew G. Knepley 
36792f856554SMatthew G. Knepley   PetscFunctionBegin;
36802f856554SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
3681064a246eSJacob Faibussowitsch   PetscValidHeaderSpecific(locX, VEC_CLASSID, 3);
3682ad540459SPierre Jolivet   if (locX_t) PetscValidHeaderSpecific(locX_t, VEC_CLASSID, 4);
3683ad540459SPierre Jolivet   if (locA) PetscValidHeaderSpecific(locA, VEC_CLASSID, 5);
36844f572ea9SToby Isaac   PetscAssertPointer(u, 6);
36854f572ea9SToby Isaac   PetscAssertPointer(u_t, 7);
36864f572ea9SToby Isaac   PetscAssertPointer(a, 8);
36879566063dSJacob Faibussowitsch   PetscCall(DMPlexConvertPlex(dm, &plex, PETSC_FALSE));
36889566063dSJacob Faibussowitsch   PetscCall(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
36899566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
369007218a29SMatthew G. Knepley   PetscCall(DMGetCellDS(dm, cells ? cells[cStart] : cStart, &prob, NULL));
36919566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(prob, &totDim));
36922f856554SMatthew G. Knepley   if (locA) {
36932f856554SMatthew G. Knepley     DM      dmAux;
36942f856554SMatthew G. Knepley     PetscDS probAux;
36952f856554SMatthew G. Knepley 
36969566063dSJacob Faibussowitsch     PetscCall(VecGetDM(locA, &dmAux));
36979566063dSJacob Faibussowitsch     PetscCall(DMGetEnclosureRelation(dmAux, dm, &encAux));
36989566063dSJacob Faibussowitsch     PetscCall(DMPlexConvertPlex(dmAux, &plexA, PETSC_FALSE));
36999566063dSJacob Faibussowitsch     PetscCall(DMGetLocalSection(dmAux, &sectionAux));
37009566063dSJacob Faibussowitsch     PetscCall(DMGetDS(dmAux, &probAux));
37019566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalDimension(probAux, &totDimAux));
37022f856554SMatthew G. Knepley   }
37032f856554SMatthew G. Knepley   numCells = cEnd - cStart;
37049566063dSJacob Faibussowitsch   PetscCall(DMGetWorkArray(dm, numCells * totDim, MPIU_SCALAR, u));
37059371c9d4SSatish Balay   if (locX_t) PetscCall(DMGetWorkArray(dm, numCells * totDim, MPIU_SCALAR, u_t));
3706ad540459SPierre Jolivet   else *u_t = NULL;
37079371c9d4SSatish Balay   if (locA) PetscCall(DMGetWorkArray(dm, numCells * totDimAux, MPIU_SCALAR, a));
3708ad540459SPierre Jolivet   else *a = NULL;
37092f856554SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
37102f856554SMatthew G. Knepley     const PetscInt cell = cells ? cells[c] : c;
37112f856554SMatthew G. Knepley     const PetscInt cind = c - cStart;
37122f856554SMatthew G. Knepley     PetscScalar   *x = NULL, *x_t = NULL, *ul = *u, *ul_t = *u_t, *al = *a;
37132f856554SMatthew G. Knepley     PetscInt       i;
37142f856554SMatthew G. Knepley 
37159566063dSJacob Faibussowitsch     PetscCall(DMPlexVecGetClosure(plex, section, locX, cell, NULL, &x));
37162f856554SMatthew G. Knepley     for (i = 0; i < totDim; ++i) ul[cind * totDim + i] = x[i];
37179566063dSJacob Faibussowitsch     PetscCall(DMPlexVecRestoreClosure(plex, section, locX, cell, NULL, &x));
37182f856554SMatthew G. Knepley     if (locX_t) {
37199566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(plex, section, locX_t, cell, NULL, &x_t));
37202f856554SMatthew G. Knepley       for (i = 0; i < totDim; ++i) ul_t[cind * totDim + i] = x_t[i];
37219566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(plex, section, locX_t, cell, NULL, &x_t));
37222f856554SMatthew G. Knepley     }
37232f856554SMatthew G. Knepley     if (locA) {
37242f856554SMatthew G. Knepley       PetscInt subcell;
37259566063dSJacob Faibussowitsch       PetscCall(DMGetEnclosurePoint(plexA, dm, encAux, cell, &subcell));
37269566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(plexA, sectionAux, locA, subcell, NULL, &x));
37272f856554SMatthew G. Knepley       for (i = 0; i < totDimAux; ++i) al[cind * totDimAux + i] = x[i];
37289566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(plexA, sectionAux, locA, subcell, NULL, &x));
37292f856554SMatthew G. Knepley     }
37302f856554SMatthew G. Knepley   }
37319566063dSJacob Faibussowitsch   PetscCall(DMDestroy(&plex));
37329566063dSJacob Faibussowitsch   if (locA) PetscCall(DMDestroy(&plexA));
37339566063dSJacob Faibussowitsch   PetscCall(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
37343ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
37352f856554SMatthew G. Knepley }
37362f856554SMatthew G. Knepley 
37372f856554SMatthew G. Knepley /*@C
37382f856554SMatthew G. Knepley   DMPlexRestoreCellFields - Restore the field values values for a chunk of cells
37392f856554SMatthew G. Knepley 
37402f856554SMatthew G. Knepley   Input Parameters:
3741a1cb98faSBarry Smith + dm     - The `DM`
37422f856554SMatthew G. Knepley . cellIS - The cells to include
37432f856554SMatthew G. Knepley . locX   - A local vector with the solution fields
37442f856554SMatthew G. Knepley . locX_t - A local vector with solution field time derivatives, or NULL
37452f856554SMatthew G. Knepley - locA   - A local vector with auxiliary fields, or NULL
37462f856554SMatthew G. Knepley 
37472f856554SMatthew G. Knepley   Output Parameters:
37482f856554SMatthew G. Knepley + u   - The field coefficients
37492f856554SMatthew G. Knepley . u_t - The fields derivative coefficients
37502f856554SMatthew G. Knepley - a   - The auxiliary field coefficients
37512f856554SMatthew G. Knepley 
37522f856554SMatthew G. Knepley   Level: developer
37532f856554SMatthew G. Knepley 
37541cc06b55SBarry Smith .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `DMPlexGetFaceFields()`
37552f856554SMatthew G. Knepley @*/
3756d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexRestoreCellFields(DM dm, IS cellIS, Vec locX, Vec locX_t, Vec locA, PetscScalar **u, PetscScalar **u_t, PetscScalar **a)
3757d71ae5a4SJacob Faibussowitsch {
37582f856554SMatthew G. Knepley   PetscFunctionBegin;
37599566063dSJacob Faibussowitsch   PetscCall(DMRestoreWorkArray(dm, 0, MPIU_SCALAR, u));
37609566063dSJacob Faibussowitsch   if (locX_t) PetscCall(DMRestoreWorkArray(dm, 0, MPIU_SCALAR, u_t));
37619566063dSJacob Faibussowitsch   if (locA) PetscCall(DMRestoreWorkArray(dm, 0, MPIU_SCALAR, a));
37623ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
37632f856554SMatthew G. Knepley }
37642f856554SMatthew G. Knepley 
3765a4e35b19SJacob Faibussowitsch static PetscErrorCode DMPlexGetHybridCellFields(DM dm, IS cellIS, Vec locX, Vec locX_t, Vec locA, PetscScalar **u, PetscScalar **u_t, PetscScalar **a)
3766d71ae5a4SJacob Faibussowitsch {
376707218a29SMatthew G. Knepley   DM              plex, plexA = NULL;
376807218a29SMatthew G. Knepley   DMEnclosureType encAux;
376907218a29SMatthew G. Knepley   PetscSection    section, sectionAux;
377007218a29SMatthew G. Knepley   PetscDS         ds, dsIn;
37716528b96dSMatthew G. Knepley   const PetscInt *cells;
377207218a29SMatthew G. Knepley   PetscInt        cStart, cEnd, numCells, c, totDim, totDimAux, Nf, f;
37736528b96dSMatthew G. Knepley 
37746528b96dSMatthew G. Knepley   PetscFunctionBegin;
377507218a29SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
377607218a29SMatthew G. Knepley   PetscValidHeaderSpecific(cellIS, IS_CLASSID, 2);
377707218a29SMatthew G. Knepley   PetscValidHeaderSpecific(locX, VEC_CLASSID, 3);
377807218a29SMatthew G. Knepley   if (locX_t) { PetscValidHeaderSpecific(locX_t, VEC_CLASSID, 4); }
377907218a29SMatthew G. Knepley   if (locA) { PetscValidHeaderSpecific(locA, VEC_CLASSID, 5); }
37804f572ea9SToby Isaac   PetscAssertPointer(u, 6);
37814f572ea9SToby Isaac   PetscAssertPointer(u_t, 7);
37824f572ea9SToby Isaac   PetscAssertPointer(a, 8);
378307218a29SMatthew G. Knepley   PetscCall(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
378407218a29SMatthew G. Knepley   numCells = cEnd - cStart;
378507218a29SMatthew G. Knepley   PetscCall(DMPlexConvertPlex(dm, &plex, PETSC_FALSE));
378607218a29SMatthew G. Knepley   PetscCall(DMGetLocalSection(dm, &section));
378707218a29SMatthew G. Knepley   PetscCall(DMGetCellDS(dm, cells ? cells[cStart] : cStart, &ds, &dsIn));
378807218a29SMatthew G. Knepley   PetscCall(PetscDSGetNumFields(dsIn, &Nf));
378907218a29SMatthew G. Knepley   PetscCall(PetscDSGetTotalDimension(dsIn, &totDim));
379007218a29SMatthew G. Knepley   if (locA) {
379107218a29SMatthew G. Knepley     DM      dmAux;
379207218a29SMatthew G. Knepley     PetscDS probAux;
379307218a29SMatthew G. Knepley 
379407218a29SMatthew G. Knepley     PetscCall(VecGetDM(locA, &dmAux));
379507218a29SMatthew G. Knepley     PetscCall(DMGetEnclosureRelation(dmAux, dm, &encAux));
379607218a29SMatthew G. Knepley     PetscCall(DMPlexConvertPlex(dmAux, &plexA, PETSC_FALSE));
379707218a29SMatthew G. Knepley     PetscCall(DMGetLocalSection(dmAux, &sectionAux));
379807218a29SMatthew G. Knepley     PetscCall(DMGetDS(dmAux, &probAux));
379907218a29SMatthew G. Knepley     PetscCall(PetscDSGetTotalDimension(probAux, &totDimAux));
380007218a29SMatthew G. Knepley   }
380107218a29SMatthew G. Knepley   PetscCall(DMGetWorkArray(dm, numCells * totDim, MPIU_SCALAR, u));
380207218a29SMatthew G. Knepley   if (locX_t) PetscCall(DMGetWorkArray(dm, numCells * totDim, MPIU_SCALAR, u_t));
380307218a29SMatthew G. Knepley   else {
380407218a29SMatthew G. Knepley     *u_t = NULL;
380507218a29SMatthew G. Knepley   }
380607218a29SMatthew G. Knepley   if (locA) PetscCall(DMGetWorkArray(dm, numCells * totDimAux, MPIU_SCALAR, a));
380707218a29SMatthew G. Knepley   else {
380807218a29SMatthew G. Knepley     *a = NULL;
380907218a29SMatthew G. Knepley   }
381007218a29SMatthew G. Knepley   // Loop over cohesive cells
381107218a29SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
381207218a29SMatthew G. Knepley     const PetscInt  cell = cells ? cells[c] : c;
381307218a29SMatthew G. Knepley     const PetscInt  cind = c - cStart;
381474a0c561SMatthew G. Knepley     PetscScalar    *xf = NULL, *xc = NULL, *x = NULL, *xf_t = NULL, *xc_t = NULL;
38158e3a54c0SPierre Jolivet     PetscScalar    *ul = &(*u)[cind * totDim], *ul_t = PetscSafePointerPlusOffset(*u_t, cind * totDim);
381607218a29SMatthew G. Knepley     const PetscInt *cone, *ornt;
381707218a29SMatthew G. Knepley     PetscInt        Nx = 0, Nxf, s;
381807218a29SMatthew G. Knepley 
381907218a29SMatthew G. Knepley     PetscCall(DMPlexGetCone(dm, cell, &cone));
382007218a29SMatthew G. Knepley     PetscCall(DMPlexGetConeOrientation(dm, cell, &ornt));
382107218a29SMatthew G. Knepley     // Put in cohesive unknowns
382207218a29SMatthew G. Knepley     PetscCall(DMPlexVecGetClosure(plex, section, locX, cell, &Nxf, &xf));
382374a0c561SMatthew G. Knepley     if (locX_t) PetscCall(DMPlexVecGetClosure(plex, section, locX_t, cell, NULL, &xf_t));
382407218a29SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
382507218a29SMatthew G. Knepley       PetscInt  fdofIn, foff, foffIn;
382607218a29SMatthew G. Knepley       PetscBool cohesive;
382707218a29SMatthew G. Knepley 
382807218a29SMatthew G. Knepley       PetscCall(PetscDSGetCohesive(dsIn, f, &cohesive));
382907218a29SMatthew G. Knepley       if (!cohesive) continue;
383007218a29SMatthew G. Knepley       PetscCall(PetscDSGetFieldSize(dsIn, f, &fdofIn));
383107218a29SMatthew G. Knepley       PetscCall(PetscDSGetFieldOffsetCohesive(ds, f, &foff));
383207218a29SMatthew G. Knepley       PetscCall(PetscDSGetFieldOffsetCohesive(dsIn, f, &foffIn));
383307218a29SMatthew G. Knepley       for (PetscInt i = 0; i < fdofIn; ++i) ul[foffIn + i] = xf[foff + i];
383474a0c561SMatthew G. Knepley       if (locX_t)
383574a0c561SMatthew G. Knepley         for (PetscInt i = 0; i < fdofIn; ++i) ul_t[foffIn + i] = xf_t[foff + i];
383607218a29SMatthew G. Knepley       Nx += fdofIn;
383707218a29SMatthew G. Knepley     }
383807218a29SMatthew G. Knepley     PetscCall(DMPlexVecRestoreClosure(plex, section, locX, cell, &Nxf, &xf));
383974a0c561SMatthew G. Knepley     if (locX_t) PetscCall(DMPlexVecRestoreClosure(plex, section, locX_t, cell, NULL, &xf_t));
384007218a29SMatthew G. Knepley     // Loop over sides of surface
384107218a29SMatthew G. Knepley     for (s = 0; s < 2; ++s) {
384207218a29SMatthew G. Knepley       const PetscInt *support;
384307218a29SMatthew G. Knepley       const PetscInt  face = cone[s];
384407218a29SMatthew G. Knepley       PetscInt        ssize, ncell, Nxc;
384507218a29SMatthew G. Knepley 
384607218a29SMatthew G. Knepley       // I don't think I need the face to have 0 orientation in the hybrid cell
384707218a29SMatthew G. Knepley       //PetscCheck(!ornt[s], PETSC_COMM_SELF, PETSC_ERR_SUP, "Face %" PetscInt_FMT " in hybrid cell %" PetscInt_FMT " has orientation %" PetscInt_FMT " != 0", face, cell, ornt[s]);
384807218a29SMatthew G. Knepley       PetscCall(DMPlexGetSupport(dm, face, &support));
384907218a29SMatthew G. Knepley       PetscCall(DMPlexGetSupportSize(dm, face, &ssize));
385007218a29SMatthew G. Knepley       if (support[0] == cell) ncell = support[1];
385107218a29SMatthew G. Knepley       else if (support[1] == cell) ncell = support[0];
385207218a29SMatthew G. Knepley       else SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Face %" PetscInt_FMT " does not have cell %" PetscInt_FMT " in its support", face, cell);
385307218a29SMatthew G. Knepley       // Get closure of both face and cell, stick in cell for normal fields and face for cohesive fields
385407218a29SMatthew G. Knepley       PetscCall(DMPlexVecGetClosure(plex, section, locX, ncell, &Nxc, &xc));
385574a0c561SMatthew G. Knepley       if (locX_t) PetscCall(DMPlexVecGetClosure(plex, section, locX_t, ncell, NULL, &xc_t));
385607218a29SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
385707218a29SMatthew G. Knepley         PetscInt  fdofIn, foffIn;
385807218a29SMatthew G. Knepley         PetscBool cohesive;
385907218a29SMatthew G. Knepley 
386007218a29SMatthew G. Knepley         PetscCall(PetscDSGetCohesive(dsIn, f, &cohesive));
386107218a29SMatthew G. Knepley         if (cohesive) continue;
386207218a29SMatthew G. Knepley         PetscCall(PetscDSGetFieldSize(dsIn, f, &fdofIn));
386307218a29SMatthew G. Knepley         PetscCall(PetscDSGetFieldOffsetCohesive(dsIn, f, &foffIn));
386407218a29SMatthew G. Knepley         for (PetscInt i = 0; i < fdofIn; ++i) ul[foffIn + s * fdofIn + i] = xc[foffIn + i];
386574a0c561SMatthew G. Knepley         if (locX_t)
386674a0c561SMatthew G. Knepley           for (PetscInt i = 0; i < fdofIn; ++i) ul_t[foffIn + s * fdofIn + i] = xc_t[foffIn + i];
386707218a29SMatthew G. Knepley         Nx += fdofIn;
386807218a29SMatthew G. Knepley       }
386907218a29SMatthew G. Knepley       PetscCall(DMPlexVecRestoreClosure(plex, section, locX, ncell, &Nxc, &xc));
387074a0c561SMatthew G. Knepley       if (locX_t) PetscCall(DMPlexVecRestoreClosure(plex, section, locX_t, ncell, NULL, &xc_t));
387107218a29SMatthew G. Knepley     }
387207218a29SMatthew G. Knepley     PetscCheck(Nx == totDim, PETSC_COMM_SELF, PETSC_ERR_ARG_INCOMP, "Closure size %" PetscInt_FMT " for cell %" PetscInt_FMT " does not match DS size %" PetscInt_FMT, Nx, cell, totDim);
387307218a29SMatthew G. Knepley 
387407218a29SMatthew G. Knepley     if (locA) {
387507218a29SMatthew G. Knepley       PetscScalar *al = &(*a)[cind * totDimAux];
387607218a29SMatthew G. Knepley       PetscInt     subcell;
387707218a29SMatthew G. Knepley 
387807218a29SMatthew G. Knepley       PetscCall(DMGetEnclosurePoint(plexA, dm, encAux, cell, &subcell));
387907218a29SMatthew G. Knepley       PetscCall(DMPlexVecGetClosure(plexA, sectionAux, locA, subcell, &Nx, &x));
388007218a29SMatthew G. Knepley       PetscCheck(Nx == totDimAux, PETSC_COMM_SELF, PETSC_ERR_ARG_INCOMP, "Closure size %" PetscInt_FMT " for subcell %" PetscInt_FMT "does not match DS size %" PetscInt_FMT, Nx, subcell, totDimAux);
388107218a29SMatthew G. Knepley       for (PetscInt i = 0; i < totDimAux; ++i) al[i] = x[i];
388207218a29SMatthew G. Knepley       PetscCall(DMPlexVecRestoreClosure(plexA, sectionAux, locA, subcell, &Nx, &x));
388307218a29SMatthew G. Knepley     }
388407218a29SMatthew G. Knepley   }
388507218a29SMatthew G. Knepley   PetscCall(DMDestroy(&plex));
388607218a29SMatthew G. Knepley   PetscCall(DMDestroy(&plexA));
388707218a29SMatthew G. Knepley   PetscCall(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
388807218a29SMatthew G. Knepley   PetscFunctionReturn(PETSC_SUCCESS);
388907218a29SMatthew G. Knepley }
389007218a29SMatthew G. Knepley 
389107218a29SMatthew G. Knepley /*
38923e2b0218SMatthew G. Knepley   DMPlexGetHybridFields - Get the field values for the negative side (s = 0) and positive side (s = 1) of the interface
389307218a29SMatthew G. Knepley 
389407218a29SMatthew G. Knepley   Input Parameters:
389507218a29SMatthew G. Knepley + dm      - The full domain DM
389607218a29SMatthew G. Knepley . dmX     - An array of DM for the field, say an auxiliary DM, indexed by s
389707218a29SMatthew G. Knepley . dsX     - An array of PetscDS for the field, indexed by s
389807218a29SMatthew G. Knepley . cellIS  - The interface cells for which we want values
389907218a29SMatthew G. Knepley . locX    - An array of local vectors with the field values, indexed by s
390007218a29SMatthew G. Knepley - useCell - Flag to have values come from neighboring cell rather than endcap face
390107218a29SMatthew G. Knepley 
390207218a29SMatthew G. Knepley   Output Parameter:
390307218a29SMatthew G. Knepley . x       - An array of field values, indexed by s
390407218a29SMatthew G. Knepley 
390507218a29SMatthew G. Knepley   Note:
390676fbde31SPierre Jolivet   The arrays in `x` will be allocated using `DMGetWorkArray()`, and must be returned using `DMPlexRestoreHybridFields()`.
390707218a29SMatthew G. Knepley 
390807218a29SMatthew G. Knepley   Level: advanced
390907218a29SMatthew G. Knepley 
391076fbde31SPierre Jolivet .seealso: `DMPlexRestoreHybridFields()`, `DMGetWorkArray()`
391107218a29SMatthew G. Knepley */
391207218a29SMatthew G. Knepley static PetscErrorCode DMPlexGetHybridFields(DM dm, DM dmX[], PetscDS dsX[], IS cellIS, Vec locX[], PetscBool useCell, PetscScalar *x[])
391307218a29SMatthew G. Knepley {
391407218a29SMatthew G. Knepley   DM              plexX[2];
391507218a29SMatthew G. Knepley   DMEnclosureType encX[2];
391607218a29SMatthew G. Knepley   PetscSection    sectionX[2];
391707218a29SMatthew G. Knepley   const PetscInt *cells;
391807218a29SMatthew G. Knepley   PetscInt        cStart, cEnd, numCells, c, s, totDimX[2];
391907218a29SMatthew G. Knepley 
392007218a29SMatthew G. Knepley   PetscFunctionBegin;
39214f572ea9SToby Isaac   PetscAssertPointer(locX, 5);
392207218a29SMatthew G. Knepley   if (!locX[0] || !locX[1]) PetscFunctionReturn(PETSC_SUCCESS);
39234f572ea9SToby Isaac   PetscAssertPointer(dmX, 2);
39244f572ea9SToby Isaac   PetscAssertPointer(dsX, 3);
392507218a29SMatthew G. Knepley   PetscValidHeaderSpecific(cellIS, IS_CLASSID, 4);
39264f572ea9SToby Isaac   PetscAssertPointer(x, 7);
39279566063dSJacob Faibussowitsch   PetscCall(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
39286528b96dSMatthew G. Knepley   numCells = cEnd - cStart;
3929148442b3SMatthew G. Knepley   for (s = 0; s < 2; ++s) {
393007218a29SMatthew G. Knepley     PetscValidHeaderSpecific(dmX[s], DM_CLASSID, 2);
393107218a29SMatthew G. Knepley     PetscValidHeaderSpecific(dsX[s], PETSCDS_CLASSID, 3);
393207218a29SMatthew G. Knepley     PetscValidHeaderSpecific(locX[s], VEC_CLASSID, 5);
393307218a29SMatthew G. Knepley     PetscCall(DMPlexConvertPlex(dmX[s], &plexX[s], PETSC_FALSE));
393407218a29SMatthew G. Knepley     PetscCall(DMGetEnclosureRelation(dmX[s], dm, &encX[s]));
393507218a29SMatthew G. Knepley     PetscCall(DMGetLocalSection(dmX[s], &sectionX[s]));
393607218a29SMatthew G. Knepley     PetscCall(PetscDSGetTotalDimension(dsX[s], &totDimX[s]));
393707218a29SMatthew G. Knepley     PetscCall(DMGetWorkArray(dmX[s], numCells * totDimX[s], MPIU_SCALAR, &x[s]));
393804c51a94SMatthew G. Knepley   }
3939148442b3SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
39406528b96dSMatthew G. Knepley     const PetscInt  cell = cells ? cells[c] : c;
39416528b96dSMatthew G. Knepley     const PetscInt  cind = c - cStart;
39426528b96dSMatthew G. Knepley     const PetscInt *cone, *ornt;
39436528b96dSMatthew G. Knepley 
39449566063dSJacob Faibussowitsch     PetscCall(DMPlexGetCone(dm, cell, &cone));
39459566063dSJacob Faibussowitsch     PetscCall(DMPlexGetConeOrientation(dm, cell, &ornt));
394607218a29SMatthew G. Knepley     //PetscCheck(!ornt[0], PETSC_COMM_SELF, PETSC_ERR_SUP, "Face %" PetscInt_FMT " in hybrid cell %" PetscInt_FMT " has orientation %" PetscInt_FMT " != 0", cone[0], cell, ornt[0]);
3947148442b3SMatthew G. Knepley     for (s = 0; s < 2; ++s) {
394807218a29SMatthew G. Knepley       const PetscInt tdX     = totDimX[s];
394907218a29SMatthew G. Knepley       PetscScalar   *closure = NULL, *xl = &x[s][cind * tdX];
395007218a29SMatthew G. Knepley       PetscInt       face = cone[s], point = face, subpoint, Nx, i;
395107218a29SMatthew G. Knepley 
395207218a29SMatthew G. Knepley       if (useCell) {
39535fedec97SMatthew G. Knepley         const PetscInt *support;
395407218a29SMatthew G. Knepley         PetscInt        ssize;
39556528b96dSMatthew G. Knepley 
395607218a29SMatthew G. Knepley         PetscCall(DMPlexGetSupport(dm, face, &support));
395707218a29SMatthew G. Knepley         PetscCall(DMPlexGetSupportSize(dm, face, &ssize));
395807218a29SMatthew G. Knepley         PetscCheck(ssize == 2, PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Face %" PetscInt_FMT " from cell %" PetscInt_FMT " has support size %" PetscInt_FMT " != 2", face, cell, ssize);
395907218a29SMatthew G. Knepley         if (support[0] == cell) point = support[1];
396007218a29SMatthew G. Knepley         else if (support[1] == cell) point = support[0];
396107218a29SMatthew G. Knepley         else SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Face %" PetscInt_FMT " does not have cell %" PetscInt_FMT " in its support", face, cell);
396207218a29SMatthew G. Knepley       }
396307218a29SMatthew G. Knepley       PetscCall(DMGetEnclosurePoint(plexX[s], dm, encX[s], point, &subpoint));
3964e8e188d2SZach Atkins       PetscCall(DMPlexVecGetOrientedClosure_Internal(plexX[s], sectionX[s], PETSC_FALSE, locX[s], subpoint, ornt[s], &Nx, &closure));
396507218a29SMatthew G. Knepley       PetscCheck(Nx == tdX, PETSC_COMM_SELF, PETSC_ERR_ARG_INCOMP, "Closure size %" PetscInt_FMT " for subpoint %" PetscInt_FMT " does not match DS size %" PetscInt_FMT, Nx, subpoint, tdX);
396607218a29SMatthew G. Knepley       for (i = 0; i < Nx; ++i) xl[i] = closure[i];
396707218a29SMatthew G. Knepley       PetscCall(DMPlexVecRestoreClosure(plexX[s], sectionX[s], locX[s], subpoint, &Nx, &closure));
39686528b96dSMatthew G. Knepley     }
39696528b96dSMatthew G. Knepley   }
397007218a29SMatthew G. Knepley   for (s = 0; s < 2; ++s) PetscCall(DMDestroy(&plexX[s]));
39719566063dSJacob Faibussowitsch   PetscCall(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
39723ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
39736528b96dSMatthew G. Knepley }
39746528b96dSMatthew G. Knepley 
397507218a29SMatthew G. Knepley static PetscErrorCode DMPlexRestoreHybridFields(DM dm, DM dmX[], PetscDS dsX[], IS cellIS, Vec locX[], PetscBool useCell, PetscScalar *x[])
3976d71ae5a4SJacob Faibussowitsch {
39776528b96dSMatthew G. Knepley   PetscFunctionBegin;
397807218a29SMatthew G. Knepley   if (!locX[0] || !locX[1]) PetscFunctionReturn(PETSC_SUCCESS);
397907218a29SMatthew G. Knepley   PetscCall(DMRestoreWorkArray(dmX[0], 0, MPIU_SCALAR, &x[0]));
398007218a29SMatthew G. Knepley   PetscCall(DMRestoreWorkArray(dmX[1], 0, MPIU_SCALAR, &x[1]));
39813ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
39826528b96dSMatthew G. Knepley }
39836528b96dSMatthew G. Knepley 
39842f856554SMatthew G. Knepley /*@C
39852f856554SMatthew G. Knepley   DMPlexGetFaceFields - Retrieve the field values values for a chunk of faces
39862f856554SMatthew G. Knepley 
39872f856554SMatthew G. Knepley   Input Parameters:
3988a1cb98faSBarry Smith + dm           - The `DM`
39892f856554SMatthew G. Knepley . fStart       - The first face to include
39902f856554SMatthew G. Knepley . fEnd         - The first face to exclude
39912f856554SMatthew G. Knepley . locX         - A local vector with the solution fields
39922f856554SMatthew G. Knepley . locX_t       - A local vector with solution field time derivatives, or NULL
39932f856554SMatthew G. Knepley . faceGeometry - A local vector with face geometry
39942f856554SMatthew G. Knepley . cellGeometry - A local vector with cell geometry
399560225df5SJacob Faibussowitsch - locGrad      - A local vector with field gradients, or NULL
39962f856554SMatthew G. Knepley 
39972f856554SMatthew G. Knepley   Output Parameters:
39982f856554SMatthew G. Knepley + Nface - The number of faces with field values
39992f856554SMatthew G. Knepley . uL    - The field values at the left side of the face
40002f856554SMatthew G. Knepley - uR    - The field values at the right side of the face
40012f856554SMatthew G. Knepley 
40022f856554SMatthew G. Knepley   Level: developer
40032f856554SMatthew G. Knepley 
40041cc06b55SBarry Smith .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `DMPlexGetCellFields()`
40052f856554SMatthew G. Knepley @*/
4006d71ae5a4SJacob Faibussowitsch 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)
4007d71ae5a4SJacob Faibussowitsch {
40082f856554SMatthew G. Knepley   DM                 dmFace, dmCell, dmGrad = NULL;
40092f856554SMatthew G. Knepley   PetscSection       section;
40102f856554SMatthew G. Knepley   PetscDS            prob;
40112f856554SMatthew G. Knepley   DMLabel            ghostLabel;
40122f856554SMatthew G. Knepley   const PetscScalar *facegeom, *cellgeom, *x, *lgrad;
40132f856554SMatthew G. Knepley   PetscBool         *isFE;
40142f856554SMatthew G. Knepley   PetscInt           dim, Nf, f, Nc, numFaces = fEnd - fStart, iface, face;
40152f856554SMatthew G. Knepley 
40162f856554SMatthew G. Knepley   PetscFunctionBegin;
40172f856554SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
40182f856554SMatthew G. Knepley   PetscValidHeaderSpecific(locX, VEC_CLASSID, 4);
4019ad540459SPierre Jolivet   if (locX_t) PetscValidHeaderSpecific(locX_t, VEC_CLASSID, 5);
40202f856554SMatthew G. Knepley   PetscValidHeaderSpecific(faceGeometry, VEC_CLASSID, 6);
40212f856554SMatthew G. Knepley   PetscValidHeaderSpecific(cellGeometry, VEC_CLASSID, 7);
4022ad540459SPierre Jolivet   if (locGrad) PetscValidHeaderSpecific(locGrad, VEC_CLASSID, 8);
40234f572ea9SToby Isaac   PetscAssertPointer(uL, 10);
40244f572ea9SToby Isaac   PetscAssertPointer(uR, 11);
40259566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
40269566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dm, &prob));
40279566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
40289566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumFields(prob, &Nf));
40299566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalComponents(prob, &Nc));
40309566063dSJacob Faibussowitsch   PetscCall(PetscMalloc1(Nf, &isFE));
40312f856554SMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
40322f856554SMatthew G. Knepley     PetscObject  obj;
40332f856554SMatthew G. Knepley     PetscClassId id;
40342f856554SMatthew G. Knepley 
40359566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, f, &obj));
40369566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
40379371c9d4SSatish Balay     if (id == PETSCFE_CLASSID) {
40389371c9d4SSatish Balay       isFE[f] = PETSC_TRUE;
40399371c9d4SSatish Balay     } else if (id == PETSCFV_CLASSID) {
40409371c9d4SSatish Balay       isFE[f] = PETSC_FALSE;
40419371c9d4SSatish Balay     } else {
40429371c9d4SSatish Balay       isFE[f] = PETSC_FALSE;
40439371c9d4SSatish Balay     }
40442f856554SMatthew G. Knepley   }
40459566063dSJacob Faibussowitsch   PetscCall(DMGetLabel(dm, "ghost", &ghostLabel));
40469566063dSJacob Faibussowitsch   PetscCall(VecGetArrayRead(locX, &x));
40479566063dSJacob Faibussowitsch   PetscCall(VecGetDM(faceGeometry, &dmFace));
40489566063dSJacob Faibussowitsch   PetscCall(VecGetArrayRead(faceGeometry, &facegeom));
40499566063dSJacob Faibussowitsch   PetscCall(VecGetDM(cellGeometry, &dmCell));
40509566063dSJacob Faibussowitsch   PetscCall(VecGetArrayRead(cellGeometry, &cellgeom));
40512f856554SMatthew G. Knepley   if (locGrad) {
40529566063dSJacob Faibussowitsch     PetscCall(VecGetDM(locGrad, &dmGrad));
40539566063dSJacob Faibussowitsch     PetscCall(VecGetArrayRead(locGrad, &lgrad));
40542f856554SMatthew G. Knepley   }
40559566063dSJacob Faibussowitsch   PetscCall(DMGetWorkArray(dm, numFaces * Nc, MPIU_SCALAR, uL));
40569566063dSJacob Faibussowitsch   PetscCall(DMGetWorkArray(dm, numFaces * Nc, MPIU_SCALAR, uR));
40572f856554SMatthew G. Knepley   /* Right now just eat the extra work for FE (could make a cell loop) */
40582f856554SMatthew G. Knepley   for (face = fStart, iface = 0; face < fEnd; ++face) {
40592f856554SMatthew G. Knepley     const PetscInt  *cells;
40602f856554SMatthew G. Knepley     PetscFVFaceGeom *fg;
40612f856554SMatthew G. Knepley     PetscFVCellGeom *cgL, *cgR;
40622f856554SMatthew G. Knepley     PetscScalar     *xL, *xR, *gL, *gR;
40632f856554SMatthew G. Knepley     PetscScalar     *uLl = *uL, *uRl = *uR;
40642f856554SMatthew G. Knepley     PetscInt         ghost, nsupp, nchild;
40652f856554SMatthew G. Knepley 
40669566063dSJacob Faibussowitsch     PetscCall(DMLabelGetValue(ghostLabel, face, &ghost));
40679566063dSJacob Faibussowitsch     PetscCall(DMPlexGetSupportSize(dm, face, &nsupp));
40689566063dSJacob Faibussowitsch     PetscCall(DMPlexGetTreeChildren(dm, face, &nchild, NULL));
40692f856554SMatthew G. Knepley     if (ghost >= 0 || nsupp > 2 || nchild > 0) continue;
40709566063dSJacob Faibussowitsch     PetscCall(DMPlexPointLocalRead(dmFace, face, facegeom, &fg));
40719566063dSJacob Faibussowitsch     PetscCall(DMPlexGetSupport(dm, face, &cells));
40729566063dSJacob Faibussowitsch     PetscCall(DMPlexPointLocalRead(dmCell, cells[0], cellgeom, &cgL));
40739566063dSJacob Faibussowitsch     PetscCall(DMPlexPointLocalRead(dmCell, cells[1], cellgeom, &cgR));
40742f856554SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
40752f856554SMatthew G. Knepley       PetscInt off;
40762f856554SMatthew G. Knepley 
40779566063dSJacob Faibussowitsch       PetscCall(PetscDSGetComponentOffset(prob, f, &off));
40782f856554SMatthew G. Knepley       if (isFE[f]) {
40792f856554SMatthew G. Knepley         const PetscInt *cone;
40802f856554SMatthew G. Knepley         PetscInt        comp, coneSizeL, coneSizeR, faceLocL, faceLocR, ldof, rdof, d;
40812f856554SMatthew G. Knepley 
40822f856554SMatthew G. Knepley         xL = xR = NULL;
40839566063dSJacob Faibussowitsch         PetscCall(PetscSectionGetFieldComponents(section, f, &comp));
40849566063dSJacob Faibussowitsch         PetscCall(DMPlexVecGetClosure(dm, section, locX, cells[0], &ldof, (PetscScalar **)&xL));
40859566063dSJacob Faibussowitsch         PetscCall(DMPlexVecGetClosure(dm, section, locX, cells[1], &rdof, (PetscScalar **)&xR));
40869566063dSJacob Faibussowitsch         PetscCall(DMPlexGetCone(dm, cells[0], &cone));
40879566063dSJacob Faibussowitsch         PetscCall(DMPlexGetConeSize(dm, cells[0], &coneSizeL));
40889371c9d4SSatish Balay         for (faceLocL = 0; faceLocL < coneSizeL; ++faceLocL)
40899371c9d4SSatish Balay           if (cone[faceLocL] == face) break;
40909566063dSJacob Faibussowitsch         PetscCall(DMPlexGetCone(dm, cells[1], &cone));
40919566063dSJacob Faibussowitsch         PetscCall(DMPlexGetConeSize(dm, cells[1], &coneSizeR));
40929371c9d4SSatish Balay         for (faceLocR = 0; faceLocR < coneSizeR; ++faceLocR)
40939371c9d4SSatish Balay           if (cone[faceLocR] == face) break;
40941dca8a05SBarry Smith         PetscCheck(faceLocL != coneSizeL || faceLocR != coneSizeR, PETSC_COMM_SELF, PETSC_ERR_PLIB, "Could not find face %" PetscInt_FMT " in cone of cell %" PetscInt_FMT " or cell %" PetscInt_FMT, face, cells[0], cells[1]);
40952f856554SMatthew G. Knepley         /* Check that FEM field has values in the right cell (sometimes its an FV ghost cell) */
40962f856554SMatthew G. Knepley         /* TODO: this is a hack that might not be right for nonconforming */
40972f856554SMatthew G. Knepley         if (faceLocL < coneSizeL) {
40989566063dSJacob Faibussowitsch           PetscCall(PetscFEEvaluateFaceFields_Internal(prob, f, faceLocL, xL, &uLl[iface * Nc + off]));
40999566063dSJacob Faibussowitsch           if (rdof == ldof && faceLocR < coneSizeR) PetscCall(PetscFEEvaluateFaceFields_Internal(prob, f, faceLocR, xR, &uRl[iface * Nc + off]));
41002f856554SMatthew G. Knepley           else {
41019371c9d4SSatish Balay             for (d = 0; d < comp; ++d) uRl[iface * Nc + off + d] = uLl[iface * Nc + off + d];
41029371c9d4SSatish Balay           }
41039371c9d4SSatish Balay         } else {
41049566063dSJacob Faibussowitsch           PetscCall(PetscFEEvaluateFaceFields_Internal(prob, f, faceLocR, xR, &uRl[iface * Nc + off]));
41059566063dSJacob Faibussowitsch           PetscCall(PetscSectionGetFieldComponents(section, f, &comp));
41062f856554SMatthew G. Knepley           for (d = 0; d < comp; ++d) uLl[iface * Nc + off + d] = uRl[iface * Nc + off + d];
41072f856554SMatthew G. Knepley         }
41089566063dSJacob Faibussowitsch         PetscCall(DMPlexVecRestoreClosure(dm, section, locX, cells[0], &ldof, (PetscScalar **)&xL));
41099566063dSJacob Faibussowitsch         PetscCall(DMPlexVecRestoreClosure(dm, section, locX, cells[1], &rdof, (PetscScalar **)&xR));
41102f856554SMatthew G. Knepley       } else {
41112f856554SMatthew G. Knepley         PetscFV  fv;
41122f856554SMatthew G. Knepley         PetscInt numComp, c;
41132f856554SMatthew G. Knepley 
41149566063dSJacob Faibussowitsch         PetscCall(PetscDSGetDiscretization(prob, f, (PetscObject *)&fv));
41159566063dSJacob Faibussowitsch         PetscCall(PetscFVGetNumComponents(fv, &numComp));
41169566063dSJacob Faibussowitsch         PetscCall(DMPlexPointLocalFieldRead(dm, cells[0], f, x, &xL));
41179566063dSJacob Faibussowitsch         PetscCall(DMPlexPointLocalFieldRead(dm, cells[1], f, x, &xR));
41182f856554SMatthew G. Knepley         if (dmGrad) {
41192f856554SMatthew G. Knepley           PetscReal dxL[3], dxR[3];
41202f856554SMatthew G. Knepley 
41219566063dSJacob Faibussowitsch           PetscCall(DMPlexPointLocalRead(dmGrad, cells[0], lgrad, &gL));
41229566063dSJacob Faibussowitsch           PetscCall(DMPlexPointLocalRead(dmGrad, cells[1], lgrad, &gR));
41232f856554SMatthew G. Knepley           DMPlex_WaxpyD_Internal(dim, -1, cgL->centroid, fg->centroid, dxL);
41242f856554SMatthew G. Knepley           DMPlex_WaxpyD_Internal(dim, -1, cgR->centroid, fg->centroid, dxR);
41252f856554SMatthew G. Knepley           for (c = 0; c < numComp; ++c) {
41262f856554SMatthew G. Knepley             uLl[iface * Nc + off + c] = xL[c] + DMPlex_DotD_Internal(dim, &gL[c * dim], dxL);
41272f856554SMatthew G. Knepley             uRl[iface * Nc + off + c] = xR[c] + DMPlex_DotD_Internal(dim, &gR[c * dim], dxR);
41282f856554SMatthew G. Knepley           }
41292f856554SMatthew G. Knepley         } else {
41302f856554SMatthew G. Knepley           for (c = 0; c < numComp; ++c) {
41312f856554SMatthew G. Knepley             uLl[iface * Nc + off + c] = xL[c];
41322f856554SMatthew G. Knepley             uRl[iface * Nc + off + c] = xR[c];
41332f856554SMatthew G. Knepley           }
41342f856554SMatthew G. Knepley         }
41352f856554SMatthew G. Knepley       }
41362f856554SMatthew G. Knepley     }
41372f856554SMatthew G. Knepley     ++iface;
41382f856554SMatthew G. Knepley   }
41392f856554SMatthew G. Knepley   *Nface = iface;
41409566063dSJacob Faibussowitsch   PetscCall(VecRestoreArrayRead(locX, &x));
41419566063dSJacob Faibussowitsch   PetscCall(VecRestoreArrayRead(faceGeometry, &facegeom));
41429566063dSJacob Faibussowitsch   PetscCall(VecRestoreArrayRead(cellGeometry, &cellgeom));
414348a46eb9SPierre Jolivet   if (locGrad) PetscCall(VecRestoreArrayRead(locGrad, &lgrad));
41449566063dSJacob Faibussowitsch   PetscCall(PetscFree(isFE));
41453ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
41462f856554SMatthew G. Knepley }
41472f856554SMatthew G. Knepley 
41482f856554SMatthew G. Knepley /*@C
41492f856554SMatthew G. Knepley   DMPlexRestoreFaceFields - Restore the field values values for a chunk of faces
41502f856554SMatthew G. Knepley 
41512f856554SMatthew G. Knepley   Input Parameters:
4152a1cb98faSBarry Smith + dm           - The `DM`
41532f856554SMatthew G. Knepley . fStart       - The first face to include
41542f856554SMatthew G. Knepley . fEnd         - The first face to exclude
41552f856554SMatthew G. Knepley . locX         - A local vector with the solution fields
41562f856554SMatthew G. Knepley . locX_t       - A local vector with solution field time derivatives, or NULL
41572f856554SMatthew G. Knepley . faceGeometry - A local vector with face geometry
41582f856554SMatthew G. Knepley . cellGeometry - A local vector with cell geometry
415960225df5SJacob Faibussowitsch - locGrad      - A local vector with field gradients, or NULL
41602f856554SMatthew G. Knepley 
41612f856554SMatthew G. Knepley   Output Parameters:
41622f856554SMatthew G. Knepley + Nface - The number of faces with field values
41632f856554SMatthew G. Knepley . uL    - The field values at the left side of the face
41642f856554SMatthew G. Knepley - uR    - The field values at the right side of the face
41652f856554SMatthew G. Knepley 
41662f856554SMatthew G. Knepley   Level: developer
41672f856554SMatthew G. Knepley 
41681cc06b55SBarry Smith .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `DMPlexGetFaceFields()`
41692f856554SMatthew G. Knepley @*/
4170d71ae5a4SJacob Faibussowitsch 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)
4171d71ae5a4SJacob Faibussowitsch {
41722f856554SMatthew G. Knepley   PetscFunctionBegin;
41739566063dSJacob Faibussowitsch   PetscCall(DMRestoreWorkArray(dm, 0, MPIU_SCALAR, uL));
41749566063dSJacob Faibussowitsch   PetscCall(DMRestoreWorkArray(dm, 0, MPIU_SCALAR, uR));
41753ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
41762f856554SMatthew G. Knepley }
41772f856554SMatthew G. Knepley 
41782f856554SMatthew G. Knepley /*@C
41792f856554SMatthew G. Knepley   DMPlexGetFaceGeometry - Retrieve the geometric values for a chunk of faces
41802f856554SMatthew G. Knepley 
41812f856554SMatthew G. Knepley   Input Parameters:
4182a1cb98faSBarry Smith + dm           - The `DM`
41832f856554SMatthew G. Knepley . fStart       - The first face to include
41842f856554SMatthew G. Knepley . fEnd         - The first face to exclude
41852f856554SMatthew G. Knepley . faceGeometry - A local vector with face geometry
41862f856554SMatthew G. Knepley - cellGeometry - A local vector with cell geometry
41872f856554SMatthew G. Knepley 
41882f856554SMatthew G. Knepley   Output Parameters:
41892f856554SMatthew G. Knepley + Nface - The number of faces with field values
41902f856554SMatthew G. Knepley . fgeom - The extract the face centroid and normal
41912f856554SMatthew G. Knepley - vol   - The cell volume
41922f856554SMatthew G. Knepley 
41932f856554SMatthew G. Knepley   Level: developer
41942f856554SMatthew G. Knepley 
41951cc06b55SBarry Smith .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `DMPlexGetCellFields()`
41962f856554SMatthew G. Knepley @*/
4197d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexGetFaceGeometry(DM dm, PetscInt fStart, PetscInt fEnd, Vec faceGeometry, Vec cellGeometry, PetscInt *Nface, PetscFVFaceGeom **fgeom, PetscReal **vol)
4198d71ae5a4SJacob Faibussowitsch {
41992f856554SMatthew G. Knepley   DM                 dmFace, dmCell;
42002f856554SMatthew G. Knepley   DMLabel            ghostLabel;
42012f856554SMatthew G. Knepley   const PetscScalar *facegeom, *cellgeom;
42022f856554SMatthew G. Knepley   PetscInt           dim, numFaces = fEnd - fStart, iface, face;
42032f856554SMatthew G. Knepley 
42042f856554SMatthew G. Knepley   PetscFunctionBegin;
42052f856554SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
42062f856554SMatthew G. Knepley   PetscValidHeaderSpecific(faceGeometry, VEC_CLASSID, 4);
42072f856554SMatthew G. Knepley   PetscValidHeaderSpecific(cellGeometry, VEC_CLASSID, 5);
42084f572ea9SToby Isaac   PetscAssertPointer(fgeom, 7);
42094f572ea9SToby Isaac   PetscAssertPointer(vol, 8);
42109566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
42119566063dSJacob Faibussowitsch   PetscCall(DMGetLabel(dm, "ghost", &ghostLabel));
42129566063dSJacob Faibussowitsch   PetscCall(VecGetDM(faceGeometry, &dmFace));
42139566063dSJacob Faibussowitsch   PetscCall(VecGetArrayRead(faceGeometry, &facegeom));
42149566063dSJacob Faibussowitsch   PetscCall(VecGetDM(cellGeometry, &dmCell));
42159566063dSJacob Faibussowitsch   PetscCall(VecGetArrayRead(cellGeometry, &cellgeom));
42169566063dSJacob Faibussowitsch   PetscCall(PetscMalloc1(numFaces, fgeom));
42179566063dSJacob Faibussowitsch   PetscCall(DMGetWorkArray(dm, numFaces * 2, MPIU_SCALAR, vol));
42182f856554SMatthew G. Knepley   for (face = fStart, iface = 0; face < fEnd; ++face) {
42192f856554SMatthew G. Knepley     const PetscInt  *cells;
42202f856554SMatthew G. Knepley     PetscFVFaceGeom *fg;
42212f856554SMatthew G. Knepley     PetscFVCellGeom *cgL, *cgR;
42222f856554SMatthew G. Knepley     PetscFVFaceGeom *fgeoml = *fgeom;
42232f856554SMatthew G. Knepley     PetscReal       *voll   = *vol;
42242f856554SMatthew G. Knepley     PetscInt         ghost, d, nchild, nsupp;
42252f856554SMatthew G. Knepley 
42269566063dSJacob Faibussowitsch     PetscCall(DMLabelGetValue(ghostLabel, face, &ghost));
42279566063dSJacob Faibussowitsch     PetscCall(DMPlexGetSupportSize(dm, face, &nsupp));
42289566063dSJacob Faibussowitsch     PetscCall(DMPlexGetTreeChildren(dm, face, &nchild, NULL));
42292f856554SMatthew G. Knepley     if (ghost >= 0 || nsupp > 2 || nchild > 0) continue;
42309566063dSJacob Faibussowitsch     PetscCall(DMPlexPointLocalRead(dmFace, face, facegeom, &fg));
42319566063dSJacob Faibussowitsch     PetscCall(DMPlexGetSupport(dm, face, &cells));
42329566063dSJacob Faibussowitsch     PetscCall(DMPlexPointLocalRead(dmCell, cells[0], cellgeom, &cgL));
42339566063dSJacob Faibussowitsch     PetscCall(DMPlexPointLocalRead(dmCell, cells[1], cellgeom, &cgR));
42342f856554SMatthew G. Knepley     for (d = 0; d < dim; ++d) {
42352f856554SMatthew G. Knepley       fgeoml[iface].centroid[d] = fg->centroid[d];
42362f856554SMatthew G. Knepley       fgeoml[iface].normal[d]   = fg->normal[d];
42372f856554SMatthew G. Knepley     }
42382f856554SMatthew G. Knepley     voll[iface * 2 + 0] = cgL->volume;
42392f856554SMatthew G. Knepley     voll[iface * 2 + 1] = cgR->volume;
42402f856554SMatthew G. Knepley     ++iface;
42412f856554SMatthew G. Knepley   }
42422f856554SMatthew G. Knepley   *Nface = iface;
42439566063dSJacob Faibussowitsch   PetscCall(VecRestoreArrayRead(faceGeometry, &facegeom));
42449566063dSJacob Faibussowitsch   PetscCall(VecRestoreArrayRead(cellGeometry, &cellgeom));
42453ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
42462f856554SMatthew G. Knepley }
42472f856554SMatthew G. Knepley 
42482f856554SMatthew G. Knepley /*@C
42492f856554SMatthew G. Knepley   DMPlexRestoreFaceGeometry - Restore the field values values for a chunk of faces
42502f856554SMatthew G. Knepley 
42512f856554SMatthew G. Knepley   Input Parameters:
4252a1cb98faSBarry Smith + dm           - The `DM`
42532f856554SMatthew G. Knepley . fStart       - The first face to include
42542f856554SMatthew G. Knepley . fEnd         - The first face to exclude
42552f856554SMatthew G. Knepley . faceGeometry - A local vector with face geometry
42562f856554SMatthew G. Knepley - cellGeometry - A local vector with cell geometry
42572f856554SMatthew G. Knepley 
42582f856554SMatthew G. Knepley   Output Parameters:
42592f856554SMatthew G. Knepley + Nface - The number of faces with field values
42602f856554SMatthew G. Knepley . fgeom - The extract the face centroid and normal
42612f856554SMatthew G. Knepley - vol   - The cell volume
42622f856554SMatthew G. Knepley 
42632f856554SMatthew G. Knepley   Level: developer
42642f856554SMatthew G. Knepley 
42651cc06b55SBarry Smith .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `DMPlexGetFaceFields()`
42662f856554SMatthew G. Knepley @*/
4267d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexRestoreFaceGeometry(DM dm, PetscInt fStart, PetscInt fEnd, Vec faceGeometry, Vec cellGeometry, PetscInt *Nface, PetscFVFaceGeom **fgeom, PetscReal **vol)
4268d71ae5a4SJacob Faibussowitsch {
42692f856554SMatthew G. Knepley   PetscFunctionBegin;
42709566063dSJacob Faibussowitsch   PetscCall(PetscFree(*fgeom));
42719566063dSJacob Faibussowitsch   PetscCall(DMRestoreWorkArray(dm, 0, MPIU_REAL, vol));
42723ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
42732f856554SMatthew G. Knepley }
42742f856554SMatthew G. Knepley 
4275d71ae5a4SJacob Faibussowitsch PetscErrorCode DMSNESGetFEGeom(DMField coordField, IS pointIS, PetscQuadrature quad, PetscBool faceData, PetscFEGeom **geom)
4276d71ae5a4SJacob Faibussowitsch {
4277a1cf66bbSMatthew G. Knepley   char           composeStr[33] = {0};
4278a1cf66bbSMatthew G. Knepley   PetscObjectId  id;
4279a1cf66bbSMatthew G. Knepley   PetscContainer container;
4280a1cf66bbSMatthew G. Knepley 
4281a1cf66bbSMatthew G. Knepley   PetscFunctionBegin;
42829566063dSJacob Faibussowitsch   PetscCall(PetscObjectGetId((PetscObject)quad, &id));
428363a3b9bcSJacob Faibussowitsch   PetscCall(PetscSNPrintf(composeStr, 32, "DMSNESGetFEGeom_%" PetscInt64_FMT "\n", id));
42849566063dSJacob Faibussowitsch   PetscCall(PetscObjectQuery((PetscObject)pointIS, composeStr, (PetscObject *)&container));
4285a1cf66bbSMatthew G. Knepley   if (container) {
42869566063dSJacob Faibussowitsch     PetscCall(PetscContainerGetPointer(container, (void **)geom));
4287a1cf66bbSMatthew G. Knepley   } else {
42889566063dSJacob Faibussowitsch     PetscCall(DMFieldCreateFEGeom(coordField, pointIS, quad, faceData, geom));
42899566063dSJacob Faibussowitsch     PetscCall(PetscContainerCreate(PETSC_COMM_SELF, &container));
42909566063dSJacob Faibussowitsch     PetscCall(PetscContainerSetPointer(container, (void *)*geom));
4291*49abdd8aSBarry Smith     PetscCall(PetscContainerSetCtxDestroy(container, PetscContainerCtxDestroy_PetscFEGeom));
42929566063dSJacob Faibussowitsch     PetscCall(PetscObjectCompose((PetscObject)pointIS, composeStr, (PetscObject)container));
42939566063dSJacob Faibussowitsch     PetscCall(PetscContainerDestroy(&container));
4294a1cf66bbSMatthew G. Knepley   }
42953ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
4296a1cf66bbSMatthew G. Knepley }
4297a1cf66bbSMatthew G. Knepley 
4298d71ae5a4SJacob Faibussowitsch PetscErrorCode DMSNESRestoreFEGeom(DMField coordField, IS pointIS, PetscQuadrature quad, PetscBool faceData, PetscFEGeom **geom)
4299d71ae5a4SJacob Faibussowitsch {
4300a1cf66bbSMatthew G. Knepley   PetscFunctionBegin;
4301a1cf66bbSMatthew G. Knepley   *geom = NULL;
43023ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
4303a1cf66bbSMatthew G. Knepley }
4304a1cf66bbSMatthew G. Knepley 
4305d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexComputeResidual_Patch_Internal(DM dm, PetscSection section, IS cellIS, PetscReal t, Vec locX, Vec locX_t, Vec locF, void *user)
4306d71ae5a4SJacob Faibussowitsch {
430792d50984SMatthew G. Knepley   DM_Plex        *mesh       = (DM_Plex *)dm->data;
430892d50984SMatthew G. Knepley   const char     *name       = "Residual";
430992d50984SMatthew G. Knepley   DM              dmAux      = NULL;
431092d50984SMatthew G. Knepley   DMLabel         ghostLabel = NULL;
431192d50984SMatthew G. Knepley   PetscDS         prob       = NULL;
431292d50984SMatthew G. Knepley   PetscDS         probAux    = NULL;
431392d50984SMatthew G. Knepley   PetscBool       useFEM     = PETSC_FALSE;
431492d50984SMatthew G. Knepley   PetscBool       isImplicit = (locX_t || t == PETSC_MIN_REAL) ? PETSC_TRUE : PETSC_FALSE;
431592d50984SMatthew G. Knepley   DMField         coordField = NULL;
4316c0006e53SPatrick Farrell   Vec             locA;
4317c0006e53SPatrick Farrell   PetscScalar    *u = NULL, *u_t, *a, *uL = NULL, *uR = NULL;
431892d50984SMatthew G. Knepley   IS              chunkIS;
431992d50984SMatthew G. Knepley   const PetscInt *cells;
432092d50984SMatthew G. Knepley   PetscInt        cStart, cEnd, numCells;
4321364207b6SKarl Rupp   PetscInt        Nf, f, totDim, totDimAux, numChunks, cellChunkSize, chunk, fStart, fEnd;
43221690c2aeSBarry Smith   PetscInt        maxDegree = PETSC_INT_MAX;
432306ad1575SMatthew G. Knepley   PetscFormKey    key;
432492d50984SMatthew G. Knepley   PetscQuadrature affineQuad = NULL, *quads = NULL;
432592d50984SMatthew G. Knepley   PetscFEGeom    *affineGeom = NULL, **geoms = NULL;
432692d50984SMatthew G. Knepley 
432792d50984SMatthew G. Knepley   PetscFunctionBegin;
43289566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_ResidualFEM, dm, 0, 0, 0));
432992d50984SMatthew G. Knepley   /* FEM+FVM */
433092d50984SMatthew G. Knepley   /* 1: Get sizes from dm and dmAux */
43319566063dSJacob Faibussowitsch   PetscCall(DMGetLabel(dm, "ghost", &ghostLabel));
43329566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dm, &prob));
43339566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumFields(prob, &Nf));
43349566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(prob, &totDim));
43359566063dSJacob Faibussowitsch   PetscCall(DMGetAuxiliaryVec(dm, NULL, 0, 0, &locA));
433692d50984SMatthew G. Knepley   if (locA) {
43379566063dSJacob Faibussowitsch     PetscCall(VecGetDM(locA, &dmAux));
43389566063dSJacob Faibussowitsch     PetscCall(DMGetDS(dmAux, &probAux));
43399566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalDimension(probAux, &totDimAux));
434092d50984SMatthew G. Knepley   }
434192d50984SMatthew G. Knepley   /* 2: Get geometric data */
434292d50984SMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
434392d50984SMatthew G. Knepley     PetscObject  obj;
434492d50984SMatthew G. Knepley     PetscClassId id;
434592d50984SMatthew G. Knepley     PetscBool    fimp;
434692d50984SMatthew G. Knepley 
43479566063dSJacob Faibussowitsch     PetscCall(PetscDSGetImplicit(prob, f, &fimp));
434892d50984SMatthew G. Knepley     if (isImplicit != fimp) continue;
43499566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, f, &obj));
43509566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
4351ad540459SPierre Jolivet     if (id == PETSCFE_CLASSID) useFEM = PETSC_TRUE;
43525f80ce2aSJacob Faibussowitsch     PetscCheck(id != PETSCFV_CLASSID, PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Use of FVM with PCPATCH not yet implemented");
435392d50984SMatthew G. Knepley   }
435492d50984SMatthew G. Knepley   if (useFEM) {
43559566063dSJacob Faibussowitsch     PetscCall(DMGetCoordinateField(dm, &coordField));
43569566063dSJacob Faibussowitsch     PetscCall(DMFieldGetDegree(coordField, cellIS, NULL, &maxDegree));
435792d50984SMatthew G. Knepley     if (maxDegree <= 1) {
43589566063dSJacob Faibussowitsch       PetscCall(DMFieldCreateDefaultQuadrature(coordField, cellIS, &affineQuad));
435948a46eb9SPierre Jolivet       if (affineQuad) PetscCall(DMSNESGetFEGeom(coordField, cellIS, affineQuad, PETSC_FALSE, &affineGeom));
436092d50984SMatthew G. Knepley     } else {
43619566063dSJacob Faibussowitsch       PetscCall(PetscCalloc2(Nf, &quads, Nf, &geoms));
436292d50984SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
436392d50984SMatthew G. Knepley         PetscObject  obj;
436492d50984SMatthew G. Knepley         PetscClassId id;
436592d50984SMatthew G. Knepley         PetscBool    fimp;
436692d50984SMatthew G. Knepley 
43679566063dSJacob Faibussowitsch         PetscCall(PetscDSGetImplicit(prob, f, &fimp));
436892d50984SMatthew G. Knepley         if (isImplicit != fimp) continue;
43699566063dSJacob Faibussowitsch         PetscCall(PetscDSGetDiscretization(prob, f, &obj));
43709566063dSJacob Faibussowitsch         PetscCall(PetscObjectGetClassId(obj, &id));
437192d50984SMatthew G. Knepley         if (id == PETSCFE_CLASSID) {
437292d50984SMatthew G. Knepley           PetscFE fe = (PetscFE)obj;
437392d50984SMatthew G. Knepley 
43749566063dSJacob Faibussowitsch           PetscCall(PetscFEGetQuadrature(fe, &quads[f]));
43759566063dSJacob Faibussowitsch           PetscCall(PetscObjectReference((PetscObject)quads[f]));
43769566063dSJacob Faibussowitsch           PetscCall(DMSNESGetFEGeom(coordField, cellIS, quads[f], PETSC_FALSE, &geoms[f]));
437792d50984SMatthew G. Knepley         }
437892d50984SMatthew G. Knepley       }
437992d50984SMatthew G. Knepley     }
438092d50984SMatthew G. Knepley   }
438192d50984SMatthew G. Knepley   /* Loop over chunks */
43829566063dSJacob Faibussowitsch   PetscCall(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
43839566063dSJacob Faibussowitsch   PetscCall(DMPlexGetHeightStratum(dm, 1, &fStart, &fEnd));
43849566063dSJacob Faibussowitsch   if (useFEM) PetscCall(ISCreate(PETSC_COMM_SELF, &chunkIS));
438592d50984SMatthew G. Knepley   numCells      = cEnd - cStart;
438692d50984SMatthew G. Knepley   numChunks     = 1;
438792d50984SMatthew G. Knepley   cellChunkSize = numCells / numChunks;
438892d50984SMatthew G. Knepley   numChunks     = PetscMin(1, numCells);
43896528b96dSMatthew G. Knepley   key.label     = NULL;
43906528b96dSMatthew G. Knepley   key.value     = 0;
439106ad1575SMatthew G. Knepley   key.part      = 0;
439292d50984SMatthew G. Knepley   for (chunk = 0; chunk < numChunks; ++chunk) {
4393c0006e53SPatrick Farrell     PetscScalar     *elemVec, *fluxL = NULL, *fluxR = NULL;
4394c0006e53SPatrick Farrell     PetscReal       *vol   = NULL;
4395c0006e53SPatrick Farrell     PetscFVFaceGeom *fgeom = NULL;
439692d50984SMatthew G. Knepley     PetscInt         cS = cStart + chunk * cellChunkSize, cE = PetscMin(cS + cellChunkSize, cEnd), numCells = cE - cS, c;
4397c0006e53SPatrick Farrell     PetscInt         numFaces = 0;
439892d50984SMatthew G. Knepley 
439992d50984SMatthew G. Knepley     /* Extract field coefficients */
440092d50984SMatthew G. Knepley     if (useFEM) {
44019566063dSJacob Faibussowitsch       PetscCall(ISGetPointSubrange(chunkIS, cS, cE, cells));
44029566063dSJacob Faibussowitsch       PetscCall(DMPlexGetCellFields(dm, chunkIS, locX, locX_t, locA, &u, &u_t, &a));
44039566063dSJacob Faibussowitsch       PetscCall(DMGetWorkArray(dm, numCells * totDim, MPIU_SCALAR, &elemVec));
44049566063dSJacob Faibussowitsch       PetscCall(PetscArrayzero(elemVec, numCells * totDim));
440592d50984SMatthew G. Knepley     }
440692d50984SMatthew 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 */
440792d50984SMatthew G. Knepley     /* Loop over fields */
440892d50984SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
440992d50984SMatthew G. Knepley       PetscObject  obj;
441092d50984SMatthew G. Knepley       PetscClassId id;
441192d50984SMatthew G. Knepley       PetscBool    fimp;
441292d50984SMatthew G. Knepley       PetscInt     numChunks, numBatches, batchSize, numBlocks, blockSize, Ne, Nr, offset;
441392d50984SMatthew G. Knepley 
44146528b96dSMatthew G. Knepley       key.field = f;
44159566063dSJacob Faibussowitsch       PetscCall(PetscDSGetImplicit(prob, f, &fimp));
441692d50984SMatthew G. Knepley       if (isImplicit != fimp) continue;
44179566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(prob, f, &obj));
44189566063dSJacob Faibussowitsch       PetscCall(PetscObjectGetClassId(obj, &id));
441992d50984SMatthew G. Knepley       if (id == PETSCFE_CLASSID) {
442092d50984SMatthew G. Knepley         PetscFE         fe        = (PetscFE)obj;
442192d50984SMatthew G. Knepley         PetscFEGeom    *geom      = affineGeom ? affineGeom : geoms[f];
442292d50984SMatthew G. Knepley         PetscFEGeom    *chunkGeom = NULL;
442392d50984SMatthew G. Knepley         PetscQuadrature quad      = affineQuad ? affineQuad : quads[f];
442492d50984SMatthew G. Knepley         PetscInt        Nq, Nb;
442592d50984SMatthew G. Knepley 
44269566063dSJacob Faibussowitsch         PetscCall(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
44279566063dSJacob Faibussowitsch         PetscCall(PetscQuadratureGetData(quad, NULL, NULL, &Nq, NULL, NULL));
44289566063dSJacob Faibussowitsch         PetscCall(PetscFEGetDimension(fe, &Nb));
442992d50984SMatthew G. Knepley         blockSize = Nb;
443092d50984SMatthew G. Knepley         batchSize = numBlocks * blockSize;
44319566063dSJacob Faibussowitsch         PetscCall(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
443292d50984SMatthew G. Knepley         numChunks = numCells / (numBatches * batchSize);
443392d50984SMatthew G. Knepley         Ne        = numChunks * numBatches * batchSize;
443492d50984SMatthew G. Knepley         Nr        = numCells % (numBatches * batchSize);
443592d50984SMatthew G. Knepley         offset    = numCells - Nr;
443692d50984SMatthew G. Knepley         /* Integrate FE residual to get elemVec (need fields at quadrature points) */
443792d50984SMatthew 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) */
44389566063dSJacob Faibussowitsch         PetscCall(PetscFEGeomGetChunk(geom, 0, offset, &chunkGeom));
44399566063dSJacob Faibussowitsch         PetscCall(PetscFEIntegrateResidual(prob, key, Ne, chunkGeom, u, u_t, probAux, a, t, elemVec));
44409566063dSJacob Faibussowitsch         PetscCall(PetscFEGeomGetChunk(geom, offset, numCells, &chunkGeom));
44418e3a54c0SPierre Jolivet         PetscCall(PetscFEIntegrateResidual(prob, key, Nr, chunkGeom, &u[offset * totDim], PetscSafePointerPlusOffset(u_t, offset * totDim), probAux, &a[offset * totDimAux], t, &elemVec[offset * totDim]));
44429566063dSJacob Faibussowitsch         PetscCall(PetscFEGeomRestoreChunk(geom, offset, numCells, &chunkGeom));
444392d50984SMatthew G. Knepley       } else if (id == PETSCFV_CLASSID) {
444492d50984SMatthew G. Knepley         PetscFV fv = (PetscFV)obj;
444592d50984SMatthew G. Knepley 
444692d50984SMatthew G. Knepley         Ne = numFaces;
444792d50984SMatthew G. Knepley         /* Riemann solve over faces (need fields at face centroids) */
444892d50984SMatthew G. Knepley         /*   We need to evaluate FE fields at those coordinates */
44499566063dSJacob Faibussowitsch         PetscCall(PetscFVIntegrateRHSFunction(fv, prob, f, Ne, fgeom, vol, uL, uR, fluxL, fluxR));
445063a3b9bcSJacob Faibussowitsch       } else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, f);
445192d50984SMatthew G. Knepley     }
445292d50984SMatthew G. Knepley     /* Loop over domain */
445392d50984SMatthew G. Knepley     if (useFEM) {
445492d50984SMatthew G. Knepley       /* Add elemVec to locX */
445592d50984SMatthew G. Knepley       for (c = cS; c < cE; ++c) {
445692d50984SMatthew G. Knepley         const PetscInt cell = cells ? cells[c] : c;
445792d50984SMatthew G. Knepley         const PetscInt cind = c - cStart;
445892d50984SMatthew G. Knepley 
44599566063dSJacob Faibussowitsch         if (mesh->printFEM > 1) PetscCall(DMPrintCellVector(cell, name, totDim, &elemVec[cind * totDim]));
446092d50984SMatthew G. Knepley         if (ghostLabel) {
446192d50984SMatthew G. Knepley           PetscInt ghostVal;
446292d50984SMatthew G. Knepley 
44639566063dSJacob Faibussowitsch           PetscCall(DMLabelGetValue(ghostLabel, cell, &ghostVal));
446492d50984SMatthew G. Knepley           if (ghostVal > 0) continue;
446592d50984SMatthew G. Knepley         }
44669566063dSJacob Faibussowitsch         PetscCall(DMPlexVecSetClosure(dm, section, locF, cell, &elemVec[cind * totDim], ADD_ALL_VALUES));
446792d50984SMatthew G. Knepley       }
446892d50984SMatthew G. Knepley     }
446992d50984SMatthew G. Knepley     /* Handle time derivative */
447092d50984SMatthew G. Knepley     if (locX_t) {
447192d50984SMatthew G. Knepley       PetscScalar *x_t, *fa;
447292d50984SMatthew G. Knepley 
44739566063dSJacob Faibussowitsch       PetscCall(VecGetArray(locF, &fa));
44749566063dSJacob Faibussowitsch       PetscCall(VecGetArray(locX_t, &x_t));
447592d50984SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
447692d50984SMatthew G. Knepley         PetscFV      fv;
447792d50984SMatthew G. Knepley         PetscObject  obj;
447892d50984SMatthew G. Knepley         PetscClassId id;
447992d50984SMatthew G. Knepley         PetscInt     pdim, d;
448092d50984SMatthew G. Knepley 
44819566063dSJacob Faibussowitsch         PetscCall(PetscDSGetDiscretization(prob, f, &obj));
44829566063dSJacob Faibussowitsch         PetscCall(PetscObjectGetClassId(obj, &id));
448392d50984SMatthew G. Knepley         if (id != PETSCFV_CLASSID) continue;
448492d50984SMatthew G. Knepley         fv = (PetscFV)obj;
44859566063dSJacob Faibussowitsch         PetscCall(PetscFVGetNumComponents(fv, &pdim));
448692d50984SMatthew G. Knepley         for (c = cS; c < cE; ++c) {
448792d50984SMatthew G. Knepley           const PetscInt cell = cells ? cells[c] : c;
448892d50984SMatthew G. Knepley           PetscScalar   *u_t, *r;
448992d50984SMatthew G. Knepley 
449092d50984SMatthew G. Knepley           if (ghostLabel) {
449192d50984SMatthew G. Knepley             PetscInt ghostVal;
449292d50984SMatthew G. Knepley 
44939566063dSJacob Faibussowitsch             PetscCall(DMLabelGetValue(ghostLabel, cell, &ghostVal));
449492d50984SMatthew G. Knepley             if (ghostVal > 0) continue;
449592d50984SMatthew G. Knepley           }
44969566063dSJacob Faibussowitsch           PetscCall(DMPlexPointLocalFieldRead(dm, cell, f, x_t, &u_t));
44979566063dSJacob Faibussowitsch           PetscCall(DMPlexPointLocalFieldRef(dm, cell, f, fa, &r));
449892d50984SMatthew G. Knepley           for (d = 0; d < pdim; ++d) r[d] += u_t[d];
449992d50984SMatthew G. Knepley         }
450092d50984SMatthew G. Knepley       }
45019566063dSJacob Faibussowitsch       PetscCall(VecRestoreArray(locX_t, &x_t));
45029566063dSJacob Faibussowitsch       PetscCall(VecRestoreArray(locF, &fa));
450392d50984SMatthew G. Knepley     }
450492d50984SMatthew G. Knepley     if (useFEM) {
45059566063dSJacob Faibussowitsch       PetscCall(DMPlexRestoreCellFields(dm, chunkIS, locX, locX_t, locA, &u, &u_t, &a));
45069566063dSJacob Faibussowitsch       PetscCall(DMRestoreWorkArray(dm, numCells * totDim, MPIU_SCALAR, &elemVec));
450792d50984SMatthew G. Knepley     }
450892d50984SMatthew G. Knepley   }
45099566063dSJacob Faibussowitsch   if (useFEM) PetscCall(ISDestroy(&chunkIS));
45109566063dSJacob Faibussowitsch   PetscCall(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
451192d50984SMatthew G. Knepley   /* TODO Could include boundary residual here (see DMPlexComputeResidual_Internal) */
451292d50984SMatthew G. Knepley   if (useFEM) {
451392d50984SMatthew G. Knepley     if (maxDegree <= 1) {
45149566063dSJacob Faibussowitsch       PetscCall(DMSNESRestoreFEGeom(coordField, cellIS, affineQuad, PETSC_FALSE, &affineGeom));
45159566063dSJacob Faibussowitsch       PetscCall(PetscQuadratureDestroy(&affineQuad));
451692d50984SMatthew G. Knepley     } else {
451792d50984SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
45189566063dSJacob Faibussowitsch         PetscCall(DMSNESRestoreFEGeom(coordField, cellIS, quads[f], PETSC_FALSE, &geoms[f]));
45199566063dSJacob Faibussowitsch         PetscCall(PetscQuadratureDestroy(&quads[f]));
452092d50984SMatthew G. Knepley       }
45219566063dSJacob Faibussowitsch       PetscCall(PetscFree2(quads, geoms));
452292d50984SMatthew G. Knepley     }
452392d50984SMatthew G. Knepley   }
45249566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_ResidualFEM, dm, 0, 0, 0));
45253ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
452692d50984SMatthew G. Knepley }
452792d50984SMatthew G. Knepley 
4528a1cf66bbSMatthew G. Knepley /*
4529a1cf66bbSMatthew 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
4530a1cf66bbSMatthew G. Knepley 
4531a1cf66bbSMatthew G. Knepley   X   - The local solution vector
4532a5b23f4aSJose E. Roman   X_t - The local solution time derivative vector, or NULL
4533a1cf66bbSMatthew G. Knepley */
4534d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexComputeJacobian_Patch_Internal(DM dm, PetscSection section, PetscSection globalSection, IS cellIS, PetscReal t, PetscReal X_tShift, Vec X, Vec X_t, Mat Jac, Mat JacP, void *ctx)
4535d71ae5a4SJacob Faibussowitsch {
4536a1cf66bbSMatthew G. Knepley   DM_Plex        *mesh = (DM_Plex *)dm->data;
4537a1cf66bbSMatthew G. Knepley   const char     *name = "Jacobian", *nameP = "JacobianPre";
4538a1cf66bbSMatthew G. Knepley   DM              dmAux = NULL;
4539a1cf66bbSMatthew G. Knepley   PetscDS         prob, probAux = NULL;
4540a1cf66bbSMatthew G. Knepley   PetscSection    sectionAux = NULL;
4541a1cf66bbSMatthew G. Knepley   Vec             A;
4542a1cf66bbSMatthew G. Knepley   DMField         coordField;
4543a1cf66bbSMatthew G. Knepley   PetscFEGeom    *cgeomFEM;
4544a1cf66bbSMatthew G. Knepley   PetscQuadrature qGeom = NULL;
4545a1cf66bbSMatthew G. Knepley   Mat             J = Jac, JP = JacP;
4546a1cf66bbSMatthew G. Knepley   PetscScalar    *work, *u = NULL, *u_t = NULL, *a = NULL, *elemMat = NULL, *elemMatP = NULL, *elemMatD = NULL;
4547e432b41dSStefano Zampini   PetscBool       hasJac, hasPrec, hasDyn, assembleJac, *isFE, hasFV = PETSC_FALSE;
4548a1cf66bbSMatthew G. Knepley   const PetscInt *cells;
454906ad1575SMatthew G. Knepley   PetscFormKey    key;
45509b2fc754SMatthew G. Knepley   PetscInt        Nf, fieldI, fieldJ, maxDegree, numCells, cStart, cEnd, numChunks, chunkSize, chunk, totDim, totDimAux = 0, sz, wsz, off = 0, offCell = 0;
4551a1cf66bbSMatthew G. Knepley 
4552a1cf66bbSMatthew G. Knepley   PetscFunctionBegin;
45539566063dSJacob Faibussowitsch   PetscCall(ISGetLocalSize(cellIS, &numCells));
45549566063dSJacob Faibussowitsch   PetscCall(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
45559566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_JacobianFEM, dm, 0, 0, 0));
45569566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dm, &prob));
45579566063dSJacob Faibussowitsch   PetscCall(DMGetAuxiliaryVec(dm, NULL, 0, 0, &A));
45589a2a23afSMatthew G. Knepley   if (A) {
45599566063dSJacob Faibussowitsch     PetscCall(VecGetDM(A, &dmAux));
45609566063dSJacob Faibussowitsch     PetscCall(DMGetLocalSection(dmAux, &sectionAux));
45619566063dSJacob Faibussowitsch     PetscCall(DMGetDS(dmAux, &probAux));
4562a1cf66bbSMatthew G. Knepley   }
4563a1cf66bbSMatthew G. Knepley   /* Get flags */
45649566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumFields(prob, &Nf));
45659566063dSJacob Faibussowitsch   PetscCall(DMGetWorkArray(dm, Nf, MPIU_BOOL, &isFE));
4566a1cf66bbSMatthew G. Knepley   for (fieldI = 0; fieldI < Nf; ++fieldI) {
4567a1cf66bbSMatthew G. Knepley     PetscObject  disc;
4568a1cf66bbSMatthew G. Knepley     PetscClassId id;
45699566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, fieldI, &disc));
45709566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(disc, &id));
45719371c9d4SSatish Balay     if (id == PETSCFE_CLASSID) {
45729371c9d4SSatish Balay       isFE[fieldI] = PETSC_TRUE;
45739371c9d4SSatish Balay     } else if (id == PETSCFV_CLASSID) {
45749371c9d4SSatish Balay       hasFV        = PETSC_TRUE;
45759371c9d4SSatish Balay       isFE[fieldI] = PETSC_FALSE;
45769371c9d4SSatish Balay     }
4577a1cf66bbSMatthew G. Knepley   }
45789566063dSJacob Faibussowitsch   PetscCall(PetscDSHasJacobian(prob, &hasJac));
45799566063dSJacob Faibussowitsch   PetscCall(PetscDSHasJacobianPreconditioner(prob, &hasPrec));
45809566063dSJacob Faibussowitsch   PetscCall(PetscDSHasDynamicJacobian(prob, &hasDyn));
4581a1cf66bbSMatthew G. Knepley   assembleJac = hasJac && hasPrec && (Jac != JacP) ? PETSC_TRUE : PETSC_FALSE;
4582a1cf66bbSMatthew G. Knepley   hasDyn      = hasDyn && (X_tShift != 0.0) ? PETSC_TRUE : PETSC_FALSE;
45839566063dSJacob Faibussowitsch   if (hasFV) PetscCall(MatSetOption(JP, MAT_IGNORE_ZERO_ENTRIES, PETSC_TRUE)); /* No allocated space for FV stuff, so ignore the zero entries */
45849566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(prob, &totDim));
45859566063dSJacob Faibussowitsch   if (probAux) PetscCall(PetscDSGetTotalDimension(probAux, &totDimAux));
4586a1cf66bbSMatthew G. Knepley   /* Compute batch sizes */
4587a1cf66bbSMatthew G. Knepley   if (isFE[0]) {
4588a1cf66bbSMatthew G. Knepley     PetscFE         fe;
4589a1cf66bbSMatthew G. Knepley     PetscQuadrature q;
4590a1cf66bbSMatthew G. Knepley     PetscInt        numQuadPoints, numBatches, batchSize, numBlocks, blockSize, Nb;
4591a1cf66bbSMatthew G. Knepley 
45929566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, 0, (PetscObject *)&fe));
45939566063dSJacob Faibussowitsch     PetscCall(PetscFEGetQuadrature(fe, &q));
45949566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureGetData(q, NULL, NULL, &numQuadPoints, NULL, NULL));
45959566063dSJacob Faibussowitsch     PetscCall(PetscFEGetDimension(fe, &Nb));
45969566063dSJacob Faibussowitsch     PetscCall(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
4597a1cf66bbSMatthew G. Knepley     blockSize = Nb * numQuadPoints;
4598a1cf66bbSMatthew G. Knepley     batchSize = numBlocks * blockSize;
4599a1cf66bbSMatthew G. Knepley     chunkSize = numBatches * batchSize;
4600a1cf66bbSMatthew G. Knepley     numChunks = numCells / chunkSize + numCells % chunkSize;
46019566063dSJacob Faibussowitsch     PetscCall(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
4602a1cf66bbSMatthew G. Knepley   } else {
4603a1cf66bbSMatthew G. Knepley     chunkSize = numCells;
4604a1cf66bbSMatthew G. Knepley     numChunks = 1;
4605a1cf66bbSMatthew G. Knepley   }
4606a1cf66bbSMatthew G. Knepley   /* Get work space */
4607a1cf66bbSMatthew 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;
46089566063dSJacob Faibussowitsch   PetscCall(DMGetWorkArray(dm, wsz, MPIU_SCALAR, &work));
46099566063dSJacob Faibussowitsch   PetscCall(PetscArrayzero(work, wsz));
4610a1cf66bbSMatthew G. Knepley   off      = 0;
4611a1cf66bbSMatthew G. Knepley   u        = X ? (sz = chunkSize * totDim, off += sz, work + off - sz) : NULL;
4612a1cf66bbSMatthew G. Knepley   u_t      = X_t ? (sz = chunkSize * totDim, off += sz, work + off - sz) : NULL;
4613a1cf66bbSMatthew G. Knepley   a        = dmAux ? (sz = chunkSize * totDimAux, off += sz, work + off - sz) : NULL;
4614a1cf66bbSMatthew G. Knepley   elemMat  = hasJac ? (sz = chunkSize * totDim * totDim, off += sz, work + off - sz) : NULL;
4615a1cf66bbSMatthew G. Knepley   elemMatP = hasPrec ? (sz = chunkSize * totDim * totDim, off += sz, work + off - sz) : NULL;
4616a1cf66bbSMatthew G. Knepley   elemMatD = hasDyn ? (sz = chunkSize * totDim * totDim, off += sz, work + off - sz) : NULL;
461763a3b9bcSJacob Faibussowitsch   PetscCheck(off == wsz, PETSC_COMM_SELF, PETSC_ERR_PLIB, "Error is workspace size %" PetscInt_FMT " should be %" PetscInt_FMT, off, wsz);
4618a1cf66bbSMatthew G. Knepley   /* Setup geometry */
46199566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateField(dm, &coordField));
46209566063dSJacob Faibussowitsch   PetscCall(DMFieldGetDegree(coordField, cellIS, NULL, &maxDegree));
46219566063dSJacob Faibussowitsch   if (maxDegree <= 1) PetscCall(DMFieldCreateDefaultQuadrature(coordField, cellIS, &qGeom));
4622a1cf66bbSMatthew G. Knepley   if (!qGeom) {
4623a1cf66bbSMatthew G. Knepley     PetscFE fe;
4624a1cf66bbSMatthew G. Knepley 
46259566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, 0, (PetscObject *)&fe));
46269566063dSJacob Faibussowitsch     PetscCall(PetscFEGetQuadrature(fe, &qGeom));
46279566063dSJacob Faibussowitsch     PetscCall(PetscObjectReference((PetscObject)qGeom));
4628a1cf66bbSMatthew G. Knepley   }
46299566063dSJacob Faibussowitsch   PetscCall(DMSNESGetFEGeom(coordField, cellIS, qGeom, PETSC_FALSE, &cgeomFEM));
4630a1cf66bbSMatthew G. Knepley   /* Compute volume integrals */
46319566063dSJacob Faibussowitsch   if (assembleJac) PetscCall(MatZeroEntries(J));
46329566063dSJacob Faibussowitsch   PetscCall(MatZeroEntries(JP));
46336528b96dSMatthew G. Knepley   key.label = NULL;
46346528b96dSMatthew G. Knepley   key.value = 0;
463506ad1575SMatthew G. Knepley   key.part  = 0;
4636a1cf66bbSMatthew G. Knepley   for (chunk = 0; chunk < numChunks; ++chunk, offCell += chunkSize) {
4637a1cf66bbSMatthew G. Knepley     const PetscInt Ncell = PetscMin(chunkSize, numCells - offCell);
4638a1cf66bbSMatthew G. Knepley     PetscInt       c;
4639a1cf66bbSMatthew G. Knepley 
4640a1cf66bbSMatthew G. Knepley     /* Extract values */
4641a1cf66bbSMatthew G. Knepley     for (c = 0; c < Ncell; ++c) {
4642a1cf66bbSMatthew G. Knepley       const PetscInt cell = cells ? cells[c + offCell] : c + offCell;
4643a1cf66bbSMatthew G. Knepley       PetscScalar   *x = NULL, *x_t = NULL;
4644a1cf66bbSMatthew G. Knepley       PetscInt       i;
4645a1cf66bbSMatthew G. Knepley 
4646a1cf66bbSMatthew G. Knepley       if (X) {
46479566063dSJacob Faibussowitsch         PetscCall(DMPlexVecGetClosure(dm, section, X, cell, NULL, &x));
4648a1cf66bbSMatthew G. Knepley         for (i = 0; i < totDim; ++i) u[c * totDim + i] = x[i];
46499566063dSJacob Faibussowitsch         PetscCall(DMPlexVecRestoreClosure(dm, section, X, cell, NULL, &x));
4650a1cf66bbSMatthew G. Knepley       }
4651a1cf66bbSMatthew G. Knepley       if (X_t) {
46529566063dSJacob Faibussowitsch         PetscCall(DMPlexVecGetClosure(dm, section, X_t, cell, NULL, &x_t));
4653a1cf66bbSMatthew G. Knepley         for (i = 0; i < totDim; ++i) u_t[c * totDim + i] = x_t[i];
46549566063dSJacob Faibussowitsch         PetscCall(DMPlexVecRestoreClosure(dm, section, X_t, cell, NULL, &x_t));
4655a1cf66bbSMatthew G. Knepley       }
4656a1cf66bbSMatthew G. Knepley       if (dmAux) {
46579566063dSJacob Faibussowitsch         PetscCall(DMPlexVecGetClosure(dmAux, sectionAux, A, cell, NULL, &x));
4658a1cf66bbSMatthew G. Knepley         for (i = 0; i < totDimAux; ++i) a[c * totDimAux + i] = x[i];
46599566063dSJacob Faibussowitsch         PetscCall(DMPlexVecRestoreClosure(dmAux, sectionAux, A, cell, NULL, &x));
4660a1cf66bbSMatthew G. Knepley       }
4661a1cf66bbSMatthew G. Knepley     }
4662a1cf66bbSMatthew G. Knepley     for (fieldI = 0; fieldI < Nf; ++fieldI) {
4663a1cf66bbSMatthew G. Knepley       PetscFE fe;
46649566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(prob, fieldI, (PetscObject *)&fe));
4665a1cf66bbSMatthew G. Knepley       for (fieldJ = 0; fieldJ < Nf; ++fieldJ) {
46666528b96dSMatthew G. Knepley         key.field = fieldI * Nf + fieldJ;
46679566063dSJacob Faibussowitsch         if (hasJac) PetscCall(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN, key, Ncell, cgeomFEM, u, u_t, probAux, a, t, X_tShift, elemMat));
46689566063dSJacob Faibussowitsch         if (hasPrec) PetscCall(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN_PRE, key, Ncell, cgeomFEM, u, u_t, probAux, a, t, X_tShift, elemMatP));
46699566063dSJacob Faibussowitsch         if (hasDyn) PetscCall(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN_DYN, key, Ncell, cgeomFEM, u, u_t, probAux, a, t, X_tShift, elemMatD));
4670a1cf66bbSMatthew G. Knepley       }
4671a1cf66bbSMatthew G. Knepley       /* For finite volume, add the identity */
4672a1cf66bbSMatthew G. Knepley       if (!isFE[fieldI]) {
4673a1cf66bbSMatthew G. Knepley         PetscFV  fv;
4674a1cf66bbSMatthew G. Knepley         PetscInt eOffset = 0, Nc, fc, foff;
4675a1cf66bbSMatthew G. Knepley 
46769566063dSJacob Faibussowitsch         PetscCall(PetscDSGetFieldOffset(prob, fieldI, &foff));
46779566063dSJacob Faibussowitsch         PetscCall(PetscDSGetDiscretization(prob, fieldI, (PetscObject *)&fv));
46789566063dSJacob Faibussowitsch         PetscCall(PetscFVGetNumComponents(fv, &Nc));
4679a1cf66bbSMatthew G. Knepley         for (c = 0; c < chunkSize; ++c, eOffset += totDim * totDim) {
4680a1cf66bbSMatthew G. Knepley           for (fc = 0; fc < Nc; ++fc) {
4681a1cf66bbSMatthew G. Knepley             const PetscInt i = foff + fc;
4682ad540459SPierre Jolivet             if (hasJac) elemMat[eOffset + i * totDim + i] = 1.0;
4683ad540459SPierre Jolivet             if (hasPrec) elemMatP[eOffset + i * totDim + i] = 1.0;
4684a1cf66bbSMatthew G. Knepley           }
4685a1cf66bbSMatthew G. Knepley         }
4686a1cf66bbSMatthew G. Knepley       }
4687a1cf66bbSMatthew G. Knepley     }
4688a1cf66bbSMatthew G. Knepley     /*   Add contribution from X_t */
46899371c9d4SSatish Balay     if (hasDyn) {
46909371c9d4SSatish Balay       for (c = 0; c < chunkSize * totDim * totDim; ++c) elemMat[c] += X_tShift * elemMatD[c];
46919371c9d4SSatish Balay     }
4692a1cf66bbSMatthew G. Knepley     /* Insert values into matrix */
4693a1cf66bbSMatthew G. Knepley     for (c = 0; c < Ncell; ++c) {
4694a1cf66bbSMatthew G. Knepley       const PetscInt cell = cells ? cells[c + offCell] : c + offCell;
4695a1cf66bbSMatthew G. Knepley       if (mesh->printFEM > 1) {
46969566063dSJacob Faibussowitsch         if (hasJac) PetscCall(DMPrintCellMatrix(cell, name, totDim, totDim, &elemMat[(c - cStart) * totDim * totDim]));
46979566063dSJacob Faibussowitsch         if (hasPrec) PetscCall(DMPrintCellMatrix(cell, nameP, totDim, totDim, &elemMatP[(c - cStart) * totDim * totDim]));
4698a1cf66bbSMatthew G. Knepley       }
4699e8e188d2SZach Atkins       if (assembleJac) PetscCall(DMPlexMatSetClosure_Internal(dm, section, globalSection, mesh->useMatClPerm, Jac, cell, &elemMat[(c - cStart) * totDim * totDim], ADD_VALUES));
4700e8e188d2SZach Atkins       PetscCall(DMPlexMatSetClosure_Internal(dm, section, globalSection, mesh->useMatClPerm, JP, cell, &elemMat[(c - cStart) * totDim * totDim], ADD_VALUES));
4701a1cf66bbSMatthew G. Knepley     }
4702a1cf66bbSMatthew G. Knepley   }
4703a1cf66bbSMatthew G. Knepley   /* Cleanup */
47049566063dSJacob Faibussowitsch   PetscCall(DMSNESRestoreFEGeom(coordField, cellIS, qGeom, PETSC_FALSE, &cgeomFEM));
47059566063dSJacob Faibussowitsch   PetscCall(PetscQuadratureDestroy(&qGeom));
47069566063dSJacob Faibussowitsch   if (hasFV) PetscCall(MatSetOption(JacP, MAT_IGNORE_ZERO_ENTRIES, PETSC_FALSE));
47079566063dSJacob Faibussowitsch   PetscCall(DMRestoreWorkArray(dm, Nf, MPIU_BOOL, &isFE));
47089566063dSJacob 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));
4709a1cf66bbSMatthew G. Knepley   /* Compute boundary integrals */
47109566063dSJacob Faibussowitsch   /* PetscCall(DMPlexComputeBdJacobian_Internal(dm, X, X_t, t, X_tShift, Jac, JacP, ctx)); */
4711a1cf66bbSMatthew G. Knepley   /* Assemble matrix */
47129371c9d4SSatish Balay   if (assembleJac) {
47139371c9d4SSatish Balay     PetscCall(MatAssemblyBegin(Jac, MAT_FINAL_ASSEMBLY));
47149371c9d4SSatish Balay     PetscCall(MatAssemblyEnd(Jac, MAT_FINAL_ASSEMBLY));
47159371c9d4SSatish Balay   }
47169371c9d4SSatish Balay   PetscCall(MatAssemblyBegin(JacP, MAT_FINAL_ASSEMBLY));
47179371c9d4SSatish Balay   PetscCall(MatAssemblyEnd(JacP, MAT_FINAL_ASSEMBLY));
47189566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_JacobianFEM, dm, 0, 0, 0));
47193ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
4720a1cf66bbSMatthew G. Knepley }
47213e9753d6SMatthew G. Knepley 
47224ee01570SBarry Smith /* FEM Assembly Function */
47233e9753d6SMatthew G. Knepley 
4724d71ae5a4SJacob Faibussowitsch static PetscErrorCode DMConvertPlex_Internal(DM dm, DM *plex, PetscBool copy)
4725d71ae5a4SJacob Faibussowitsch {
47263e9753d6SMatthew G. Knepley   PetscBool isPlex;
47273e9753d6SMatthew G. Knepley 
47283e9753d6SMatthew G. Knepley   PetscFunctionBegin;
47299566063dSJacob Faibussowitsch   PetscCall(PetscObjectTypeCompare((PetscObject)dm, DMPLEX, &isPlex));
47303e9753d6SMatthew G. Knepley   if (isPlex) {
47313e9753d6SMatthew G. Knepley     *plex = dm;
47329566063dSJacob Faibussowitsch     PetscCall(PetscObjectReference((PetscObject)dm));
47333e9753d6SMatthew G. Knepley   } else {
47349566063dSJacob Faibussowitsch     PetscCall(PetscObjectQuery((PetscObject)dm, "dm_plex", (PetscObject *)plex));
47353e9753d6SMatthew G. Knepley     if (!*plex) {
47369566063dSJacob Faibussowitsch       PetscCall(DMConvert(dm, DMPLEX, plex));
47379566063dSJacob Faibussowitsch       PetscCall(PetscObjectCompose((PetscObject)dm, "dm_plex", (PetscObject)*plex));
47383e9753d6SMatthew G. Knepley     } else {
47399566063dSJacob Faibussowitsch       PetscCall(PetscObjectReference((PetscObject)*plex));
47403e9753d6SMatthew G. Knepley     }
4741cbf8eb3cSStefano Zampini     if (copy) PetscCall(DMCopyAuxiliaryVec(dm, *plex));
47423e9753d6SMatthew G. Knepley   }
47433ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
47443e9753d6SMatthew G. Knepley }
47453e9753d6SMatthew G. Knepley 
47463e9753d6SMatthew G. Knepley /*@
47473e9753d6SMatthew G. Knepley   DMPlexGetGeometryFVM - Return precomputed geometric data
47483e9753d6SMatthew G. Knepley 
474920f4b53cSBarry Smith   Collective
47503e9753d6SMatthew G. Knepley 
47513e9753d6SMatthew G. Knepley   Input Parameter:
4752a1cb98faSBarry Smith . dm - The `DM`
47533e9753d6SMatthew G. Knepley 
47543e9753d6SMatthew G. Knepley   Output Parameters:
47553e9753d6SMatthew G. Knepley + facegeom  - The values precomputed from face geometry
47563e9753d6SMatthew G. Knepley . cellgeom  - The values precomputed from cell geometry
47573e9753d6SMatthew G. Knepley - minRadius - The minimum radius over the mesh of an inscribed sphere in a cell
47583e9753d6SMatthew G. Knepley 
47593e9753d6SMatthew G. Knepley   Level: developer
47603e9753d6SMatthew G. Knepley 
47611cc06b55SBarry Smith .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `DMTSSetRHSFunctionLocal()`
47623e9753d6SMatthew G. Knepley @*/
4763d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexGetGeometryFVM(DM dm, Vec *facegeom, Vec *cellgeom, PetscReal *minRadius)
4764d71ae5a4SJacob Faibussowitsch {
47653e9753d6SMatthew G. Knepley   DM plex;
47663e9753d6SMatthew G. Knepley 
47673e9753d6SMatthew G. Knepley   PetscFunctionBegin;
47683e9753d6SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
47699566063dSJacob Faibussowitsch   PetscCall(DMConvertPlex_Internal(dm, &plex, PETSC_TRUE));
47709566063dSJacob Faibussowitsch   PetscCall(DMPlexGetDataFVM(plex, NULL, cellgeom, facegeom, NULL));
47719566063dSJacob Faibussowitsch   if (minRadius) PetscCall(DMPlexGetMinRadius(plex, minRadius));
47729566063dSJacob Faibussowitsch   PetscCall(DMDestroy(&plex));
47733ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
47743e9753d6SMatthew G. Knepley }
47753e9753d6SMatthew G. Knepley 
47763e9753d6SMatthew G. Knepley /*@
47773e9753d6SMatthew G. Knepley   DMPlexGetGradientDM - Return gradient data layout
47783e9753d6SMatthew G. Knepley 
477920f4b53cSBarry Smith   Collective
47803e9753d6SMatthew G. Knepley 
47813e9753d6SMatthew G. Knepley   Input Parameters:
4782a1cb98faSBarry Smith + dm - The `DM`
478320f4b53cSBarry Smith - fv - The `PetscFV`
47843e9753d6SMatthew G. Knepley 
47853e9753d6SMatthew G. Knepley   Output Parameter:
47863e9753d6SMatthew G. Knepley . dmGrad - The layout for gradient values
47873e9753d6SMatthew G. Knepley 
47883e9753d6SMatthew G. Knepley   Level: developer
47893e9753d6SMatthew G. Knepley 
47901cc06b55SBarry Smith .seealso: [](ch_unstructured), `DM`, `DMPLEX`, `DMPlexGetGeometryFVM()`
47913e9753d6SMatthew G. Knepley @*/
4792d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexGetGradientDM(DM dm, PetscFV fv, DM *dmGrad)
4793d71ae5a4SJacob Faibussowitsch {
47943e9753d6SMatthew G. Knepley   DM        plex;
47953e9753d6SMatthew G. Knepley   PetscBool computeGradients;
47963e9753d6SMatthew G. Knepley 
47973e9753d6SMatthew G. Knepley   PetscFunctionBegin;
47983e9753d6SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
47993e9753d6SMatthew G. Knepley   PetscValidHeaderSpecific(fv, PETSCFV_CLASSID, 2);
48004f572ea9SToby Isaac   PetscAssertPointer(dmGrad, 3);
48019566063dSJacob Faibussowitsch   PetscCall(PetscFVGetComputeGradients(fv, &computeGradients));
48029371c9d4SSatish Balay   if (!computeGradients) {
48039371c9d4SSatish Balay     *dmGrad = NULL;
48043ba16761SJacob Faibussowitsch     PetscFunctionReturn(PETSC_SUCCESS);
48059371c9d4SSatish Balay   }
48069566063dSJacob Faibussowitsch   PetscCall(DMConvertPlex_Internal(dm, &plex, PETSC_TRUE));
48079566063dSJacob Faibussowitsch   PetscCall(DMPlexGetDataFVM(plex, fv, NULL, NULL, dmGrad));
48089566063dSJacob Faibussowitsch   PetscCall(DMDestroy(&plex));
48093ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
48103e9753d6SMatthew G. Knepley }
48113e9753d6SMatthew G. Knepley 
4812d71ae5a4SJacob Faibussowitsch static PetscErrorCode DMPlexComputeBdResidual_Single_Internal(DM dm, PetscReal t, PetscWeakForm wf, PetscFormKey key, Vec locX, Vec locX_t, Vec locF, DMField coordField, IS facetIS)
4813d71ae5a4SJacob Faibussowitsch {
48143e9753d6SMatthew G. Knepley   DM_Plex        *mesh = (DM_Plex *)dm->data;
48153e9753d6SMatthew G. Knepley   DM              plex = NULL, plexA = NULL;
4816673019faSMatthew G. Knepley   const char     *name = "BdResidual";
48173e9753d6SMatthew G. Knepley   DMEnclosureType encAux;
48183e9753d6SMatthew G. Knepley   PetscDS         prob, probAux       = NULL;
48193e9753d6SMatthew G. Knepley   PetscSection    section, sectionAux = NULL;
48203e9753d6SMatthew G. Knepley   Vec             locA = NULL;
48213e9753d6SMatthew G. Knepley   PetscScalar    *u = NULL, *u_t = NULL, *a = NULL, *elemVec = NULL;
48223e9753d6SMatthew G. Knepley   PetscInt        totDim, totDimAux = 0;
48233e9753d6SMatthew G. Knepley 
48243e9753d6SMatthew G. Knepley   PetscFunctionBegin;
48259566063dSJacob Faibussowitsch   PetscCall(DMConvert(dm, DMPLEX, &plex));
48269566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
48279566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dm, &prob));
48289566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(prob, &totDim));
48299566063dSJacob Faibussowitsch   PetscCall(DMGetAuxiliaryVec(dm, key.label, key.value, key.part, &locA));
48303e9753d6SMatthew G. Knepley   if (locA) {
48313e9753d6SMatthew G. Knepley     DM dmAux;
48323e9753d6SMatthew G. Knepley 
48339566063dSJacob Faibussowitsch     PetscCall(VecGetDM(locA, &dmAux));
48349566063dSJacob Faibussowitsch     PetscCall(DMGetEnclosureRelation(dmAux, dm, &encAux));
48359566063dSJacob Faibussowitsch     PetscCall(DMConvert(dmAux, DMPLEX, &plexA));
48369566063dSJacob Faibussowitsch     PetscCall(DMGetDS(plexA, &probAux));
48379566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalDimension(probAux, &totDimAux));
48389566063dSJacob Faibussowitsch     PetscCall(DMGetLocalSection(plexA, &sectionAux));
48393e9753d6SMatthew G. Knepley   }
48400c290148SMatthew G. Knepley   {
48413e9753d6SMatthew G. Knepley     PetscFEGeom    *fgeom;
48423e9753d6SMatthew G. Knepley     PetscInt        maxDegree;
48433e9753d6SMatthew G. Knepley     PetscQuadrature qGeom = NULL;
48443e9753d6SMatthew G. Knepley     IS              pointIS;
48453e9753d6SMatthew G. Knepley     const PetscInt *points;
48463e9753d6SMatthew G. Knepley     PetscInt        numFaces, face, Nq;
48473e9753d6SMatthew G. Knepley 
48489566063dSJacob Faibussowitsch     PetscCall(DMLabelGetStratumIS(key.label, key.value, &pointIS));
48490c290148SMatthew G. Knepley     if (!pointIS) goto end; /* No points with that id on this process */
48503e9753d6SMatthew G. Knepley     {
48513e9753d6SMatthew G. Knepley       IS isectIS;
48523e9753d6SMatthew G. Knepley 
48533e9753d6SMatthew G. Knepley       /* TODO: Special cases of ISIntersect where it is quick to check a priori if one is a superset of the other */
48549566063dSJacob Faibussowitsch       PetscCall(ISIntersect_Caching_Internal(facetIS, pointIS, &isectIS));
48559566063dSJacob Faibussowitsch       PetscCall(ISDestroy(&pointIS));
48563e9753d6SMatthew G. Knepley       pointIS = isectIS;
48573e9753d6SMatthew G. Knepley     }
48589566063dSJacob Faibussowitsch     PetscCall(ISGetLocalSize(pointIS, &numFaces));
48599566063dSJacob Faibussowitsch     PetscCall(ISGetIndices(pointIS, &points));
48609566063dSJacob Faibussowitsch     PetscCall(PetscMalloc4(numFaces * totDim, &u, locX_t ? numFaces * totDim : 0, &u_t, numFaces * totDim, &elemVec, locA ? numFaces * totDimAux : 0, &a));
48619566063dSJacob Faibussowitsch     PetscCall(DMFieldGetDegree(coordField, pointIS, NULL, &maxDegree));
486248a46eb9SPierre Jolivet     if (maxDegree <= 1) PetscCall(DMFieldCreateDefaultQuadrature(coordField, pointIS, &qGeom));
48633e9753d6SMatthew G. Knepley     if (!qGeom) {
48643e9753d6SMatthew G. Knepley       PetscFE fe;
48653e9753d6SMatthew G. Knepley 
48669566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(prob, key.field, (PetscObject *)&fe));
48679566063dSJacob Faibussowitsch       PetscCall(PetscFEGetFaceQuadrature(fe, &qGeom));
48689566063dSJacob Faibussowitsch       PetscCall(PetscObjectReference((PetscObject)qGeom));
48693e9753d6SMatthew G. Knepley     }
48709566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureGetData(qGeom, NULL, NULL, &Nq, NULL, NULL));
48719566063dSJacob Faibussowitsch     PetscCall(DMSNESGetFEGeom(coordField, pointIS, qGeom, PETSC_TRUE, &fgeom));
48723e9753d6SMatthew G. Knepley     for (face = 0; face < numFaces; ++face) {
4873f15274beSMatthew Knepley       const PetscInt point = points[face], *support;
48743e9753d6SMatthew G. Knepley       PetscScalar   *x     = NULL;
4875f15274beSMatthew Knepley       PetscInt       i;
48763e9753d6SMatthew G. Knepley 
48779566063dSJacob Faibussowitsch       PetscCall(DMPlexGetSupport(dm, point, &support));
48789566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(plex, section, locX, support[0], NULL, &x));
48793e9753d6SMatthew G. Knepley       for (i = 0; i < totDim; ++i) u[face * totDim + i] = x[i];
48809566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(plex, section, locX, support[0], NULL, &x));
48813e9753d6SMatthew G. Knepley       if (locX_t) {
48829566063dSJacob Faibussowitsch         PetscCall(DMPlexVecGetClosure(plex, section, locX_t, support[0], NULL, &x));
48833e9753d6SMatthew G. Knepley         for (i = 0; i < totDim; ++i) u_t[face * totDim + i] = x[i];
48849566063dSJacob Faibussowitsch         PetscCall(DMPlexVecRestoreClosure(plex, section, locX_t, support[0], NULL, &x));
48853e9753d6SMatthew G. Knepley       }
48863e9753d6SMatthew G. Knepley       if (locA) {
48873e9753d6SMatthew G. Knepley         PetscInt subp;
48883e9753d6SMatthew G. Knepley 
48899566063dSJacob Faibussowitsch         PetscCall(DMGetEnclosurePoint(plexA, dm, encAux, support[0], &subp));
48909566063dSJacob Faibussowitsch         PetscCall(DMPlexVecGetClosure(plexA, sectionAux, locA, subp, NULL, &x));
48913e9753d6SMatthew G. Knepley         for (i = 0; i < totDimAux; ++i) a[face * totDimAux + i] = x[i];
48929566063dSJacob Faibussowitsch         PetscCall(DMPlexVecRestoreClosure(plexA, sectionAux, locA, subp, NULL, &x));
48933e9753d6SMatthew G. Knepley       }
48943e9753d6SMatthew G. Knepley     }
48959566063dSJacob Faibussowitsch     PetscCall(PetscArrayzero(elemVec, numFaces * totDim));
48963e9753d6SMatthew G. Knepley     {
48973e9753d6SMatthew G. Knepley       PetscFE      fe;
48983e9753d6SMatthew G. Knepley       PetscInt     Nb;
48993e9753d6SMatthew G. Knepley       PetscFEGeom *chunkGeom = NULL;
49003e9753d6SMatthew G. Knepley       /* Conforming batches */
49013e9753d6SMatthew G. Knepley       PetscInt numChunks, numBatches, numBlocks, Ne, blockSize, batchSize;
49023e9753d6SMatthew G. Knepley       /* Remainder */
49033e9753d6SMatthew G. Knepley       PetscInt Nr, offset;
49043e9753d6SMatthew G. Knepley 
49059566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(prob, key.field, (PetscObject *)&fe));
49069566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDimension(fe, &Nb));
49079566063dSJacob Faibussowitsch       PetscCall(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
49083e9753d6SMatthew G. Knepley       /* TODO: documentation is unclear about what is going on with these numbers: how should Nb / Nq factor in ? */
49093e9753d6SMatthew G. Knepley       blockSize = Nb;
49103e9753d6SMatthew G. Knepley       batchSize = numBlocks * blockSize;
49119566063dSJacob Faibussowitsch       PetscCall(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
49123e9753d6SMatthew G. Knepley       numChunks = numFaces / (numBatches * batchSize);
49133e9753d6SMatthew G. Knepley       Ne        = numChunks * numBatches * batchSize;
49143e9753d6SMatthew G. Knepley       Nr        = numFaces % (numBatches * batchSize);
49153e9753d6SMatthew G. Knepley       offset    = numFaces - Nr;
49169566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomGetChunk(fgeom, 0, offset, &chunkGeom));
49179566063dSJacob Faibussowitsch       PetscCall(PetscFEIntegrateBdResidual(prob, wf, key, Ne, chunkGeom, u, u_t, probAux, a, t, elemVec));
49189566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomRestoreChunk(fgeom, 0, offset, &chunkGeom));
49199566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomGetChunk(fgeom, offset, numFaces, &chunkGeom));
49208e3a54c0SPierre Jolivet       PetscCall(PetscFEIntegrateBdResidual(prob, wf, key, Nr, chunkGeom, &u[offset * totDim], PetscSafePointerPlusOffset(u_t, offset * totDim), probAux, PetscSafePointerPlusOffset(a, offset * totDimAux), t, &elemVec[offset * totDim]));
49219566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomRestoreChunk(fgeom, offset, numFaces, &chunkGeom));
49223e9753d6SMatthew G. Knepley     }
49233e9753d6SMatthew G. Knepley     for (face = 0; face < numFaces; ++face) {
49243e9753d6SMatthew G. Knepley       const PetscInt point = points[face], *support;
49253e9753d6SMatthew G. Knepley 
4926673019faSMatthew G. Knepley       if (mesh->printFEM > 1) PetscCall(DMPrintCellVector(point, name, totDim, &elemVec[face * totDim]));
49279566063dSJacob Faibussowitsch       PetscCall(DMPlexGetSupport(plex, point, &support));
49289566063dSJacob Faibussowitsch       PetscCall(DMPlexVecSetClosure(plex, NULL, locF, support[0], &elemVec[face * totDim], ADD_ALL_VALUES));
49293e9753d6SMatthew G. Knepley     }
49309566063dSJacob Faibussowitsch     PetscCall(DMSNESRestoreFEGeom(coordField, pointIS, qGeom, PETSC_TRUE, &fgeom));
49319566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureDestroy(&qGeom));
49329566063dSJacob Faibussowitsch     PetscCall(ISRestoreIndices(pointIS, &points));
49339566063dSJacob Faibussowitsch     PetscCall(ISDestroy(&pointIS));
49349566063dSJacob Faibussowitsch     PetscCall(PetscFree4(u, u_t, elemVec, a));
49353e9753d6SMatthew G. Knepley   }
49360c290148SMatthew G. Knepley end:
4937673019faSMatthew G. Knepley   if (mesh->printFEM) {
4938673019faSMatthew G. Knepley     PetscSection s;
4939673019faSMatthew G. Knepley     Vec          locFbc;
4940673019faSMatthew G. Knepley     PetscInt     pStart, pEnd, maxDof;
4941673019faSMatthew G. Knepley     PetscScalar *zeroes;
4942673019faSMatthew G. Knepley 
4943673019faSMatthew G. Knepley     PetscCall(DMGetLocalSection(dm, &s));
4944673019faSMatthew G. Knepley     PetscCall(VecDuplicate(locF, &locFbc));
4945673019faSMatthew G. Knepley     PetscCall(VecCopy(locF, locFbc));
4946673019faSMatthew G. Knepley     PetscCall(PetscSectionGetChart(s, &pStart, &pEnd));
4947673019faSMatthew G. Knepley     PetscCall(PetscSectionGetMaxDof(s, &maxDof));
4948673019faSMatthew G. Knepley     PetscCall(PetscCalloc1(maxDof, &zeroes));
4949673019faSMatthew G. Knepley     for (PetscInt p = pStart; p < pEnd; p++) PetscCall(VecSetValuesSection(locFbc, s, p, zeroes, INSERT_BC_VALUES));
4950673019faSMatthew G. Knepley     PetscCall(PetscFree(zeroes));
4951673019faSMatthew G. Knepley     PetscCall(DMPrintLocalVec(dm, name, mesh->printTol, locFbc));
4952673019faSMatthew G. Knepley     PetscCall(VecDestroy(&locFbc));
4953673019faSMatthew G. Knepley   }
49549566063dSJacob Faibussowitsch   PetscCall(DMDestroy(&plex));
49559566063dSJacob Faibussowitsch   PetscCall(DMDestroy(&plexA));
49563ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
49573e9753d6SMatthew G. Knepley }
49583e9753d6SMatthew G. Knepley 
4959d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexComputeBdResidualSingle(DM dm, PetscReal t, PetscWeakForm wf, PetscFormKey key, Vec locX, Vec locX_t, Vec locF)
4960d71ae5a4SJacob Faibussowitsch {
49613e9753d6SMatthew G. Knepley   DMField  coordField;
49623e9753d6SMatthew G. Knepley   DMLabel  depthLabel;
49633e9753d6SMatthew G. Knepley   IS       facetIS;
49643e9753d6SMatthew G. Knepley   PetscInt dim;
49653e9753d6SMatthew G. Knepley 
49663e9753d6SMatthew G. Knepley   PetscFunctionBegin;
49679566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
49689566063dSJacob Faibussowitsch   PetscCall(DMPlexGetDepthLabel(dm, &depthLabel));
49699566063dSJacob Faibussowitsch   PetscCall(DMLabelGetStratumIS(depthLabel, dim - 1, &facetIS));
49709566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateField(dm, &coordField));
49719566063dSJacob Faibussowitsch   PetscCall(DMPlexComputeBdResidual_Single_Internal(dm, t, wf, key, locX, locX_t, locF, coordField, facetIS));
49729566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&facetIS));
49733ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
49743e9753d6SMatthew G. Knepley }
49753e9753d6SMatthew G. Knepley 
4976a4e35b19SJacob Faibussowitsch static PetscErrorCode DMPlexComputeBdResidual_Internal(DM dm, Vec locX, Vec locX_t, PetscReal t, Vec locF, void *user)
4977d71ae5a4SJacob Faibussowitsch {
49783e9753d6SMatthew G. Knepley   PetscDS  prob;
49793e9753d6SMatthew G. Knepley   PetscInt numBd, bd;
49803e9753d6SMatthew G. Knepley   DMField  coordField = NULL;
49813e9753d6SMatthew G. Knepley   IS       facetIS    = NULL;
49823e9753d6SMatthew G. Knepley   DMLabel  depthLabel;
49833e9753d6SMatthew G. Knepley   PetscInt dim;
49843e9753d6SMatthew G. Knepley 
49853e9753d6SMatthew G. Knepley   PetscFunctionBegin;
49869566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dm, &prob));
49879566063dSJacob Faibussowitsch   PetscCall(DMPlexGetDepthLabel(dm, &depthLabel));
49889566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
49899566063dSJacob Faibussowitsch   PetscCall(DMLabelGetStratumIS(depthLabel, dim - 1, &facetIS));
49909566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumBoundary(prob, &numBd));
49913e9753d6SMatthew G. Knepley   for (bd = 0; bd < numBd; ++bd) {
499245480ffeSMatthew G. Knepley     PetscWeakForm           wf;
49933e9753d6SMatthew G. Knepley     DMBoundaryConditionType type;
49943e9753d6SMatthew G. Knepley     DMLabel                 label;
49953e9753d6SMatthew G. Knepley     const PetscInt         *values;
49960c290148SMatthew G. Knepley     PetscInt                field, numValues, v;
49973e9753d6SMatthew G. Knepley     PetscObject             obj;
49983e9753d6SMatthew G. Knepley     PetscClassId            id;
49990c290148SMatthew G. Knepley     PetscFormKey            key;
50003e9753d6SMatthew G. Knepley 
50019566063dSJacob Faibussowitsch     PetscCall(PetscDSGetBoundary(prob, bd, &wf, &type, NULL, &label, &numValues, &values, &field, NULL, NULL, NULL, NULL, NULL));
50023d3e5d66SMatthew G. Knepley     if (type & DM_BC_ESSENTIAL) continue;
50039566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, field, &obj));
50049566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
50053d3e5d66SMatthew G. Knepley     if (id != PETSCFE_CLASSID) continue;
50063e9753d6SMatthew G. Knepley     if (!facetIS) {
50073e9753d6SMatthew G. Knepley       DMLabel  depthLabel;
50083e9753d6SMatthew G. Knepley       PetscInt dim;
50093e9753d6SMatthew G. Knepley 
50109566063dSJacob Faibussowitsch       PetscCall(DMPlexGetDepthLabel(dm, &depthLabel));
50119566063dSJacob Faibussowitsch       PetscCall(DMGetDimension(dm, &dim));
50129566063dSJacob Faibussowitsch       PetscCall(DMLabelGetStratumIS(depthLabel, dim - 1, &facetIS));
50133e9753d6SMatthew G. Knepley     }
50149566063dSJacob Faibussowitsch     PetscCall(DMGetCoordinateField(dm, &coordField));
50150c290148SMatthew G. Knepley     for (v = 0; v < numValues; ++v) {
50160c290148SMatthew G. Knepley       key.label = label;
50170c290148SMatthew G. Knepley       key.value = values[v];
50180c290148SMatthew G. Knepley       key.field = field;
50190c290148SMatthew G. Knepley       key.part  = 0;
50209566063dSJacob Faibussowitsch       PetscCall(DMPlexComputeBdResidual_Single_Internal(dm, t, wf, key, locX, locX_t, locF, coordField, facetIS));
50210c290148SMatthew G. Knepley     }
50223e9753d6SMatthew G. Knepley   }
50239566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&facetIS));
50243ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
50253e9753d6SMatthew G. Knepley }
50263e9753d6SMatthew G. Knepley 
5027d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexComputeResidual_Internal(DM dm, PetscFormKey key, IS cellIS, PetscReal time, Vec locX, Vec locX_t, PetscReal t, Vec locF, void *user)
5028d71ae5a4SJacob Faibussowitsch {
50293e9753d6SMatthew G. Knepley   DM_Plex        *mesh       = (DM_Plex *)dm->data;
50303e9753d6SMatthew G. Knepley   const char     *name       = "Residual";
50313e9753d6SMatthew G. Knepley   DM              dmAux      = NULL;
50323e9753d6SMatthew G. Knepley   DM              dmGrad     = NULL;
50333e9753d6SMatthew G. Knepley   DMLabel         ghostLabel = NULL;
50346528b96dSMatthew G. Knepley   PetscDS         ds         = NULL;
50356528b96dSMatthew G. Knepley   PetscDS         dsAux      = NULL;
50363e9753d6SMatthew G. Knepley   PetscSection    section    = NULL;
50373e9753d6SMatthew G. Knepley   PetscBool       useFEM     = PETSC_FALSE;
50383e9753d6SMatthew G. Knepley   PetscBool       useFVM     = PETSC_FALSE;
50393e9753d6SMatthew G. Knepley   PetscBool       isImplicit = (locX_t || time == PETSC_MIN_REAL) ? PETSC_TRUE : PETSC_FALSE;
50403e9753d6SMatthew G. Knepley   PetscFV         fvm        = NULL;
50413e9753d6SMatthew G. Knepley   DMField         coordField = NULL;
50425962854dSMatthew G. Knepley   Vec             locA, cellGeometryFVM = NULL, faceGeometryFVM = NULL, locGrad = NULL;
50433e9753d6SMatthew G. Knepley   PetscScalar    *u = NULL, *u_t, *a, *uL, *uR;
50443e9753d6SMatthew G. Knepley   IS              chunkIS;
50453e9753d6SMatthew G. Knepley   const PetscInt *cells;
50463e9753d6SMatthew G. Knepley   PetscInt        cStart, cEnd, numCells;
50473e9753d6SMatthew G. Knepley   PetscInt        Nf, f, totDim, totDimAux, numChunks, cellChunkSize, faceChunkSize, chunk, fStart, fEnd;
50481690c2aeSBarry Smith   PetscInt        maxDegree  = PETSC_INT_MAX;
50493e9753d6SMatthew G. Knepley   PetscQuadrature affineQuad = NULL, *quads = NULL;
50503e9753d6SMatthew G. Knepley   PetscFEGeom    *affineGeom = NULL, **geoms = NULL;
50513e9753d6SMatthew G. Knepley 
50523e9753d6SMatthew G. Knepley   PetscFunctionBegin;
50539566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_ResidualFEM, dm, 0, 0, 0));
50543cc88e6aSStefano Zampini   if (!cellIS) goto end;
50553cc88e6aSStefano Zampini   PetscCall(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
50563cc88e6aSStefano Zampini   if (cStart >= cEnd) goto end;
50573e9753d6SMatthew G. Knepley   /* TODO The places where we have to use isFE are probably the member functions for the PetscDisc class */
50583e9753d6SMatthew G. Knepley   /* TODO The FVM geometry is over-manipulated. Make the precalc functions return exactly what we need */
50593e9753d6SMatthew G. Knepley   /* FEM+FVM */
50609566063dSJacob Faibussowitsch   PetscCall(DMPlexGetHeightStratum(dm, 1, &fStart, &fEnd));
50613e9753d6SMatthew G. Knepley   /* 1: Get sizes from dm and dmAux */
50629566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
50639566063dSJacob Faibussowitsch   PetscCall(DMGetLabel(dm, "ghost", &ghostLabel));
506407218a29SMatthew G. Knepley   PetscCall(DMGetCellDS(dm, cells ? cells[cStart] : cStart, &ds, NULL));
50659566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumFields(ds, &Nf));
50669566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(ds, &totDim));
50679566063dSJacob Faibussowitsch   PetscCall(DMGetAuxiliaryVec(dm, key.label, key.value, key.part, &locA));
50683e9753d6SMatthew G. Knepley   if (locA) {
50693e9753d6SMatthew G. Knepley     PetscInt subcell;
50709566063dSJacob Faibussowitsch     PetscCall(VecGetDM(locA, &dmAux));
50711059d808SMatthew G. Knepley     PetscCall(DMGetEnclosurePoint(dmAux, dm, DM_ENC_UNKNOWN, cells ? cells[cStart] : cStart, &subcell));
507207218a29SMatthew G. Knepley     PetscCall(DMGetCellDS(dmAux, subcell, &dsAux, NULL));
50739566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalDimension(dsAux, &totDimAux));
50743e9753d6SMatthew G. Knepley   }
50753e9753d6SMatthew G. Knepley   /* 2: Get geometric data */
50763e9753d6SMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
50773e9753d6SMatthew G. Knepley     PetscObject  obj;
50783e9753d6SMatthew G. Knepley     PetscClassId id;
50793e9753d6SMatthew G. Knepley     PetscBool    fimp;
50803e9753d6SMatthew G. Knepley 
50819566063dSJacob Faibussowitsch     PetscCall(PetscDSGetImplicit(ds, f, &fimp));
50823e9753d6SMatthew G. Knepley     if (isImplicit != fimp) continue;
50839566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(ds, f, &obj));
50849566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
5085ad540459SPierre Jolivet     if (id == PETSCFE_CLASSID) useFEM = PETSC_TRUE;
50869371c9d4SSatish Balay     if (id == PETSCFV_CLASSID) {
50879371c9d4SSatish Balay       useFVM = PETSC_TRUE;
50889371c9d4SSatish Balay       fvm    = (PetscFV)obj;
50899371c9d4SSatish Balay     }
50903e9753d6SMatthew G. Knepley   }
50913e9753d6SMatthew G. Knepley   if (useFEM) {
50929566063dSJacob Faibussowitsch     PetscCall(DMGetCoordinateField(dm, &coordField));
50939566063dSJacob Faibussowitsch     PetscCall(DMFieldGetDegree(coordField, cellIS, NULL, &maxDegree));
50943e9753d6SMatthew G. Knepley     if (maxDegree <= 1) {
50959566063dSJacob Faibussowitsch       PetscCall(DMFieldCreateDefaultQuadrature(coordField, cellIS, &affineQuad));
509648a46eb9SPierre Jolivet       if (affineQuad) PetscCall(DMSNESGetFEGeom(coordField, cellIS, affineQuad, PETSC_FALSE, &affineGeom));
50973e9753d6SMatthew G. Knepley     } else {
50989566063dSJacob Faibussowitsch       PetscCall(PetscCalloc2(Nf, &quads, Nf, &geoms));
50993e9753d6SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
51003e9753d6SMatthew G. Knepley         PetscObject  obj;
51013e9753d6SMatthew G. Knepley         PetscClassId id;
51023e9753d6SMatthew G. Knepley         PetscBool    fimp;
51033e9753d6SMatthew G. Knepley 
51049566063dSJacob Faibussowitsch         PetscCall(PetscDSGetImplicit(ds, f, &fimp));
51053e9753d6SMatthew G. Knepley         if (isImplicit != fimp) continue;
51069566063dSJacob Faibussowitsch         PetscCall(PetscDSGetDiscretization(ds, f, &obj));
51079566063dSJacob Faibussowitsch         PetscCall(PetscObjectGetClassId(obj, &id));
51083e9753d6SMatthew G. Knepley         if (id == PETSCFE_CLASSID) {
51093e9753d6SMatthew G. Knepley           PetscFE fe = (PetscFE)obj;
51103e9753d6SMatthew G. Knepley 
51119566063dSJacob Faibussowitsch           PetscCall(PetscFEGetQuadrature(fe, &quads[f]));
51129566063dSJacob Faibussowitsch           PetscCall(PetscObjectReference((PetscObject)quads[f]));
51139566063dSJacob Faibussowitsch           PetscCall(DMSNESGetFEGeom(coordField, cellIS, quads[f], PETSC_FALSE, &geoms[f]));
51143e9753d6SMatthew G. Knepley         }
51153e9753d6SMatthew G. Knepley       }
51163e9753d6SMatthew G. Knepley     }
51173e9753d6SMatthew G. Knepley   }
51185962854dSMatthew G. Knepley   // Handle non-essential (e.g. outflow) boundary values
51193e9753d6SMatthew G. Knepley   if (useFVM) {
51205962854dSMatthew G. Knepley     PetscCall(DMPlexInsertBoundaryValuesFVM(dm, fvm, locX, time, &locGrad));
51219566063dSJacob Faibussowitsch     PetscCall(DMPlexGetGeometryFVM(dm, &faceGeometryFVM, &cellGeometryFVM, NULL));
51229566063dSJacob Faibussowitsch     PetscCall(DMPlexGetGradientDM(dm, fvm, &dmGrad));
51233e9753d6SMatthew G. Knepley   }
51243e9753d6SMatthew G. Knepley   /* Loop over chunks */
51259566063dSJacob Faibussowitsch   if (useFEM) PetscCall(ISCreate(PETSC_COMM_SELF, &chunkIS));
51263e9753d6SMatthew G. Knepley   numCells      = cEnd - cStart;
51273e9753d6SMatthew G. Knepley   numChunks     = 1;
51283e9753d6SMatthew G. Knepley   cellChunkSize = numCells / numChunks;
51293e9753d6SMatthew G. Knepley   faceChunkSize = (fEnd - fStart) / numChunks;
51303e9753d6SMatthew G. Knepley   numChunks     = PetscMin(1, numCells);
51313e9753d6SMatthew G. Knepley   for (chunk = 0; chunk < numChunks; ++chunk) {
51323e9753d6SMatthew G. Knepley     PetscScalar     *elemVec, *fluxL, *fluxR;
51333e9753d6SMatthew G. Knepley     PetscReal       *vol;
51343e9753d6SMatthew G. Knepley     PetscFVFaceGeom *fgeom;
51353e9753d6SMatthew G. Knepley     PetscInt         cS = cStart + chunk * cellChunkSize, cE = PetscMin(cS + cellChunkSize, cEnd), numCells = cE - cS, c;
51363e9753d6SMatthew G. Knepley     PetscInt         fS = fStart + chunk * faceChunkSize, fE = PetscMin(fS + faceChunkSize, fEnd), numFaces = 0, face;
51373e9753d6SMatthew G. Knepley 
51383e9753d6SMatthew G. Knepley     /* Extract field coefficients */
51393e9753d6SMatthew G. Knepley     if (useFEM) {
51409566063dSJacob Faibussowitsch       PetscCall(ISGetPointSubrange(chunkIS, cS, cE, cells));
51419566063dSJacob Faibussowitsch       PetscCall(DMPlexGetCellFields(dm, chunkIS, locX, locX_t, locA, &u, &u_t, &a));
51429566063dSJacob Faibussowitsch       PetscCall(DMGetWorkArray(dm, numCells * totDim, MPIU_SCALAR, &elemVec));
51439566063dSJacob Faibussowitsch       PetscCall(PetscArrayzero(elemVec, numCells * totDim));
51443e9753d6SMatthew G. Knepley     }
51453e9753d6SMatthew G. Knepley     if (useFVM) {
51469566063dSJacob Faibussowitsch       PetscCall(DMPlexGetFaceFields(dm, fS, fE, locX, locX_t, faceGeometryFVM, cellGeometryFVM, locGrad, &numFaces, &uL, &uR));
51479566063dSJacob Faibussowitsch       PetscCall(DMPlexGetFaceGeometry(dm, fS, fE, faceGeometryFVM, cellGeometryFVM, &numFaces, &fgeom, &vol));
51489566063dSJacob Faibussowitsch       PetscCall(DMGetWorkArray(dm, numFaces * totDim, MPIU_SCALAR, &fluxL));
51499566063dSJacob Faibussowitsch       PetscCall(DMGetWorkArray(dm, numFaces * totDim, MPIU_SCALAR, &fluxR));
51509566063dSJacob Faibussowitsch       PetscCall(PetscArrayzero(fluxL, numFaces * totDim));
51519566063dSJacob Faibussowitsch       PetscCall(PetscArrayzero(fluxR, numFaces * totDim));
51523e9753d6SMatthew G. Knepley     }
51533e9753d6SMatthew 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 */
51543e9753d6SMatthew G. Knepley     /* Loop over fields */
51553e9753d6SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
51563e9753d6SMatthew G. Knepley       PetscObject  obj;
51573e9753d6SMatthew G. Knepley       PetscClassId id;
51583e9753d6SMatthew G. Knepley       PetscBool    fimp;
51593e9753d6SMatthew G. Knepley       PetscInt     numChunks, numBatches, batchSize, numBlocks, blockSize, Ne, Nr, offset;
51603e9753d6SMatthew G. Knepley 
51616528b96dSMatthew G. Knepley       key.field = f;
51629566063dSJacob Faibussowitsch       PetscCall(PetscDSGetImplicit(ds, f, &fimp));
51633e9753d6SMatthew G. Knepley       if (isImplicit != fimp) continue;
51649566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(ds, f, &obj));
51659566063dSJacob Faibussowitsch       PetscCall(PetscObjectGetClassId(obj, &id));
51663e9753d6SMatthew G. Knepley       if (id == PETSCFE_CLASSID) {
51673e9753d6SMatthew G. Knepley         PetscFE         fe        = (PetscFE)obj;
51683e9753d6SMatthew G. Knepley         PetscFEGeom    *geom      = affineGeom ? affineGeom : geoms[f];
51693e9753d6SMatthew G. Knepley         PetscFEGeom    *chunkGeom = NULL;
51703e9753d6SMatthew G. Knepley         PetscQuadrature quad      = affineQuad ? affineQuad : quads[f];
51713e9753d6SMatthew G. Knepley         PetscInt        Nq, Nb;
51723e9753d6SMatthew G. Knepley 
51739566063dSJacob Faibussowitsch         PetscCall(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
51749566063dSJacob Faibussowitsch         PetscCall(PetscQuadratureGetData(quad, NULL, NULL, &Nq, NULL, NULL));
51759566063dSJacob Faibussowitsch         PetscCall(PetscFEGetDimension(fe, &Nb));
51763e9753d6SMatthew G. Knepley         blockSize = Nb;
51773e9753d6SMatthew G. Knepley         batchSize = numBlocks * blockSize;
51789566063dSJacob Faibussowitsch         PetscCall(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
51793e9753d6SMatthew G. Knepley         numChunks = numCells / (numBatches * batchSize);
51803e9753d6SMatthew G. Knepley         Ne        = numChunks * numBatches * batchSize;
51813e9753d6SMatthew G. Knepley         Nr        = numCells % (numBatches * batchSize);
51823e9753d6SMatthew G. Knepley         offset    = numCells - Nr;
51833e9753d6SMatthew G. Knepley         /* Integrate FE residual to get elemVec (need fields at quadrature points) */
51843e9753d6SMatthew 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) */
51859566063dSJacob Faibussowitsch         PetscCall(PetscFEGeomGetChunk(geom, 0, offset, &chunkGeom));
51869566063dSJacob Faibussowitsch         PetscCall(PetscFEIntegrateResidual(ds, key, Ne, chunkGeom, u, u_t, dsAux, a, t, elemVec));
51879566063dSJacob Faibussowitsch         PetscCall(PetscFEGeomGetChunk(geom, offset, numCells, &chunkGeom));
51888e3a54c0SPierre Jolivet         PetscCall(PetscFEIntegrateResidual(ds, key, Nr, chunkGeom, &u[offset * totDim], PetscSafePointerPlusOffset(u_t, offset * totDim), dsAux, PetscSafePointerPlusOffset(a, offset * totDimAux), t, &elemVec[offset * totDim]));
51899566063dSJacob Faibussowitsch         PetscCall(PetscFEGeomRestoreChunk(geom, offset, numCells, &chunkGeom));
51903e9753d6SMatthew G. Knepley       } else if (id == PETSCFV_CLASSID) {
51913e9753d6SMatthew G. Knepley         PetscFV fv = (PetscFV)obj;
51923e9753d6SMatthew G. Knepley 
51933e9753d6SMatthew G. Knepley         Ne = numFaces;
51943e9753d6SMatthew G. Knepley         /* Riemann solve over faces (need fields at face centroids) */
51953e9753d6SMatthew G. Knepley         /*   We need to evaluate FE fields at those coordinates */
51969566063dSJacob Faibussowitsch         PetscCall(PetscFVIntegrateRHSFunction(fv, ds, f, Ne, fgeom, vol, uL, uR, fluxL, fluxR));
519763a3b9bcSJacob Faibussowitsch       } else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, f);
51983e9753d6SMatthew G. Knepley     }
51993e9753d6SMatthew G. Knepley     /* Loop over domain */
52003e9753d6SMatthew G. Knepley     if (useFEM) {
52013e9753d6SMatthew G. Knepley       /* Add elemVec to locX */
52023e9753d6SMatthew G. Knepley       for (c = cS; c < cE; ++c) {
52033e9753d6SMatthew G. Knepley         const PetscInt cell = cells ? cells[c] : c;
52043e9753d6SMatthew G. Knepley         const PetscInt cind = c - cStart;
52053e9753d6SMatthew G. Knepley 
52069566063dSJacob Faibussowitsch         if (mesh->printFEM > 1) PetscCall(DMPrintCellVector(cell, name, totDim, &elemVec[cind * totDim]));
52073e9753d6SMatthew G. Knepley         if (ghostLabel) {
52083e9753d6SMatthew G. Knepley           PetscInt ghostVal;
52093e9753d6SMatthew G. Knepley 
52109566063dSJacob Faibussowitsch           PetscCall(DMLabelGetValue(ghostLabel, cell, &ghostVal));
52113e9753d6SMatthew G. Knepley           if (ghostVal > 0) continue;
52123e9753d6SMatthew G. Knepley         }
52139566063dSJacob Faibussowitsch         PetscCall(DMPlexVecSetClosure(dm, section, locF, cell, &elemVec[cind * totDim], ADD_ALL_VALUES));
52143e9753d6SMatthew G. Knepley       }
52153e9753d6SMatthew G. Knepley     }
52163e9753d6SMatthew G. Knepley     if (useFVM) {
52173e9753d6SMatthew G. Knepley       PetscScalar *fa;
52183e9753d6SMatthew G. Knepley       PetscInt     iface;
52193e9753d6SMatthew G. Knepley 
52209566063dSJacob Faibussowitsch       PetscCall(VecGetArray(locF, &fa));
52213e9753d6SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
52223e9753d6SMatthew G. Knepley         PetscFV      fv;
52233e9753d6SMatthew G. Knepley         PetscObject  obj;
52243e9753d6SMatthew G. Knepley         PetscClassId id;
52255962854dSMatthew G. Knepley         PetscInt     cdim, foff, pdim;
52263e9753d6SMatthew G. Knepley 
52275962854dSMatthew G. Knepley         PetscCall(DMGetCoordinateDim(dm, &cdim));
52289566063dSJacob Faibussowitsch         PetscCall(PetscDSGetDiscretization(ds, f, &obj));
52299566063dSJacob Faibussowitsch         PetscCall(PetscDSGetFieldOffset(ds, f, &foff));
52309566063dSJacob Faibussowitsch         PetscCall(PetscObjectGetClassId(obj, &id));
52313e9753d6SMatthew G. Knepley         if (id != PETSCFV_CLASSID) continue;
52323e9753d6SMatthew G. Knepley         fv = (PetscFV)obj;
52339566063dSJacob Faibussowitsch         PetscCall(PetscFVGetNumComponents(fv, &pdim));
52343e9753d6SMatthew G. Knepley         /* Accumulate fluxes to cells */
52353e9753d6SMatthew G. Knepley         for (face = fS, iface = 0; face < fE; ++face) {
52363e9753d6SMatthew G. Knepley           const PetscInt *scells;
52373e9753d6SMatthew G. Knepley           PetscScalar    *fL = NULL, *fR = NULL;
52383e9753d6SMatthew G. Knepley           PetscInt        ghost, d, nsupp, nchild;
52393e9753d6SMatthew G. Knepley 
52409566063dSJacob Faibussowitsch           PetscCall(DMLabelGetValue(ghostLabel, face, &ghost));
52419566063dSJacob Faibussowitsch           PetscCall(DMPlexGetSupportSize(dm, face, &nsupp));
52429566063dSJacob Faibussowitsch           PetscCall(DMPlexGetTreeChildren(dm, face, &nchild, NULL));
52433e9753d6SMatthew G. Knepley           if (ghost >= 0 || nsupp > 2 || nchild > 0) continue;
52449566063dSJacob Faibussowitsch           PetscCall(DMPlexGetSupport(dm, face, &scells));
52459566063dSJacob Faibussowitsch           PetscCall(DMLabelGetValue(ghostLabel, scells[0], &ghost));
52469566063dSJacob Faibussowitsch           if (ghost <= 0) PetscCall(DMPlexPointLocalFieldRef(dm, scells[0], f, fa, &fL));
52479566063dSJacob Faibussowitsch           PetscCall(DMLabelGetValue(ghostLabel, scells[1], &ghost));
52489566063dSJacob Faibussowitsch           if (ghost <= 0) PetscCall(DMPlexPointLocalFieldRef(dm, scells[1], f, fa, &fR));
52495962854dSMatthew G. Knepley           if (mesh->printFVM > 1) {
52505962854dSMatthew G. Knepley             PetscCall(DMPrintCellVectorReal(face, "Residual: normal", cdim, fgeom[iface].normal));
52515962854dSMatthew G. Knepley             PetscCall(DMPrintCellVector(face, "Residual: left state", pdim, &uL[iface * totDim + foff]));
52525962854dSMatthew G. Knepley             PetscCall(DMPrintCellVector(face, "Residual: right state", pdim, &uR[iface * totDim + foff]));
52535962854dSMatthew G. Knepley             PetscCall(DMPrintCellVector(face, "Residual: left flux", pdim, &fluxL[iface * totDim + foff]));
52545962854dSMatthew G. Knepley             PetscCall(DMPrintCellVector(face, "Residual: right flux", pdim, &fluxR[iface * totDim + foff]));
52555962854dSMatthew G. Knepley           }
52563e9753d6SMatthew G. Knepley           for (d = 0; d < pdim; ++d) {
52573e9753d6SMatthew G. Knepley             if (fL) fL[d] -= fluxL[iface * totDim + foff + d];
52583e9753d6SMatthew G. Knepley             if (fR) fR[d] += fluxR[iface * totDim + foff + d];
52593e9753d6SMatthew G. Knepley           }
52603e9753d6SMatthew G. Knepley           ++iface;
52613e9753d6SMatthew G. Knepley         }
52623e9753d6SMatthew G. Knepley       }
52639566063dSJacob Faibussowitsch       PetscCall(VecRestoreArray(locF, &fa));
52643e9753d6SMatthew G. Knepley     }
52653e9753d6SMatthew G. Knepley     /* Handle time derivative */
52663e9753d6SMatthew G. Knepley     if (locX_t) {
52673e9753d6SMatthew G. Knepley       PetscScalar *x_t, *fa;
52683e9753d6SMatthew G. Knepley 
52699566063dSJacob Faibussowitsch       PetscCall(VecGetArray(locF, &fa));
52709566063dSJacob Faibussowitsch       PetscCall(VecGetArray(locX_t, &x_t));
52713e9753d6SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
52723e9753d6SMatthew G. Knepley         PetscFV      fv;
52733e9753d6SMatthew G. Knepley         PetscObject  obj;
52743e9753d6SMatthew G. Knepley         PetscClassId id;
52753e9753d6SMatthew G. Knepley         PetscInt     pdim, d;
52763e9753d6SMatthew G. Knepley 
52779566063dSJacob Faibussowitsch         PetscCall(PetscDSGetDiscretization(ds, f, &obj));
52789566063dSJacob Faibussowitsch         PetscCall(PetscObjectGetClassId(obj, &id));
52793e9753d6SMatthew G. Knepley         if (id != PETSCFV_CLASSID) continue;
52803e9753d6SMatthew G. Knepley         fv = (PetscFV)obj;
52819566063dSJacob Faibussowitsch         PetscCall(PetscFVGetNumComponents(fv, &pdim));
52823e9753d6SMatthew G. Knepley         for (c = cS; c < cE; ++c) {
52833e9753d6SMatthew G. Knepley           const PetscInt cell = cells ? cells[c] : c;
52843e9753d6SMatthew G. Knepley           PetscScalar   *u_t, *r;
52853e9753d6SMatthew G. Knepley 
52863e9753d6SMatthew G. Knepley           if (ghostLabel) {
52873e9753d6SMatthew G. Knepley             PetscInt ghostVal;
52883e9753d6SMatthew G. Knepley 
52899566063dSJacob Faibussowitsch             PetscCall(DMLabelGetValue(ghostLabel, cell, &ghostVal));
52903e9753d6SMatthew G. Knepley             if (ghostVal > 0) continue;
52913e9753d6SMatthew G. Knepley           }
52929566063dSJacob Faibussowitsch           PetscCall(DMPlexPointLocalFieldRead(dm, cell, f, x_t, &u_t));
52939566063dSJacob Faibussowitsch           PetscCall(DMPlexPointLocalFieldRef(dm, cell, f, fa, &r));
52943e9753d6SMatthew G. Knepley           for (d = 0; d < pdim; ++d) r[d] += u_t[d];
52953e9753d6SMatthew G. Knepley         }
52963e9753d6SMatthew G. Knepley       }
52979566063dSJacob Faibussowitsch       PetscCall(VecRestoreArray(locX_t, &x_t));
52989566063dSJacob Faibussowitsch       PetscCall(VecRestoreArray(locF, &fa));
52993e9753d6SMatthew G. Knepley     }
53003e9753d6SMatthew G. Knepley     if (useFEM) {
53019566063dSJacob Faibussowitsch       PetscCall(DMPlexRestoreCellFields(dm, chunkIS, locX, locX_t, locA, &u, &u_t, &a));
53029566063dSJacob Faibussowitsch       PetscCall(DMRestoreWorkArray(dm, numCells * totDim, MPIU_SCALAR, &elemVec));
53033e9753d6SMatthew G. Knepley     }
53043e9753d6SMatthew G. Knepley     if (useFVM) {
53059566063dSJacob Faibussowitsch       PetscCall(DMPlexRestoreFaceFields(dm, fS, fE, locX, locX_t, faceGeometryFVM, cellGeometryFVM, locGrad, &numFaces, &uL, &uR));
53069566063dSJacob Faibussowitsch       PetscCall(DMPlexRestoreFaceGeometry(dm, fS, fE, faceGeometryFVM, cellGeometryFVM, &numFaces, &fgeom, &vol));
53079566063dSJacob Faibussowitsch       PetscCall(DMRestoreWorkArray(dm, numFaces * totDim, MPIU_SCALAR, &fluxL));
53089566063dSJacob Faibussowitsch       PetscCall(DMRestoreWorkArray(dm, numFaces * totDim, MPIU_SCALAR, &fluxR));
53099566063dSJacob Faibussowitsch       if (dmGrad) PetscCall(DMRestoreLocalVector(dmGrad, &locGrad));
53103e9753d6SMatthew G. Knepley     }
53113e9753d6SMatthew G. Knepley   }
53129566063dSJacob Faibussowitsch   if (useFEM) PetscCall(ISDestroy(&chunkIS));
53139566063dSJacob Faibussowitsch   PetscCall(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
53143e9753d6SMatthew G. Knepley 
53153e9753d6SMatthew G. Knepley   if (useFEM) {
53169566063dSJacob Faibussowitsch     PetscCall(DMPlexComputeBdResidual_Internal(dm, locX, locX_t, t, locF, user));
53173e9753d6SMatthew G. Knepley 
53183e9753d6SMatthew G. Knepley     if (maxDegree <= 1) {
53199566063dSJacob Faibussowitsch       PetscCall(DMSNESRestoreFEGeom(coordField, cellIS, affineQuad, PETSC_FALSE, &affineGeom));
53209566063dSJacob Faibussowitsch       PetscCall(PetscQuadratureDestroy(&affineQuad));
53213e9753d6SMatthew G. Knepley     } else {
53223e9753d6SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
53239566063dSJacob Faibussowitsch         PetscCall(DMSNESRestoreFEGeom(coordField, cellIS, quads[f], PETSC_FALSE, &geoms[f]));
53249566063dSJacob Faibussowitsch         PetscCall(PetscQuadratureDestroy(&quads[f]));
53253e9753d6SMatthew G. Knepley       }
53269566063dSJacob Faibussowitsch       PetscCall(PetscFree2(quads, geoms));
53273e9753d6SMatthew G. Knepley     }
53283e9753d6SMatthew G. Knepley   }
53293e9753d6SMatthew G. Knepley 
53303e9753d6SMatthew G. Knepley   /* FEM */
53313e9753d6SMatthew G. Knepley   /* 1: Get sizes from dm and dmAux */
53323e9753d6SMatthew G. Knepley   /* 2: Get geometric data */
53333e9753d6SMatthew G. Knepley   /* 3: Handle boundary values */
53343e9753d6SMatthew G. Knepley   /* 4: Loop over domain */
53353e9753d6SMatthew G. Knepley   /*   Extract coefficients */
53363e9753d6SMatthew G. Knepley   /* Loop over fields */
53373e9753d6SMatthew G. Knepley   /*   Set tiling for FE*/
53383e9753d6SMatthew G. Knepley   /*   Integrate FE residual to get elemVec */
53393e9753d6SMatthew G. Knepley   /*     Loop over subdomain */
53403e9753d6SMatthew G. Knepley   /*       Loop over quad points */
53413e9753d6SMatthew G. Knepley   /*         Transform coords to real space */
53423e9753d6SMatthew G. Knepley   /*         Evaluate field and aux fields at point */
53433e9753d6SMatthew G. Knepley   /*         Evaluate residual at point */
53443e9753d6SMatthew G. Knepley   /*         Transform residual to real space */
53453e9753d6SMatthew G. Knepley   /*       Add residual to elemVec */
53463e9753d6SMatthew G. Knepley   /* Loop over domain */
53473e9753d6SMatthew G. Knepley   /*   Add elemVec to locX */
53483e9753d6SMatthew G. Knepley 
53493e9753d6SMatthew G. Knepley   /* FVM */
53503e9753d6SMatthew G. Knepley   /* Get geometric data */
53513e9753d6SMatthew G. Knepley   /* If using gradients */
53523e9753d6SMatthew G. Knepley   /*   Compute gradient data */
53533e9753d6SMatthew G. Knepley   /*   Loop over domain faces */
53543e9753d6SMatthew G. Knepley   /*     Count computational faces */
53553e9753d6SMatthew G. Knepley   /*     Reconstruct cell gradient */
53563e9753d6SMatthew G. Knepley   /*   Loop over domain cells */
53573e9753d6SMatthew G. Knepley   /*     Limit cell gradients */
53583e9753d6SMatthew G. Knepley   /* Handle boundary values */
53593e9753d6SMatthew G. Knepley   /* Loop over domain faces */
53603e9753d6SMatthew G. Knepley   /*   Read out field, centroid, normal, volume for each side of face */
53613e9753d6SMatthew G. Knepley   /* Riemann solve over faces */
53623e9753d6SMatthew G. Knepley   /* Loop over domain faces */
53633e9753d6SMatthew G. Knepley   /*   Accumulate fluxes to cells */
53643e9753d6SMatthew G. Knepley   /* TODO Change printFEM to printDisc here */
53653e9753d6SMatthew G. Knepley   if (mesh->printFEM) {
53663e9753d6SMatthew G. Knepley     Vec          locFbc;
53673e9753d6SMatthew G. Knepley     PetscInt     pStart, pEnd, p, maxDof;
53683e9753d6SMatthew G. Knepley     PetscScalar *zeroes;
53693e9753d6SMatthew G. Knepley 
53709566063dSJacob Faibussowitsch     PetscCall(VecDuplicate(locF, &locFbc));
53719566063dSJacob Faibussowitsch     PetscCall(VecCopy(locF, locFbc));
53729566063dSJacob Faibussowitsch     PetscCall(PetscSectionGetChart(section, &pStart, &pEnd));
53739566063dSJacob Faibussowitsch     PetscCall(PetscSectionGetMaxDof(section, &maxDof));
53749566063dSJacob Faibussowitsch     PetscCall(PetscCalloc1(maxDof, &zeroes));
537548a46eb9SPierre Jolivet     for (p = pStart; p < pEnd; p++) PetscCall(VecSetValuesSection(locFbc, section, p, zeroes, INSERT_BC_VALUES));
53769566063dSJacob Faibussowitsch     PetscCall(PetscFree(zeroes));
53779566063dSJacob Faibussowitsch     PetscCall(DMPrintLocalVec(dm, name, mesh->printTol, locFbc));
53789566063dSJacob Faibussowitsch     PetscCall(VecDestroy(&locFbc));
53793e9753d6SMatthew G. Knepley   }
53803cc88e6aSStefano Zampini end:
53819566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_ResidualFEM, dm, 0, 0, 0));
53823ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
53833e9753d6SMatthew G. Knepley }
53843e9753d6SMatthew G. Knepley 
53856528b96dSMatthew G. Knepley /*
53866528b96dSMatthew G. Knepley   1) Allow multiple kernels for BdResidual for hybrid DS
53876528b96dSMatthew G. Knepley 
53886528b96dSMatthew G. Knepley   DONE 2) Get out dsAux for either side at the same time as cohesive cell dsAux
53896528b96dSMatthew G. Knepley 
53906528b96dSMatthew G. Knepley   DONE 3) Change DMGetCellFields() to get different aux data a[] for each side
53916528b96dSMatthew G. Knepley      - I think I just need to replace a[] with the closure from each face
53926528b96dSMatthew G. Knepley 
53936528b96dSMatthew G. Knepley   4) Run both kernels for each non-hybrid field with correct dsAux, and then hybrid field as before
53946528b96dSMatthew G. Knepley */
5395d71ae5a4SJacob Faibussowitsch PetscErrorCode DMPlexComputeResidual_Hybrid_Internal(DM dm, PetscFormKey key[], IS cellIS, PetscReal time, Vec locX, Vec locX_t, PetscReal t, Vec locF, void *user)
5396d71ae5a4SJacob Faibussowitsch {
53973e9753d6SMatthew G. Knepley   DM_Plex        *mesh       = (DM_Plex *)dm->data;
53983e9753d6SMatthew G. Knepley   const char     *name       = "Hybrid Residual";
539904c51a94SMatthew G. Knepley   DM              dmAux[3]   = {NULL, NULL, NULL};
54003e9753d6SMatthew G. Knepley   DMLabel         ghostLabel = NULL;
54016528b96dSMatthew G. Knepley   PetscDS         ds         = NULL;
540207218a29SMatthew G. Knepley   PetscDS         dsIn       = NULL;
54036528b96dSMatthew G. Knepley   PetscDS         dsAux[3]   = {NULL, NULL, NULL};
540404c51a94SMatthew G. Knepley   Vec             locA[3]    = {NULL, NULL, NULL};
540507218a29SMatthew G. Knepley   DM              dmScale[3] = {NULL, NULL, NULL};
540607218a29SMatthew G. Knepley   PetscDS         dsScale[3] = {NULL, NULL, NULL};
540707218a29SMatthew G. Knepley   Vec             locS[3]    = {NULL, NULL, NULL};
54083e9753d6SMatthew G. Knepley   PetscSection    section    = NULL;
54093e9753d6SMatthew G. Knepley   DMField         coordField = NULL;
541007218a29SMatthew G. Knepley   PetscScalar    *a[3]       = {NULL, NULL, NULL};
541107218a29SMatthew G. Knepley   PetscScalar    *s[3]       = {NULL, NULL, NULL};
5412b2ab40e6SMatthew G. Knepley   PetscScalar    *u          = NULL, *u_t;
541307218a29SMatthew G. Knepley   PetscScalar    *elemVecNeg, *elemVecPos, *elemVecCoh;
54143e9753d6SMatthew G. Knepley   IS              chunkIS;
54153e9753d6SMatthew G. Knepley   const PetscInt *cells;
54163e9753d6SMatthew G. Knepley   PetscInt       *faces;
54173e9753d6SMatthew G. Knepley   PetscInt        cStart, cEnd, numCells;
54183e2b0218SMatthew G. Knepley   PetscInt        Nf, f, totDim, totDimIn, totDimAux[3], totDimScale[3], numChunks, cellChunkSize, chunk;
54191690c2aeSBarry Smith   PetscInt        maxDegree  = PETSC_INT_MAX;
54203e9753d6SMatthew G. Knepley   PetscQuadrature affineQuad = NULL, *quads = NULL;
54213e9753d6SMatthew G. Knepley   PetscFEGeom    *affineGeom = NULL, **geoms = NULL;
54223e9753d6SMatthew G. Knepley 
54233e9753d6SMatthew G. Knepley   PetscFunctionBegin;
54243cc88e6aSStefano Zampini   PetscCall(PetscLogEventBegin(DMPLEX_ResidualFEM, dm, 0, 0, 0));
54253cc88e6aSStefano Zampini   if (!cellIS) goto end;
5426437e83fbSMatthew G. Knepley   PetscCall(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
5427437e83fbSMatthew G. Knepley   PetscCall(ISGetLocalSize(cellIS, &numCells));
54283cc88e6aSStefano Zampini   if (cStart >= cEnd) goto end;
54295fedec97SMatthew G. Knepley   if ((key[0].label == key[1].label) && (key[0].value == key[1].value) && (key[0].part == key[1].part)) {
54305fedec97SMatthew G. Knepley     const char *name;
54319566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetName((PetscObject)key[0].label, &name));
543263a3b9bcSJacob Faibussowitsch     SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Form keys for each side of a cohesive surface must be different (%s, %" PetscInt_FMT ", %" PetscInt_FMT ")", name, key[0].value, key[0].part);
54335fedec97SMatthew G. Knepley   }
54343e9753d6SMatthew G. Knepley   /* TODO The places where we have to use isFE are probably the member functions for the PetscDisc class */
54353e9753d6SMatthew G. Knepley   /* FEM */
54363e9753d6SMatthew G. Knepley   /* 1: Get sizes from dm and dmAux */
54379566063dSJacob Faibussowitsch   PetscCall(DMGetSection(dm, &section));
54389566063dSJacob Faibussowitsch   PetscCall(DMGetLabel(dm, "ghost", &ghostLabel));
543907218a29SMatthew G. Knepley   PetscCall(DMGetCellDS(dm, cells ? cells[cStart] : cStart, &ds, &dsIn));
54409566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumFields(ds, &Nf));
54419566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(ds, &totDim));
544207218a29SMatthew G. Knepley   PetscCall(PetscDSGetTotalDimension(dsIn, &totDimIn));
54439566063dSJacob Faibussowitsch   PetscCall(DMGetAuxiliaryVec(dm, key[2].label, key[2].value, key[2].part, &locA[2]));
544404c51a94SMatthew G. Knepley   if (locA[2]) {
54451059d808SMatthew G. Knepley     const PetscInt cellStart = cells ? cells[cStart] : cStart;
54461059d808SMatthew G. Knepley 
54479566063dSJacob Faibussowitsch     PetscCall(VecGetDM(locA[2], &dmAux[2]));
544807218a29SMatthew G. Knepley     PetscCall(DMGetCellDS(dmAux[2], cellStart, &dsAux[2], NULL));
54499566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalDimension(dsAux[2], &totDimAux[2]));
54506528b96dSMatthew G. Knepley     {
54516528b96dSMatthew G. Knepley       const PetscInt *cone;
54526528b96dSMatthew G. Knepley       PetscInt        c;
54536528b96dSMatthew G. Knepley 
54541059d808SMatthew G. Knepley       PetscCall(DMPlexGetCone(dm, cellStart, &cone));
54556528b96dSMatthew G. Knepley       for (c = 0; c < 2; ++c) {
54566528b96dSMatthew G. Knepley         const PetscInt *support;
54576528b96dSMatthew G. Knepley         PetscInt        ssize, s;
54586528b96dSMatthew G. Knepley 
54599566063dSJacob Faibussowitsch         PetscCall(DMPlexGetSupport(dm, cone[c], &support));
54609566063dSJacob Faibussowitsch         PetscCall(DMPlexGetSupportSize(dm, cone[c], &ssize));
54611059d808SMatthew G. Knepley         PetscCheck(ssize == 2, PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Face %" PetscInt_FMT " from cell %" PetscInt_FMT " has support size %" PetscInt_FMT " != 2", cone[c], cellStart, ssize);
54621059d808SMatthew G. Knepley         if (support[0] == cellStart) s = 1;
54631059d808SMatthew G. Knepley         else if (support[1] == cellStart) s = 0;
54641059d808SMatthew G. Knepley         else SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Face %" PetscInt_FMT " does not have cell %" PetscInt_FMT " in its support", cone[c], cellStart);
54659566063dSJacob Faibussowitsch         PetscCall(DMGetAuxiliaryVec(dm, key[c].label, key[c].value, key[c].part, &locA[c]));
5466c75bfeddSPierre Jolivet         PetscCheck(locA[c], PETSC_COMM_SELF, PETSC_ERR_ARG_WRONGSTATE, "Must have auxiliary vector for (%p, %" PetscInt_FMT ", %" PetscInt_FMT ")", (void *)key[c].label, key[c].value, key[c].part);
54679566063dSJacob Faibussowitsch         if (locA[c]) PetscCall(VecGetDM(locA[c], &dmAux[c]));
5468ad540459SPierre Jolivet         else dmAux[c] = dmAux[2];
546907218a29SMatthew G. Knepley         PetscCall(DMGetCellDS(dmAux[c], support[s], &dsAux[c], NULL));
54709566063dSJacob Faibussowitsch         PetscCall(PetscDSGetTotalDimension(dsAux[c], &totDimAux[c]));
54716528b96dSMatthew G. Knepley       }
54726528b96dSMatthew G. Knepley     }
54733e9753d6SMatthew G. Knepley   }
547407218a29SMatthew G. Knepley   /* Handle mass matrix scaling
547507218a29SMatthew G. Knepley        The field in key[2] is the field to be scaled, and the scaling field is the first in the dsScale */
547607218a29SMatthew G. Knepley   PetscCall(DMGetAuxiliaryVec(dm, key[2].label, -key[2].value, key[2].part, &locS[2]));
547707218a29SMatthew G. Knepley   if (locS[2]) {
54783e2b0218SMatthew G. Knepley     const PetscInt cellStart = cells ? cells[cStart] : cStart;
547907218a29SMatthew G. Knepley     PetscInt       Nb, Nbs;
548007218a29SMatthew G. Knepley 
548107218a29SMatthew G. Knepley     PetscCall(VecGetDM(locS[2], &dmScale[2]));
54823e2b0218SMatthew G. Knepley     PetscCall(DMGetCellDS(dmScale[2], cellStart, &dsScale[2], NULL));
54833e2b0218SMatthew G. Knepley     PetscCall(PetscDSGetTotalDimension(dsScale[2], &totDimScale[2]));
548407218a29SMatthew G. Knepley     // BRAD: This is not set correctly
548507218a29SMatthew G. Knepley     key[2].field = 2;
548607218a29SMatthew G. Knepley     PetscCall(PetscDSGetFieldSize(ds, key[2].field, &Nb));
548707218a29SMatthew G. Knepley     PetscCall(PetscDSGetFieldSize(dsScale[2], 0, &Nbs));
548807218a29SMatthew G. Knepley     PetscCheck(Nb == Nbs, PETSC_COMM_SELF, PETSC_ERR_ARG_INCOMP, "Field %" PetscInt_FMT " of size %" PetscInt_FMT " cannot be scaled by field of size %" PetscInt_FMT, key[2].field, Nb, Nbs);
54893e2b0218SMatthew G. Knepley     {
54903e2b0218SMatthew G. Knepley       const PetscInt *cone;
54913e2b0218SMatthew G. Knepley       PetscInt        c;
54923e2b0218SMatthew G. Knepley 
54933e2b0218SMatthew G. Knepley       locS[1] = locS[0] = locS[2];
54943e2b0218SMatthew G. Knepley       dmScale[1] = dmScale[0] = dmScale[2];
54953e2b0218SMatthew G. Knepley       PetscCall(DMPlexGetCone(dm, cellStart, &cone));
54963e2b0218SMatthew G. Knepley       for (c = 0; c < 2; ++c) {
54973e2b0218SMatthew G. Knepley         const PetscInt *support;
54983e2b0218SMatthew G. Knepley         PetscInt        ssize, s;
54993e2b0218SMatthew G. Knepley 
55003e2b0218SMatthew G. Knepley         PetscCall(DMPlexGetSupport(dm, cone[c], &support));
55013e2b0218SMatthew G. Knepley         PetscCall(DMPlexGetSupportSize(dm, cone[c], &ssize));
55023e2b0218SMatthew G. Knepley         PetscCheck(ssize == 2, PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Face %" PetscInt_FMT " from cell %" PetscInt_FMT " has support size %" PetscInt_FMT " != 2", cone[c], cellStart, ssize);
55033e2b0218SMatthew G. Knepley         if (support[0] == cellStart) s = 1;
55043e2b0218SMatthew G. Knepley         else if (support[1] == cellStart) s = 0;
55053e2b0218SMatthew G. Knepley         else SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Face %" PetscInt_FMT " does not have cell %" PetscInt_FMT " in its support", cone[c], cellStart);
55063e2b0218SMatthew G. Knepley         PetscCall(DMGetCellDS(dmScale[c], support[s], &dsScale[c], NULL));
55073e2b0218SMatthew G. Knepley         PetscCall(PetscDSGetTotalDimension(dsScale[c], &totDimScale[c]));
55083e2b0218SMatthew G. Knepley       }
55093e2b0218SMatthew G. Knepley     }
551007218a29SMatthew G. Knepley   }
55113e9753d6SMatthew G. Knepley   /* 2: Setup geometric data */
55129566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateField(dm, &coordField));
55139566063dSJacob Faibussowitsch   PetscCall(DMFieldGetDegree(coordField, cellIS, NULL, &maxDegree));
55143e9753d6SMatthew G. Knepley   if (maxDegree > 1) {
55159566063dSJacob Faibussowitsch     PetscCall(PetscCalloc2(Nf, &quads, Nf, &geoms));
55163e9753d6SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
55173e9753d6SMatthew G. Knepley       PetscFE fe;
55183e9753d6SMatthew G. Knepley 
55199566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(ds, f, (PetscObject *)&fe));
55203e9753d6SMatthew G. Knepley       if (fe) {
55219566063dSJacob Faibussowitsch         PetscCall(PetscFEGetQuadrature(fe, &quads[f]));
55229566063dSJacob Faibussowitsch         PetscCall(PetscObjectReference((PetscObject)quads[f]));
55233e9753d6SMatthew G. Knepley       }
55243e9753d6SMatthew G. Knepley     }
55253e9753d6SMatthew G. Knepley   }
55263e9753d6SMatthew G. Knepley   /* Loop over chunks */
55273e9753d6SMatthew G. Knepley   cellChunkSize = numCells;
55283e9753d6SMatthew G. Knepley   numChunks     = !numCells ? 0 : PetscCeilReal(((PetscReal)numCells) / cellChunkSize);
552907218a29SMatthew G. Knepley   PetscCall(PetscCalloc1(2 * cellChunkSize, &faces));
553007218a29SMatthew G. Knepley   PetscCall(ISCreateGeneral(PETSC_COMM_SELF, 2 * cellChunkSize, faces, PETSC_USE_POINTER, &chunkIS));
55313e9753d6SMatthew G. Knepley   /* Extract field coefficients */
55323e9753d6SMatthew G. Knepley   /* NOTE This needs the end cap faces to have identical orientations */
553307218a29SMatthew G. Knepley   PetscCall(DMPlexGetHybridCellFields(dm, cellIS, locX, locX_t, locA[2], &u, &u_t, &a[2]));
553407218a29SMatthew G. Knepley   PetscCall(DMPlexGetHybridFields(dm, dmAux, dsAux, cellIS, locA, PETSC_TRUE, a));
55353e2b0218SMatthew G. Knepley   PetscCall(DMPlexGetHybridFields(dm, dmScale, dsScale, cellIS, locS, PETSC_TRUE, s));
553607218a29SMatthew G. Knepley   PetscCall(DMGetWorkArray(dm, cellChunkSize * totDim, MPIU_SCALAR, &elemVecNeg));
553707218a29SMatthew G. Knepley   PetscCall(DMGetWorkArray(dm, cellChunkSize * totDim, MPIU_SCALAR, &elemVecPos));
553807218a29SMatthew G. Knepley   PetscCall(DMGetWorkArray(dm, cellChunkSize * totDim, MPIU_SCALAR, &elemVecCoh));
55393e9753d6SMatthew G. Knepley   for (chunk = 0; chunk < numChunks; ++chunk) {
55403e9753d6SMatthew G. Knepley     PetscInt cS = cStart + chunk * cellChunkSize, cE = PetscMin(cS + cellChunkSize, cEnd), numCells = cE - cS, c;
55413e9753d6SMatthew G. Knepley 
554207218a29SMatthew G. Knepley     PetscCall(PetscArrayzero(elemVecNeg, cellChunkSize * totDim));
554307218a29SMatthew G. Knepley     PetscCall(PetscArrayzero(elemVecPos, cellChunkSize * totDim));
554407218a29SMatthew G. Knepley     PetscCall(PetscArrayzero(elemVecCoh, cellChunkSize * totDim));
55453e9753d6SMatthew G. Knepley     /* Get faces */
55463e9753d6SMatthew G. Knepley     for (c = cS; c < cE; ++c) {
55473e9753d6SMatthew G. Knepley       const PetscInt  cell = cells ? cells[c] : c;
55483e9753d6SMatthew G. Knepley       const PetscInt *cone;
55499566063dSJacob Faibussowitsch       PetscCall(DMPlexGetCone(dm, cell, &cone));
555007218a29SMatthew G. Knepley       faces[(c - cS) * 2 + 0] = cone[0];
555107218a29SMatthew G. Knepley       faces[(c - cS) * 2 + 1] = cone[1];
55523e9753d6SMatthew G. Knepley     }
555307218a29SMatthew G. Knepley     PetscCall(ISGeneralSetIndices(chunkIS, 2 * cellChunkSize, faces, PETSC_USE_POINTER));
55543e9753d6SMatthew G. Knepley     /* Get geometric data */
55553e9753d6SMatthew G. Knepley     if (maxDegree <= 1) {
55569566063dSJacob Faibussowitsch       if (!affineQuad) PetscCall(DMFieldCreateDefaultQuadrature(coordField, chunkIS, &affineQuad));
55579566063dSJacob Faibussowitsch       if (affineQuad) PetscCall(DMSNESGetFEGeom(coordField, chunkIS, affineQuad, PETSC_TRUE, &affineGeom));
55583e9753d6SMatthew G. Knepley     } else {
55593e9753d6SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
55609566063dSJacob Faibussowitsch         if (quads[f]) PetscCall(DMSNESGetFEGeom(coordField, chunkIS, quads[f], PETSC_TRUE, &geoms[f]));
55613e9753d6SMatthew G. Knepley       }
55623e9753d6SMatthew G. Knepley     }
55633e9753d6SMatthew G. Knepley     /* Loop over fields */
55643e9753d6SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
55653e9753d6SMatthew G. Knepley       PetscFE         fe;
55663e9753d6SMatthew G. Knepley       PetscFEGeom    *geom      = affineGeom ? affineGeom : geoms[f];
5567148442b3SMatthew G. Knepley       PetscFEGeom    *chunkGeom = NULL, *remGeom = NULL;
55683e9753d6SMatthew G. Knepley       PetscQuadrature quad = affineQuad ? affineQuad : quads[f];
55693e9753d6SMatthew G. Knepley       PetscInt        numChunks, numBatches, batchSize, numBlocks, blockSize, Ne, Nr, offset, Nq, Nb;
55705fedec97SMatthew G. Knepley       PetscBool       isCohesiveField;
55713e9753d6SMatthew G. Knepley 
55729566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(ds, f, (PetscObject *)&fe));
55733e9753d6SMatthew G. Knepley       if (!fe) continue;
55749566063dSJacob Faibussowitsch       PetscCall(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
55759566063dSJacob Faibussowitsch       PetscCall(PetscQuadratureGetData(quad, NULL, NULL, &Nq, NULL, NULL));
55769566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDimension(fe, &Nb));
55773e9753d6SMatthew G. Knepley       blockSize = Nb;
55783e9753d6SMatthew G. Knepley       batchSize = numBlocks * blockSize;
55799566063dSJacob Faibussowitsch       PetscCall(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
55803e9753d6SMatthew G. Knepley       numChunks = numCells / (numBatches * batchSize);
55813e9753d6SMatthew G. Knepley       Ne        = numChunks * numBatches * batchSize;
55823e9753d6SMatthew G. Knepley       Nr        = numCells % (numBatches * batchSize);
55833e9753d6SMatthew G. Knepley       offset    = numCells - Nr;
558407218a29SMatthew G. Knepley       PetscCall(PetscFEGeomGetChunk(geom, 0, offset * 2, &chunkGeom));
558507218a29SMatthew G. Knepley       PetscCall(PetscFEGeomGetChunk(geom, offset * 2, numCells * 2, &remGeom));
55869566063dSJacob Faibussowitsch       PetscCall(PetscDSGetCohesive(ds, f, &isCohesiveField));
55875fedec97SMatthew G. Knepley       chunkGeom->isCohesive = remGeom->isCohesive = PETSC_TRUE;
55886528b96dSMatthew G. Knepley       key[0].field                                = f;
55896528b96dSMatthew G. Knepley       key[1].field                                = f;
55905fedec97SMatthew G. Knepley       key[2].field                                = f;
559107218a29SMatthew G. Knepley       PetscCall(PetscFEIntegrateHybridResidual(ds, dsIn, key[0], 0, Ne, chunkGeom, u, u_t, dsAux[0], a[0], t, elemVecNeg));
55928e3a54c0SPierre Jolivet       PetscCall(PetscFEIntegrateHybridResidual(ds, dsIn, key[0], 0, Nr, remGeom, &u[offset * totDimIn], PetscSafePointerPlusOffset(u_t, offset * totDimIn), dsAux[0], PetscSafePointerPlusOffset(a[0], offset * totDimAux[0]), t, &elemVecNeg[offset * totDim]));
559307218a29SMatthew G. Knepley       PetscCall(PetscFEIntegrateHybridResidual(ds, dsIn, key[1], 1, Ne, chunkGeom, u, u_t, dsAux[1], a[1], t, elemVecPos));
55948e3a54c0SPierre Jolivet       PetscCall(PetscFEIntegrateHybridResidual(ds, dsIn, key[1], 1, Nr, remGeom, &u[offset * totDimIn], PetscSafePointerPlusOffset(u_t, offset * totDimIn), dsAux[1], PetscSafePointerPlusOffset(a[1], offset * totDimAux[1]), t, &elemVecPos[offset * totDim]));
559507218a29SMatthew G. Knepley       PetscCall(PetscFEIntegrateHybridResidual(ds, dsIn, key[2], 2, Ne, chunkGeom, u, u_t, dsAux[2], a[2], t, elemVecCoh));
55968e3a54c0SPierre Jolivet       PetscCall(PetscFEIntegrateHybridResidual(ds, dsIn, key[2], 2, Nr, remGeom, &u[offset * totDimIn], PetscSafePointerPlusOffset(u_t, offset * totDimIn), dsAux[2], PetscSafePointerPlusOffset(a[2], offset * totDimAux[2]), t, &elemVecCoh[offset * totDim]));
55979566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomRestoreChunk(geom, offset, numCells, &remGeom));
55989566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomRestoreChunk(geom, 0, offset, &chunkGeom));
55993e9753d6SMatthew G. Knepley     }
56003e9753d6SMatthew G. Knepley     /* Add elemVec to locX */
56013e9753d6SMatthew G. Knepley     for (c = cS; c < cE; ++c) {
56023e9753d6SMatthew G. Knepley       const PetscInt cell = cells ? cells[c] : c;
56033e9753d6SMatthew G. Knepley       const PetscInt cind = c - cStart;
560407218a29SMatthew G. Knepley       PetscInt       i;
56053e9753d6SMatthew G. Knepley 
560607218a29SMatthew G. Knepley       /* Scale element values */
560707218a29SMatthew G. Knepley       if (locS[0]) {
56083e2b0218SMatthew G. Knepley         PetscInt  Nb, off = cind * totDim, soff = cind * totDimScale[0];
560907218a29SMatthew G. Knepley         PetscBool cohesive;
561007218a29SMatthew G. Knepley 
561107218a29SMatthew G. Knepley         for (f = 0; f < Nf; ++f) {
561207218a29SMatthew G. Knepley           PetscCall(PetscDSGetFieldSize(ds, f, &Nb));
561307218a29SMatthew G. Knepley           PetscCall(PetscDSGetCohesive(ds, f, &cohesive));
561407218a29SMatthew G. Knepley           if (f == key[2].field) {
561507218a29SMatthew G. Knepley             PetscCheck(cohesive, PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Scaling should not happen for face fields");
561607218a29SMatthew G. Knepley             // No cohesive scaling field is currently input
561707218a29SMatthew G. Knepley             for (i = 0; i < Nb; ++i) elemVecCoh[off + i] += s[0][soff + i] * elemVecNeg[off + i] + s[1][soff + i] * elemVecPos[off + i];
561807218a29SMatthew G. Knepley             off += Nb;
561907218a29SMatthew G. Knepley           } else {
562007218a29SMatthew G. Knepley             const PetscInt N = cohesive ? Nb : Nb * 2;
562107218a29SMatthew G. Knepley 
562207218a29SMatthew G. Knepley             for (i = 0; i < N; ++i) elemVecCoh[off + i] += elemVecNeg[off + i] + elemVecPos[off + i];
562307218a29SMatthew G. Knepley             off += N;
562407218a29SMatthew G. Knepley           }
562507218a29SMatthew G. Knepley         }
562607218a29SMatthew G. Knepley       } else {
562707218a29SMatthew G. Knepley         for (i = cind * totDim; i < (cind + 1) * totDim; ++i) elemVecCoh[i] += elemVecNeg[i] + elemVecPos[i];
562807218a29SMatthew G. Knepley       }
562907218a29SMatthew G. Knepley       if (mesh->printFEM > 1) PetscCall(DMPrintCellVector(cell, name, totDim, &elemVecCoh[cind * totDim]));
56303e9753d6SMatthew G. Knepley       if (ghostLabel) {
56313e9753d6SMatthew G. Knepley         PetscInt ghostVal;
56323e9753d6SMatthew G. Knepley 
56339566063dSJacob Faibussowitsch         PetscCall(DMLabelGetValue(ghostLabel, cell, &ghostVal));
56343e9753d6SMatthew G. Knepley         if (ghostVal > 0) continue;
56353e9753d6SMatthew G. Knepley       }
563607218a29SMatthew G. Knepley       PetscCall(DMPlexVecSetClosure(dm, section, locF, cell, &elemVecCoh[cind * totDim], ADD_ALL_VALUES));
56373e9753d6SMatthew G. Knepley     }
56383e9753d6SMatthew G. Knepley   }
56399566063dSJacob Faibussowitsch   PetscCall(DMPlexRestoreCellFields(dm, cellIS, locX, locX_t, locA[2], &u, &u_t, &a[2]));
564007218a29SMatthew G. Knepley   PetscCall(DMPlexRestoreHybridFields(dm, dmAux, dsAux, cellIS, locA, PETSC_TRUE, a));
56413e2b0218SMatthew G. Knepley   PetscCall(DMPlexRestoreHybridFields(dm, dmScale, dsScale, cellIS, locS, PETSC_TRUE, s));
564207218a29SMatthew G. Knepley   PetscCall(DMRestoreWorkArray(dm, numCells * totDim, MPIU_SCALAR, &elemVecNeg));
564307218a29SMatthew G. Knepley   PetscCall(DMRestoreWorkArray(dm, numCells * totDim, MPIU_SCALAR, &elemVecPos));
564407218a29SMatthew G. Knepley   PetscCall(DMRestoreWorkArray(dm, numCells * totDim, MPIU_SCALAR, &elemVecCoh));
56459566063dSJacob Faibussowitsch   PetscCall(PetscFree(faces));
56469566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&chunkIS));
56479566063dSJacob Faibussowitsch   PetscCall(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
56483e9753d6SMatthew G. Knepley   if (maxDegree <= 1) {
56499566063dSJacob Faibussowitsch     PetscCall(DMSNESRestoreFEGeom(coordField, cellIS, affineQuad, PETSC_FALSE, &affineGeom));
56509566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureDestroy(&affineQuad));
56513e9753d6SMatthew G. Knepley   } else {
56523e9753d6SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
56539566063dSJacob Faibussowitsch       if (geoms) PetscCall(DMSNESRestoreFEGeom(coordField, cellIS, quads[f], PETSC_FALSE, &geoms[f]));
56549566063dSJacob Faibussowitsch       if (quads) PetscCall(PetscQuadratureDestroy(&quads[f]));
56553e9753d6SMatthew G. Knepley     }
56569566063dSJacob Faibussowitsch     PetscCall(PetscFree2(quads, geoms));
56573e9753d6SMatthew G. Knepley   }
565885cc2951SMatthew G. Knepley   if (mesh->printFEM) {
565985cc2951SMatthew G. Knepley     Vec          locFbc;
566085cc2951SMatthew G. Knepley     PetscInt     pStart, pEnd, p, maxDof;
566185cc2951SMatthew G. Knepley     PetscScalar *zeroes;
566285cc2951SMatthew G. Knepley 
566385cc2951SMatthew G. Knepley     PetscCall(VecDuplicate(locF, &locFbc));
566485cc2951SMatthew G. Knepley     PetscCall(VecCopy(locF, locFbc));
566585cc2951SMatthew G. Knepley     PetscCall(PetscSectionGetChart(section, &pStart, &pEnd));
566685cc2951SMatthew G. Knepley     PetscCall(PetscSectionGetMaxDof(section, &maxDof));
566785cc2951SMatthew G. Knepley     PetscCall(PetscCalloc1(maxDof, &zeroes));
566885cc2951SMatthew G. Knepley     for (p = pStart; p < pEnd; p++) PetscCall(VecSetValuesSection(locFbc, section, p, zeroes, INSERT_BC_VALUES));
566985cc2951SMatthew G. Knepley     PetscCall(PetscFree(zeroes));
567085cc2951SMatthew G. Knepley     PetscCall(DMPrintLocalVec(dm, name, mesh->printTol, locFbc));
567185cc2951SMatthew G. Knepley     PetscCall(VecDestroy(&locFbc));
567285cc2951SMatthew G. Knepley   }
56733cc88e6aSStefano Zampini end:
56749566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_ResidualFEM, dm, 0, 0, 0));
56753ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
56763e9753d6SMatthew G. Knepley }
56773e9753d6SMatthew G. Knepley 
5678a4e35b19SJacob Faibussowitsch static 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)
5679d71ae5a4SJacob Faibussowitsch {
56803e9753d6SMatthew G. Knepley   DM_Plex        *mesh = (DM_Plex *)dm->data;
56813e9753d6SMatthew G. Knepley   DM              plex = NULL, plexA = NULL, tdm;
56823e9753d6SMatthew G. Knepley   DMEnclosureType encAux;
5683be62b2b4SMatthew G. Knepley   PetscDS         ds, dsAux           = NULL;
56843e9753d6SMatthew G. Knepley   PetscSection    section, sectionAux = NULL;
5685e432b41dSStefano Zampini   PetscSection    globalSection;
56863e9753d6SMatthew G. Knepley   Vec             locA = NULL, tv;
5687be62b2b4SMatthew G. Knepley   PetscScalar    *u = NULL, *u_t = NULL, *a = NULL, *elemMat = NULL, *elemMatP = NULL;
56883e9753d6SMatthew G. Knepley   PetscInt        v;
56893e9753d6SMatthew G. Knepley   PetscInt        Nf, totDim, totDimAux = 0;
5690be62b2b4SMatthew G. Knepley   PetscBool       hasJac = PETSC_FALSE, hasPrec = PETSC_FALSE, transform;
56913e9753d6SMatthew G. Knepley 
56923e9753d6SMatthew G. Knepley   PetscFunctionBegin;
56939566063dSJacob Faibussowitsch   PetscCall(DMHasBasisTransform(dm, &transform));
56949566063dSJacob Faibussowitsch   PetscCall(DMGetBasisTransformDM_Internal(dm, &tdm));
56959566063dSJacob Faibussowitsch   PetscCall(DMGetBasisTransformVec_Internal(dm, &tv));
56969566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
5697be62b2b4SMatthew G. Knepley   PetscCall(DMGetDS(dm, &ds));
5698be62b2b4SMatthew G. Knepley   PetscCall(PetscDSGetNumFields(ds, &Nf));
5699be62b2b4SMatthew G. Knepley   PetscCall(PetscDSGetTotalDimension(ds, &totDim));
570021a4fad8SMatthew G. Knepley   PetscCall(PetscWeakFormHasBdJacobian(wf, &hasJac));
570121a4fad8SMatthew G. Knepley   PetscCall(PetscWeakFormHasBdJacobianPreconditioner(wf, &hasPrec));
570221a4fad8SMatthew G. Knepley   if (!hasJac && !hasPrec) PetscFunctionReturn(PETSC_SUCCESS);
570321a4fad8SMatthew G. Knepley   PetscCall(DMConvert(dm, DMPLEX, &plex));
57049566063dSJacob Faibussowitsch   PetscCall(DMGetAuxiliaryVec(dm, label, values[0], 0, &locA));
57053e9753d6SMatthew G. Knepley   if (locA) {
57063e9753d6SMatthew G. Knepley     DM dmAux;
57073e9753d6SMatthew G. Knepley 
57089566063dSJacob Faibussowitsch     PetscCall(VecGetDM(locA, &dmAux));
57099566063dSJacob Faibussowitsch     PetscCall(DMGetEnclosureRelation(dmAux, dm, &encAux));
57109566063dSJacob Faibussowitsch     PetscCall(DMConvert(dmAux, DMPLEX, &plexA));
5711be62b2b4SMatthew G. Knepley     PetscCall(DMGetDS(plexA, &dsAux));
5712be62b2b4SMatthew G. Knepley     PetscCall(PetscDSGetTotalDimension(dsAux, &totDimAux));
57139566063dSJacob Faibussowitsch     PetscCall(DMGetLocalSection(plexA, &sectionAux));
57143e9753d6SMatthew G. Knepley   }
57153e9753d6SMatthew G. Knepley 
57169566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dm, &globalSection));
57173e9753d6SMatthew G. Knepley   for (v = 0; v < numValues; ++v) {
57183e9753d6SMatthew G. Knepley     PetscFEGeom    *fgeom;
57193e9753d6SMatthew G. Knepley     PetscInt        maxDegree;
57203e9753d6SMatthew G. Knepley     PetscQuadrature qGeom = NULL;
57213e9753d6SMatthew G. Knepley     IS              pointIS;
57223e9753d6SMatthew G. Knepley     const PetscInt *points;
572306ad1575SMatthew G. Knepley     PetscFormKey    key;
57243e9753d6SMatthew G. Knepley     PetscInt        numFaces, face, Nq;
57253e9753d6SMatthew G. Knepley 
572645480ffeSMatthew G. Knepley     key.label = label;
572745480ffeSMatthew G. Knepley     key.value = values[v];
572806ad1575SMatthew G. Knepley     key.part  = 0;
57299566063dSJacob Faibussowitsch     PetscCall(DMLabelGetStratumIS(label, values[v], &pointIS));
57303e9753d6SMatthew G. Knepley     if (!pointIS) continue; /* No points with that id on this process */
57313e9753d6SMatthew G. Knepley     {
57323e9753d6SMatthew G. Knepley       IS isectIS;
57333e9753d6SMatthew G. Knepley 
57343e9753d6SMatthew G. Knepley       /* TODO: Special cases of ISIntersect where it is quick to check a prior if one is a superset of the other */
57359566063dSJacob Faibussowitsch       PetscCall(ISIntersect_Caching_Internal(facetIS, pointIS, &isectIS));
57369566063dSJacob Faibussowitsch       PetscCall(ISDestroy(&pointIS));
57373e9753d6SMatthew G. Knepley       pointIS = isectIS;
57383e9753d6SMatthew G. Knepley     }
57399566063dSJacob Faibussowitsch     PetscCall(ISGetLocalSize(pointIS, &numFaces));
57409566063dSJacob Faibussowitsch     PetscCall(ISGetIndices(pointIS, &points));
5741be62b2b4SMatthew G. Knepley     PetscCall(PetscMalloc5(numFaces * totDim, &u, locX_t ? numFaces * totDim : 0, &u_t, hasJac ? numFaces * totDim * totDim : 0, &elemMat, hasPrec ? numFaces * totDim * totDim : 0, &elemMatP, locA ? numFaces * totDimAux : 0, &a));
57429566063dSJacob Faibussowitsch     PetscCall(DMFieldGetDegree(coordField, pointIS, NULL, &maxDegree));
574348a46eb9SPierre Jolivet     if (maxDegree <= 1) PetscCall(DMFieldCreateDefaultQuadrature(coordField, pointIS, &qGeom));
57443e9753d6SMatthew G. Knepley     if (!qGeom) {
57453e9753d6SMatthew G. Knepley       PetscFE fe;
57463e9753d6SMatthew G. Knepley 
5747be62b2b4SMatthew G. Knepley       PetscCall(PetscDSGetDiscretization(ds, fieldI, (PetscObject *)&fe));
57489566063dSJacob Faibussowitsch       PetscCall(PetscFEGetFaceQuadrature(fe, &qGeom));
57499566063dSJacob Faibussowitsch       PetscCall(PetscObjectReference((PetscObject)qGeom));
57503e9753d6SMatthew G. Knepley     }
57519566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureGetData(qGeom, NULL, NULL, &Nq, NULL, NULL));
57529566063dSJacob Faibussowitsch     PetscCall(DMSNESGetFEGeom(coordField, pointIS, qGeom, PETSC_TRUE, &fgeom));
57533e9753d6SMatthew G. Knepley     for (face = 0; face < numFaces; ++face) {
5754f15274beSMatthew Knepley       const PetscInt point = points[face], *support;
57553e9753d6SMatthew G. Knepley       PetscScalar   *x     = NULL;
5756f15274beSMatthew Knepley       PetscInt       i;
57573e9753d6SMatthew G. Knepley 
57589566063dSJacob Faibussowitsch       PetscCall(DMPlexGetSupport(dm, point, &support));
57599566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(plex, section, locX, support[0], NULL, &x));
57603e9753d6SMatthew G. Knepley       for (i = 0; i < totDim; ++i) u[face * totDim + i] = x[i];
57619566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(plex, section, locX, support[0], NULL, &x));
57623e9753d6SMatthew G. Knepley       if (locX_t) {
57639566063dSJacob Faibussowitsch         PetscCall(DMPlexVecGetClosure(plex, section, locX_t, support[0], NULL, &x));
57643e9753d6SMatthew G. Knepley         for (i = 0; i < totDim; ++i) u_t[face * totDim + i] = x[i];
57659566063dSJacob Faibussowitsch         PetscCall(DMPlexVecRestoreClosure(plex, section, locX_t, support[0], NULL, &x));
57663e9753d6SMatthew G. Knepley       }
57673e9753d6SMatthew G. Knepley       if (locA) {
57683e9753d6SMatthew G. Knepley         PetscInt subp;
57699566063dSJacob Faibussowitsch         PetscCall(DMGetEnclosurePoint(plexA, dm, encAux, support[0], &subp));
57709566063dSJacob Faibussowitsch         PetscCall(DMPlexVecGetClosure(plexA, sectionAux, locA, subp, NULL, &x));
57713e9753d6SMatthew G. Knepley         for (i = 0; i < totDimAux; ++i) a[face * totDimAux + i] = x[i];
57729566063dSJacob Faibussowitsch         PetscCall(DMPlexVecRestoreClosure(plexA, sectionAux, locA, subp, NULL, &x));
57733e9753d6SMatthew G. Knepley       }
57743e9753d6SMatthew G. Knepley     }
577521a4fad8SMatthew G. Knepley     if (elemMat) PetscCall(PetscArrayzero(elemMat, numFaces * totDim * totDim));
577621a4fad8SMatthew G. Knepley     if (elemMatP) PetscCall(PetscArrayzero(elemMatP, numFaces * totDim * totDim));
57773e9753d6SMatthew G. Knepley     {
57783e9753d6SMatthew G. Knepley       PetscFE  fe;
57793e9753d6SMatthew G. Knepley       PetscInt Nb;
57803e9753d6SMatthew G. Knepley       /* Conforming batches */
57813e9753d6SMatthew G. Knepley       PetscInt numChunks, numBatches, numBlocks, Ne, blockSize, batchSize;
57823e9753d6SMatthew G. Knepley       /* Remainder */
57833e9753d6SMatthew G. Knepley       PetscFEGeom *chunkGeom = NULL;
57843e9753d6SMatthew G. Knepley       PetscInt     fieldJ, Nr, offset;
57853e9753d6SMatthew G. Knepley 
5786be62b2b4SMatthew G. Knepley       PetscCall(PetscDSGetDiscretization(ds, fieldI, (PetscObject *)&fe));
57879566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDimension(fe, &Nb));
57889566063dSJacob Faibussowitsch       PetscCall(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
57893e9753d6SMatthew G. Knepley       blockSize = Nb;
57903e9753d6SMatthew G. Knepley       batchSize = numBlocks * blockSize;
57919566063dSJacob Faibussowitsch       PetscCall(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
57923e9753d6SMatthew G. Knepley       numChunks = numFaces / (numBatches * batchSize);
57933e9753d6SMatthew G. Knepley       Ne        = numChunks * numBatches * batchSize;
57943e9753d6SMatthew G. Knepley       Nr        = numFaces % (numBatches * batchSize);
57953e9753d6SMatthew G. Knepley       offset    = numFaces - Nr;
57969566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomGetChunk(fgeom, 0, offset, &chunkGeom));
57973e9753d6SMatthew G. Knepley       for (fieldJ = 0; fieldJ < Nf; ++fieldJ) {
579845480ffeSMatthew G. Knepley         key.field = fieldI * Nf + fieldJ;
5799be62b2b4SMatthew G. Knepley         if (hasJac) PetscCall(PetscFEIntegrateBdJacobian(ds, wf, PETSCFE_JACOBIAN, key, Ne, chunkGeom, u, u_t, dsAux, a, t, X_tShift, elemMat));
5800be62b2b4SMatthew G. Knepley         if (hasPrec) PetscCall(PetscFEIntegrateBdJacobian(ds, wf, PETSCFE_JACOBIAN_PRE, key, Ne, chunkGeom, u, u_t, dsAux, a, t, X_tShift, elemMatP));
58013e9753d6SMatthew G. Knepley       }
58029566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomGetChunk(fgeom, offset, numFaces, &chunkGeom));
58033e9753d6SMatthew G. Knepley       for (fieldJ = 0; fieldJ < Nf; ++fieldJ) {
580445480ffeSMatthew G. Knepley         key.field = fieldI * Nf + fieldJ;
5805be62b2b4SMatthew G. Knepley         if (hasJac)
58068e3a54c0SPierre Jolivet           PetscCall(PetscFEIntegrateBdJacobian(ds, wf, PETSCFE_JACOBIAN, key, Nr, chunkGeom, &u[offset * totDim], PetscSafePointerPlusOffset(u_t, offset * totDim), dsAux, PetscSafePointerPlusOffset(a, offset * totDimAux), t, X_tShift, &elemMat[offset * totDim * totDim]));
5807be62b2b4SMatthew G. Knepley         if (hasPrec)
58088e3a54c0SPierre Jolivet           PetscCall(PetscFEIntegrateBdJacobian(ds, wf, PETSCFE_JACOBIAN_PRE, key, Nr, chunkGeom, &u[offset * totDim], PetscSafePointerPlusOffset(u_t, offset * totDim), dsAux, PetscSafePointerPlusOffset(a, offset * totDimAux), t, X_tShift, &elemMatP[offset * totDim * totDim]));
58093e9753d6SMatthew G. Knepley       }
58109566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomRestoreChunk(fgeom, offset, numFaces, &chunkGeom));
58113e9753d6SMatthew G. Knepley     }
58123e9753d6SMatthew G. Knepley     for (face = 0; face < numFaces; ++face) {
58133e9753d6SMatthew G. Knepley       const PetscInt point = points[face], *support;
58143e9753d6SMatthew G. Knepley 
58153e9753d6SMatthew G. Knepley       /* Transform to global basis before insertion in Jacobian */
58169566063dSJacob Faibussowitsch       PetscCall(DMPlexGetSupport(plex, point, &support));
581721a4fad8SMatthew G. Knepley       if (hasJac && transform) PetscCall(DMPlexBasisTransformPointTensor_Internal(dm, tdm, tv, support[0], PETSC_TRUE, totDim, &elemMat[face * totDim * totDim]));
581821a4fad8SMatthew G. Knepley       if (hasPrec && transform) PetscCall(DMPlexBasisTransformPointTensor_Internal(dm, tdm, tv, support[0], PETSC_TRUE, totDim, &elemMatP[face * totDim * totDim]));
5819be62b2b4SMatthew G. Knepley       if (hasPrec) {
5820be62b2b4SMatthew G. Knepley         if (hasJac) {
58219566063dSJacob Faibussowitsch           if (mesh->printFEM > 1) PetscCall(DMPrintCellMatrix(point, "BdJacobian", totDim, totDim, &elemMat[face * totDim * totDim]));
582221a4fad8SMatthew G. Knepley           PetscCall(DMPlexMatSetClosure_Internal(plex, section, globalSection, mesh->useMatClPerm, Jac, support[0], &elemMat[face * totDim * totDim], ADD_VALUES));
58233e9753d6SMatthew G. Knepley         }
5824be62b2b4SMatthew G. Knepley         if (mesh->printFEM > 1) PetscCall(DMPrintCellMatrix(point, "BdJacobian", totDim, totDim, &elemMatP[face * totDim * totDim]));
5825be62b2b4SMatthew G. Knepley         PetscCall(DMPlexMatSetClosure_Internal(plex, section, globalSection, mesh->useMatClPerm, JacP, support[0], &elemMatP[face * totDim * totDim], ADD_VALUES));
5826be62b2b4SMatthew G. Knepley       } else {
5827be62b2b4SMatthew G. Knepley         if (hasJac) {
5828be62b2b4SMatthew G. Knepley           if (mesh->printFEM > 1) PetscCall(DMPrintCellMatrix(point, "BdJacobian", totDim, totDim, &elemMat[face * totDim * totDim]));
582921a4fad8SMatthew G. Knepley           PetscCall(DMPlexMatSetClosure_Internal(plex, section, globalSection, mesh->useMatClPerm, Jac, support[0], &elemMat[face * totDim * totDim], ADD_VALUES));
5830be62b2b4SMatthew G. Knepley         }
5831be62b2b4SMatthew G. Knepley       }
5832be62b2b4SMatthew G. Knepley     }
58339566063dSJacob Faibussowitsch     PetscCall(DMSNESRestoreFEGeom(coordField, pointIS, qGeom, PETSC_TRUE, &fgeom));
58349566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureDestroy(&qGeom));
58359566063dSJacob Faibussowitsch     PetscCall(ISRestoreIndices(pointIS, &points));
58369566063dSJacob Faibussowitsch     PetscCall(ISDestroy(&pointIS));
5837be62b2b4SMatthew G. Knepley     PetscCall(PetscFree5(u, u_t, elemMat, elemMatP, a));
58383e9753d6SMatthew G. Knepley   }
58399566063dSJacob Faibussowitsch   if (plex) PetscCall(DMDestroy(&plex));
58409566063dSJacob Faibussowitsch   if (plexA) PetscCall(DMDestroy(&plexA));
58413ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
58423e9753d6SMatthew G. Knepley }
58433e9753d6SMatthew G. Knepley 
5844d71ae5a4SJacob Faibussowitsch 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)
5845d71ae5a4SJacob Faibussowitsch {
58463e9753d6SMatthew G. Knepley   DMField  coordField;
58473e9753d6SMatthew G. Knepley   DMLabel  depthLabel;
58483e9753d6SMatthew G. Knepley   IS       facetIS;
58493e9753d6SMatthew G. Knepley   PetscInt dim;
58503e9753d6SMatthew G. Knepley 
58513e9753d6SMatthew G. Knepley   PetscFunctionBegin;
58529566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
58539566063dSJacob Faibussowitsch   PetscCall(DMPlexGetDepthLabel(dm, &depthLabel));
58549566063dSJacob Faibussowitsch   PetscCall(DMLabelGetStratumIS(depthLabel, dim - 1, &facetIS));
58559566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateField(dm, &coordField));
58569566063dSJacob Faibussowitsch   PetscCall(DMPlexComputeBdJacobian_Single_Internal(dm, t, wf, label, numValues, values, field, locX, locX_t, X_tShift, Jac, JacP, coordField, facetIS));
58579566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&facetIS));
58583ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
58593e9753d6SMatthew G. Knepley }
58603e9753d6SMatthew G. Knepley 
5861a4e35b19SJacob Faibussowitsch static PetscErrorCode DMPlexComputeBdJacobian_Internal(DM dm, Vec locX, Vec locX_t, PetscReal t, PetscReal X_tShift, Mat Jac, Mat JacP, void *user)
5862d71ae5a4SJacob Faibussowitsch {
58633e9753d6SMatthew G. Knepley   PetscDS  prob;
58643e9753d6SMatthew G. Knepley   PetscInt dim, numBd, bd;
58653e9753d6SMatthew G. Knepley   DMLabel  depthLabel;
58663e9753d6SMatthew G. Knepley   DMField  coordField = NULL;
58673e9753d6SMatthew G. Knepley   IS       facetIS;
58683e9753d6SMatthew G. Knepley 
58693e9753d6SMatthew G. Knepley   PetscFunctionBegin;
58709566063dSJacob Faibussowitsch   PetscCall(DMGetDS(dm, &prob));
58719566063dSJacob Faibussowitsch   PetscCall(DMPlexGetDepthLabel(dm, &depthLabel));
58729566063dSJacob Faibussowitsch   PetscCall(DMGetDimension(dm, &dim));
58739566063dSJacob Faibussowitsch   PetscCall(DMLabelGetStratumIS(depthLabel, dim - 1, &facetIS));
58749566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumBoundary(prob, &numBd));
58759566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateField(dm, &coordField));
58763e9753d6SMatthew G. Knepley   for (bd = 0; bd < numBd; ++bd) {
587745480ffeSMatthew G. Knepley     PetscWeakForm           wf;
58783e9753d6SMatthew G. Knepley     DMBoundaryConditionType type;
58793e9753d6SMatthew G. Knepley     DMLabel                 label;
58803e9753d6SMatthew G. Knepley     const PetscInt         *values;
58813e9753d6SMatthew G. Knepley     PetscInt                fieldI, numValues;
58823e9753d6SMatthew G. Knepley     PetscObject             obj;
58833e9753d6SMatthew G. Knepley     PetscClassId            id;
58843e9753d6SMatthew G. Knepley 
58859566063dSJacob Faibussowitsch     PetscCall(PetscDSGetBoundary(prob, bd, &wf, &type, NULL, &label, &numValues, &values, &fieldI, NULL, NULL, NULL, NULL, NULL));
58863d3e5d66SMatthew G. Knepley     if (type & DM_BC_ESSENTIAL) continue;
58879566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, fieldI, &obj));
58889566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId(obj, &id));
58893d3e5d66SMatthew G. Knepley     if (id != PETSCFE_CLASSID) continue;
58909566063dSJacob Faibussowitsch     PetscCall(DMPlexComputeBdJacobian_Single_Internal(dm, t, wf, label, numValues, values, fieldI, locX, locX_t, X_tShift, Jac, JacP, coordField, facetIS));
58913e9753d6SMatthew G. Knepley   }
58929566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&facetIS));
58933ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
58943e9753d6SMatthew G. Knepley }
58953e9753d6SMatthew G. Knepley 
5896d71ae5a4SJacob Faibussowitsch 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)
5897d71ae5a4SJacob Faibussowitsch {
58983e9753d6SMatthew G. Knepley   DM_Plex        *mesh  = (DM_Plex *)dm->data;
58993e9753d6SMatthew G. Knepley   const char     *name  = "Jacobian";
59009a2a23afSMatthew G. Knepley   DM              dmAux = NULL, plex, tdm;
59013e9753d6SMatthew G. Knepley   DMEnclosureType encAux;
59023e9753d6SMatthew G. Knepley   Vec             A, tv;
59033e9753d6SMatthew G. Knepley   DMField         coordField;
59043e9753d6SMatthew G. Knepley   PetscDS         prob, probAux = NULL;
5905e432b41dSStefano Zampini   PetscSection    section, globalSection, sectionAux;
59063e9753d6SMatthew G. Knepley   PetscScalar    *elemMat, *elemMatP, *elemMatD, *u, *u_t, *a = NULL;
59073e9753d6SMatthew G. Knepley   const PetscInt *cells;
59083e9753d6SMatthew G. Knepley   PetscInt        Nf, fieldI, fieldJ;
590928351e22SJed Brown   PetscInt        totDim, totDimAux = 0, cStart, cEnd, numCells, c;
5910e04ae0b4SMatthew G. Knepley   PetscBool       hasJac = PETSC_FALSE, hasPrec = PETSC_FALSE, hasDyn, hasFV = PETSC_FALSE, transform;
59113e9753d6SMatthew G. Knepley 
59123e9753d6SMatthew G. Knepley   PetscFunctionBegin;
5913af18b51aSmarkadams4   PetscCall(PetscLogEventBegin(DMPLEX_JacobianFEM, dm, 0, 0, 0));
5914ae3cf2c1SStefano Zampini   PetscCall(DMGetLocalSection(dm, &section));
5915ae3cf2c1SStefano Zampini   PetscCall(DMGetGlobalSection(dm, &globalSection));
5916ae3cf2c1SStefano Zampini   PetscCall(DMGetAuxiliaryVec(dm, key.label, key.value, key.part, &A));
5917ae3cf2c1SStefano Zampini   if (A) {
5918ae3cf2c1SStefano Zampini     PetscCall(VecGetDM(A, &dmAux));
5919ae3cf2c1SStefano Zampini     PetscCall(DMGetEnclosureRelation(dmAux, dm, &encAux));
5920ae3cf2c1SStefano Zampini     PetscCall(DMConvert(dmAux, DMPLEX, &plex));
5921ae3cf2c1SStefano Zampini     PetscCall(DMGetLocalSection(plex, &sectionAux));
5922ae3cf2c1SStefano Zampini     PetscCall(DMGetDS(dmAux, &probAux));
5923ae3cf2c1SStefano Zampini     PetscCall(PetscDSGetTotalDimension(probAux, &totDimAux));
5924ae3cf2c1SStefano Zampini   }
5925ae3cf2c1SStefano Zampini   PetscCall(DMGetCoordinateField(dm, &coordField));
5926e04ae0b4SMatthew G. Knepley   if (!cellIS) goto end;
59279566063dSJacob Faibussowitsch   PetscCall(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
5928437e83fbSMatthew G. Knepley   PetscCall(ISGetLocalSize(cellIS, &numCells));
5929437e83fbSMatthew G. Knepley   if (cStart >= cEnd) goto end;
59309566063dSJacob Faibussowitsch   PetscCall(DMHasBasisTransform(dm, &transform));
59319566063dSJacob Faibussowitsch   PetscCall(DMGetBasisTransformDM_Internal(dm, &tdm));
59329566063dSJacob Faibussowitsch   PetscCall(DMGetBasisTransformVec_Internal(dm, &tv));
593307218a29SMatthew G. Knepley   PetscCall(DMGetCellDS(dm, cells ? cells[cStart] : cStart, &prob, NULL));
59349566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumFields(prob, &Nf));
59359566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(prob, &totDim));
59369566063dSJacob Faibussowitsch   PetscCall(PetscDSHasJacobian(prob, &hasJac));
59379566063dSJacob Faibussowitsch   PetscCall(PetscDSHasJacobianPreconditioner(prob, &hasPrec));
59383e9753d6SMatthew G. Knepley   /* user passed in the same matrix, avoid double contributions and
59393e9753d6SMatthew G. Knepley      only assemble the Jacobian */
59403e9753d6SMatthew G. Knepley   if (hasJac && Jac == JacP) hasPrec = PETSC_FALSE;
59419566063dSJacob Faibussowitsch   PetscCall(PetscDSHasDynamicJacobian(prob, &hasDyn));
59423e9753d6SMatthew G. Knepley   hasDyn = hasDyn && (X_tShift != 0.0) ? PETSC_TRUE : PETSC_FALSE;
59439566063dSJacob 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));
59449566063dSJacob Faibussowitsch   if (dmAux) PetscCall(PetscMalloc1(numCells * totDimAux, &a));
59453e9753d6SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
59463e9753d6SMatthew G. Knepley     const PetscInt cell = cells ? cells[c] : c;
59473e9753d6SMatthew G. Knepley     const PetscInt cind = c - cStart;
59483e9753d6SMatthew G. Knepley     PetscScalar   *x = NULL, *x_t = NULL;
59493e9753d6SMatthew G. Knepley     PetscInt       i;
59503e9753d6SMatthew G. Knepley 
59519566063dSJacob Faibussowitsch     PetscCall(DMPlexVecGetClosure(dm, section, X, cell, NULL, &x));
59523e9753d6SMatthew G. Knepley     for (i = 0; i < totDim; ++i) u[cind * totDim + i] = x[i];
59539566063dSJacob Faibussowitsch     PetscCall(DMPlexVecRestoreClosure(dm, section, X, cell, NULL, &x));
59543e9753d6SMatthew G. Knepley     if (X_t) {
59559566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(dm, section, X_t, cell, NULL, &x_t));
59563e9753d6SMatthew G. Knepley       for (i = 0; i < totDim; ++i) u_t[cind * totDim + i] = x_t[i];
59579566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(dm, section, X_t, cell, NULL, &x_t));
59583e9753d6SMatthew G. Knepley     }
59593e9753d6SMatthew G. Knepley     if (dmAux) {
59603e9753d6SMatthew G. Knepley       PetscInt subcell;
59619566063dSJacob Faibussowitsch       PetscCall(DMGetEnclosurePoint(dmAux, dm, encAux, cell, &subcell));
59629566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(plex, sectionAux, A, subcell, NULL, &x));
59633e9753d6SMatthew G. Knepley       for (i = 0; i < totDimAux; ++i) a[cind * totDimAux + i] = x[i];
59649566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(plex, sectionAux, A, subcell, NULL, &x));
59653e9753d6SMatthew G. Knepley     }
59663e9753d6SMatthew G. Knepley   }
59679566063dSJacob Faibussowitsch   if (hasJac) PetscCall(PetscArrayzero(elemMat, numCells * totDim * totDim));
59689566063dSJacob Faibussowitsch   if (hasPrec) PetscCall(PetscArrayzero(elemMatP, numCells * totDim * totDim));
59699566063dSJacob Faibussowitsch   if (hasDyn) PetscCall(PetscArrayzero(elemMatD, numCells * totDim * totDim));
59703e9753d6SMatthew G. Knepley   for (fieldI = 0; fieldI < Nf; ++fieldI) {
59713e9753d6SMatthew G. Knepley     PetscClassId    id;
59723e9753d6SMatthew G. Knepley     PetscFE         fe;
59733e9753d6SMatthew G. Knepley     PetscQuadrature qGeom = NULL;
59743e9753d6SMatthew G. Knepley     PetscInt        Nb;
59753e9753d6SMatthew G. Knepley     /* Conforming batches */
59763e9753d6SMatthew G. Knepley     PetscInt numChunks, numBatches, numBlocks, Ne, blockSize, batchSize;
59773e9753d6SMatthew G. Knepley     /* Remainder */
59783e9753d6SMatthew G. Knepley     PetscInt     Nr, offset, Nq;
59793e9753d6SMatthew G. Knepley     PetscInt     maxDegree;
59803e9753d6SMatthew G. Knepley     PetscFEGeom *cgeomFEM, *chunkGeom = NULL, *remGeom = NULL;
59813e9753d6SMatthew G. Knepley 
59829566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, fieldI, (PetscObject *)&fe));
59839566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetClassId((PetscObject)fe, &id));
59849371c9d4SSatish Balay     if (id == PETSCFV_CLASSID) {
59859371c9d4SSatish Balay       hasFV = PETSC_TRUE;
59869371c9d4SSatish Balay       continue;
59879371c9d4SSatish Balay     }
59889566063dSJacob Faibussowitsch     PetscCall(PetscFEGetDimension(fe, &Nb));
59899566063dSJacob Faibussowitsch     PetscCall(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
59909566063dSJacob Faibussowitsch     PetscCall(DMFieldGetDegree(coordField, cellIS, NULL, &maxDegree));
599148a46eb9SPierre Jolivet     if (maxDegree <= 1) PetscCall(DMFieldCreateDefaultQuadrature(coordField, cellIS, &qGeom));
59923e9753d6SMatthew G. Knepley     if (!qGeom) {
59939566063dSJacob Faibussowitsch       PetscCall(PetscFEGetQuadrature(fe, &qGeom));
59949566063dSJacob Faibussowitsch       PetscCall(PetscObjectReference((PetscObject)qGeom));
59953e9753d6SMatthew G. Knepley     }
59969566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureGetData(qGeom, NULL, NULL, &Nq, NULL, NULL));
59979566063dSJacob Faibussowitsch     PetscCall(DMSNESGetFEGeom(coordField, cellIS, qGeom, PETSC_FALSE, &cgeomFEM));
59983e9753d6SMatthew G. Knepley     blockSize = Nb;
59993e9753d6SMatthew G. Knepley     batchSize = numBlocks * blockSize;
60009566063dSJacob Faibussowitsch     PetscCall(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
60013e9753d6SMatthew G. Knepley     numChunks = numCells / (numBatches * batchSize);
60023e9753d6SMatthew G. Knepley     Ne        = numChunks * numBatches * batchSize;
60033e9753d6SMatthew G. Knepley     Nr        = numCells % (numBatches * batchSize);
60043e9753d6SMatthew G. Knepley     offset    = numCells - Nr;
60059566063dSJacob Faibussowitsch     PetscCall(PetscFEGeomGetChunk(cgeomFEM, 0, offset, &chunkGeom));
60069566063dSJacob Faibussowitsch     PetscCall(PetscFEGeomGetChunk(cgeomFEM, offset, numCells, &remGeom));
60073e9753d6SMatthew G. Knepley     for (fieldJ = 0; fieldJ < Nf; ++fieldJ) {
60086528b96dSMatthew G. Knepley       key.field = fieldI * Nf + fieldJ;
60093e9753d6SMatthew G. Knepley       if (hasJac) {
60109566063dSJacob Faibussowitsch         PetscCall(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN, key, Ne, chunkGeom, u, u_t, probAux, a, t, X_tShift, elemMat));
60118e3a54c0SPierre Jolivet         PetscCall(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN, key, Nr, remGeom, &u[offset * totDim], PetscSafePointerPlusOffset(u_t, offset * totDim), probAux, PetscSafePointerPlusOffset(a, offset * totDimAux), t, X_tShift, &elemMat[offset * totDim * totDim]));
60123e9753d6SMatthew G. Knepley       }
60133e9753d6SMatthew G. Knepley       if (hasPrec) {
60149566063dSJacob Faibussowitsch         PetscCall(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN_PRE, key, Ne, chunkGeom, u, u_t, probAux, a, t, X_tShift, elemMatP));
60158e3a54c0SPierre Jolivet         PetscCall(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN_PRE, key, Nr, remGeom, &u[offset * totDim], PetscSafePointerPlusOffset(u_t, offset * totDim), probAux, PetscSafePointerPlusOffset(a, offset * totDimAux), t, X_tShift, &elemMatP[offset * totDim * totDim]));
60163e9753d6SMatthew G. Knepley       }
60173e9753d6SMatthew G. Knepley       if (hasDyn) {
60189566063dSJacob Faibussowitsch         PetscCall(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN_DYN, key, Ne, chunkGeom, u, u_t, probAux, a, t, X_tShift, elemMatD));
60198e3a54c0SPierre Jolivet         PetscCall(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN_DYN, key, Nr, remGeom, &u[offset * totDim], PetscSafePointerPlusOffset(u_t, offset * totDim), probAux, PetscSafePointerPlusOffset(a, offset * totDimAux), t, X_tShift, &elemMatD[offset * totDim * totDim]));
60203e9753d6SMatthew G. Knepley       }
60213e9753d6SMatthew G. Knepley     }
60229566063dSJacob Faibussowitsch     PetscCall(PetscFEGeomRestoreChunk(cgeomFEM, offset, numCells, &remGeom));
60239566063dSJacob Faibussowitsch     PetscCall(PetscFEGeomRestoreChunk(cgeomFEM, 0, offset, &chunkGeom));
60249566063dSJacob Faibussowitsch     PetscCall(DMSNESRestoreFEGeom(coordField, cellIS, qGeom, PETSC_FALSE, &cgeomFEM));
60259566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureDestroy(&qGeom));
60263e9753d6SMatthew G. Knepley   }
60273e9753d6SMatthew G. Knepley   /*   Add contribution from X_t */
60289371c9d4SSatish Balay   if (hasDyn) {
60299371c9d4SSatish Balay     for (c = 0; c < numCells * totDim * totDim; ++c) elemMat[c] += X_tShift * elemMatD[c];
60309371c9d4SSatish Balay   }
60313e9753d6SMatthew G. Knepley   if (hasFV) {
60323e9753d6SMatthew G. Knepley     PetscClassId id;
60333e9753d6SMatthew G. Knepley     PetscFV      fv;
60343e9753d6SMatthew G. Knepley     PetscInt     offsetI, NcI, NbI = 1, fc, f;
60353e9753d6SMatthew G. Knepley 
60363e9753d6SMatthew G. Knepley     for (fieldI = 0; fieldI < Nf; ++fieldI) {
60379566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(prob, fieldI, (PetscObject *)&fv));
60389566063dSJacob Faibussowitsch       PetscCall(PetscDSGetFieldOffset(prob, fieldI, &offsetI));
60399566063dSJacob Faibussowitsch       PetscCall(PetscObjectGetClassId((PetscObject)fv, &id));
60403e9753d6SMatthew G. Knepley       if (id != PETSCFV_CLASSID) continue;
60412f86f8c5SMatthew G. Knepley       /* Put in the weighted identity */
60429566063dSJacob Faibussowitsch       PetscCall(PetscFVGetNumComponents(fv, &NcI));
60433e9753d6SMatthew G. Knepley       for (c = cStart; c < cEnd; ++c) {
60443e9753d6SMatthew G. Knepley         const PetscInt cind    = c - cStart;
60453e9753d6SMatthew G. Knepley         const PetscInt eOffset = cind * totDim * totDim;
60462f86f8c5SMatthew G. Knepley         PetscReal      vol;
60472f86f8c5SMatthew G. Knepley 
60482f86f8c5SMatthew G. Knepley         PetscCall(DMPlexComputeCellGeometryFVM(dm, c, &vol, NULL, NULL));
60493e9753d6SMatthew G. Knepley         for (fc = 0; fc < NcI; ++fc) {
60503e9753d6SMatthew G. Knepley           for (f = 0; f < NbI; ++f) {
60513e9753d6SMatthew G. Knepley             const PetscInt i = offsetI + f * NcI + fc;
60523e9753d6SMatthew G. Knepley             if (hasPrec) {
60532f86f8c5SMatthew G. Knepley               if (hasJac) elemMat[eOffset + i * totDim + i] = vol;
60542f86f8c5SMatthew G. Knepley               elemMatP[eOffset + i * totDim + i] = vol;
60559371c9d4SSatish Balay             } else {
60562f86f8c5SMatthew G. Knepley               elemMat[eOffset + i * totDim + i] = vol;
60579371c9d4SSatish Balay             }
60583e9753d6SMatthew G. Knepley           }
60593e9753d6SMatthew G. Knepley         }
60603e9753d6SMatthew G. Knepley       }
60613e9753d6SMatthew G. Knepley     }
60623e9753d6SMatthew G. Knepley     /* No allocated space for FV stuff, so ignore the zero entries */
60639566063dSJacob Faibussowitsch     PetscCall(MatSetOption(JacP, MAT_IGNORE_ZERO_ENTRIES, PETSC_TRUE));
60643e9753d6SMatthew G. Knepley   }
60653e9753d6SMatthew G. Knepley   /* Insert values into matrix */
60663e9753d6SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
60673e9753d6SMatthew G. Knepley     const PetscInt cell = cells ? cells[c] : c;
60683e9753d6SMatthew G. Knepley     const PetscInt cind = c - cStart;
60693e9753d6SMatthew G. Knepley 
60703e9753d6SMatthew G. Knepley     /* Transform to global basis before insertion in Jacobian */
60719566063dSJacob Faibussowitsch     if (transform) PetscCall(DMPlexBasisTransformPointTensor_Internal(dm, tdm, tv, cell, PETSC_TRUE, totDim, &elemMat[cind * totDim * totDim]));
60723e9753d6SMatthew G. Knepley     if (hasPrec) {
60733e9753d6SMatthew G. Knepley       if (hasJac) {
60749566063dSJacob Faibussowitsch         if (mesh->printFEM > 1) PetscCall(DMPrintCellMatrix(cell, name, totDim, totDim, &elemMat[cind * totDim * totDim]));
6075e8e188d2SZach Atkins         PetscCall(DMPlexMatSetClosure_Internal(dm, section, globalSection, mesh->useMatClPerm, Jac, cell, &elemMat[cind * totDim * totDim], ADD_VALUES));
60763e9753d6SMatthew G. Knepley       }
60779566063dSJacob Faibussowitsch       if (mesh->printFEM > 1) PetscCall(DMPrintCellMatrix(cell, name, totDim, totDim, &elemMatP[cind * totDim * totDim]));
6078be62b2b4SMatthew G. Knepley       PetscCall(DMPlexMatSetClosure_Internal(dm, section, globalSection, mesh->useMatClPerm, JacP, cell, &elemMatP[cind * totDim * totDim], ADD_VALUES));
60793e9753d6SMatthew G. Knepley     } else {
60803e9753d6SMatthew G. Knepley       if (hasJac) {
60819566063dSJacob Faibussowitsch         if (mesh->printFEM > 1) PetscCall(DMPrintCellMatrix(cell, name, totDim, totDim, &elemMat[cind * totDim * totDim]));
6082e8e188d2SZach Atkins         PetscCall(DMPlexMatSetClosure_Internal(dm, section, globalSection, mesh->useMatClPerm, JacP, cell, &elemMat[cind * totDim * totDim], ADD_VALUES));
60833e9753d6SMatthew G. Knepley       }
60843e9753d6SMatthew G. Knepley     }
60853e9753d6SMatthew G. Knepley   }
60869566063dSJacob Faibussowitsch   PetscCall(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
60879566063dSJacob Faibussowitsch   if (hasFV) PetscCall(MatSetOption(JacP, MAT_IGNORE_ZERO_ENTRIES, PETSC_FALSE));
60889566063dSJacob Faibussowitsch   PetscCall(PetscFree5(u, u_t, elemMat, elemMatP, elemMatD));
60893e9753d6SMatthew G. Knepley   if (dmAux) {
60909566063dSJacob Faibussowitsch     PetscCall(PetscFree(a));
60919566063dSJacob Faibussowitsch     PetscCall(DMDestroy(&plex));
60923e9753d6SMatthew G. Knepley   }
60933e9753d6SMatthew G. Knepley   /* Compute boundary integrals */
60949566063dSJacob Faibussowitsch   PetscCall(DMPlexComputeBdJacobian_Internal(dm, X, X_t, t, X_tShift, Jac, JacP, user));
60953e9753d6SMatthew G. Knepley   /* Assemble matrix */
60969371c9d4SSatish Balay end: {
6097e04ae0b4SMatthew G. Knepley   PetscBool assOp = hasJac && hasPrec ? PETSC_TRUE : PETSC_FALSE, gassOp;
6098e04ae0b4SMatthew G. Knepley 
6099462c564dSBarry Smith   PetscCallMPI(MPIU_Allreduce(&assOp, &gassOp, 1, MPIU_BOOL, MPI_LOR, PetscObjectComm((PetscObject)dm)));
61003e9753d6SMatthew G. Knepley   if (hasJac && hasPrec) {
61019566063dSJacob Faibussowitsch     PetscCall(MatAssemblyBegin(Jac, MAT_FINAL_ASSEMBLY));
61029566063dSJacob Faibussowitsch     PetscCall(MatAssemblyEnd(Jac, MAT_FINAL_ASSEMBLY));
61033e9753d6SMatthew G. Knepley   }
6104e04ae0b4SMatthew G. Knepley }
61059566063dSJacob Faibussowitsch   PetscCall(MatAssemblyBegin(JacP, MAT_FINAL_ASSEMBLY));
61069566063dSJacob Faibussowitsch   PetscCall(MatAssemblyEnd(JacP, MAT_FINAL_ASSEMBLY));
61079566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_JacobianFEM, dm, 0, 0, 0));
61083ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
61093e9753d6SMatthew G. Knepley }
61103e9753d6SMatthew G. Knepley 
6111d71ae5a4SJacob Faibussowitsch 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)
6112d71ae5a4SJacob Faibussowitsch {
61133e9753d6SMatthew G. Knepley   DM_Plex        *mesh          = (DM_Plex *)dm->data;
61143e9753d6SMatthew G. Knepley   const char     *name          = "Hybrid Jacobian";
6115148442b3SMatthew G. Knepley   DM              dmAux[3]      = {NULL, NULL, NULL};
6116148442b3SMatthew G. Knepley   DMLabel         ghostLabel    = NULL;
61173e9753d6SMatthew G. Knepley   DM              plex          = NULL;
61183e9753d6SMatthew G. Knepley   DM              plexA         = NULL;
6119148442b3SMatthew G. Knepley   PetscDS         ds            = NULL;
612007218a29SMatthew G. Knepley   PetscDS         dsIn          = NULL;
6121148442b3SMatthew G. Knepley   PetscDS         dsAux[3]      = {NULL, NULL, NULL};
6122148442b3SMatthew G. Knepley   Vec             locA[3]       = {NULL, NULL, NULL};
612307218a29SMatthew G. Knepley   DM              dmScale[3]    = {NULL, NULL, NULL};
612407218a29SMatthew G. Knepley   PetscDS         dsScale[3]    = {NULL, NULL, NULL};
612507218a29SMatthew G. Knepley   Vec             locS[3]       = {NULL, NULL, NULL};
61263e9753d6SMatthew G. Knepley   PetscSection    section       = NULL;
6127148442b3SMatthew G. Knepley   PetscSection    sectionAux[3] = {NULL, NULL, NULL};
61283e9753d6SMatthew G. Knepley   DMField         coordField    = NULL;
612907218a29SMatthew G. Knepley   PetscScalar    *a[3]          = {NULL, NULL, NULL};
613007218a29SMatthew G. Knepley   PetscScalar    *s[3]          = {NULL, NULL, NULL};
613107218a29SMatthew G. Knepley   PetscScalar    *u             = NULL, *u_t;
613207218a29SMatthew G. Knepley   PetscScalar    *elemMatNeg, *elemMatPos, *elemMatCoh;
613307218a29SMatthew G. Knepley   PetscScalar    *elemMatNegP, *elemMatPosP, *elemMatCohP;
6134e432b41dSStefano Zampini   PetscSection    globalSection;
61353e9753d6SMatthew G. Knepley   IS              chunkIS;
61363e9753d6SMatthew G. Knepley   const PetscInt *cells;
61373e9753d6SMatthew G. Knepley   PetscInt       *faces;
61383e9753d6SMatthew G. Knepley   PetscInt        cStart, cEnd, numCells;
61393e2b0218SMatthew G. Knepley   PetscInt        Nf, fieldI, fieldJ, totDim, totDimIn, totDimAux[3], totDimScale[3], numChunks, cellChunkSize, chunk;
61401690c2aeSBarry Smith   PetscInt        maxDegree  = PETSC_INT_MAX;
61413e9753d6SMatthew G. Knepley   PetscQuadrature affineQuad = NULL, *quads = NULL;
61423e9753d6SMatthew G. Knepley   PetscFEGeom    *affineGeom = NULL, **geoms = NULL;
6143e432b41dSStefano Zampini   PetscBool       hasBdJac, hasBdPrec;
61443e9753d6SMatthew G. Knepley 
61453e9753d6SMatthew G. Knepley   PetscFunctionBegin;
61463cc88e6aSStefano Zampini   PetscCall(PetscLogEventBegin(DMPLEX_JacobianFEM, dm, 0, 0, 0));
61473cc88e6aSStefano Zampini   if (!cellIS) goto end;
6148437e83fbSMatthew G. Knepley   PetscCall(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
6149437e83fbSMatthew G. Knepley   PetscCall(ISGetLocalSize(cellIS, &numCells));
61503cc88e6aSStefano Zampini   if (cStart >= cEnd) goto end;
61515fedec97SMatthew G. Knepley   if ((key[0].label == key[1].label) && (key[0].value == key[1].value) && (key[0].part == key[1].part)) {
61525fedec97SMatthew G. Knepley     const char *name;
61539566063dSJacob Faibussowitsch     PetscCall(PetscObjectGetName((PetscObject)key[0].label, &name));
615463a3b9bcSJacob Faibussowitsch     SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Form keys for each side of a cohesive surface must be different (%s, %" PetscInt_FMT ", %" PetscInt_FMT ")", name, key[0].value, key[0].part);
61555fedec97SMatthew G. Knepley   }
61569566063dSJacob Faibussowitsch   PetscCall(DMConvert(dm, DMPLEX, &plex));
61579566063dSJacob Faibussowitsch   PetscCall(DMGetSection(dm, &section));
61589566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dm, &globalSection));
61599566063dSJacob Faibussowitsch   PetscCall(DMGetLabel(dm, "ghost", &ghostLabel));
616007218a29SMatthew G. Knepley   PetscCall(DMGetCellDS(dm, cells ? cells[cStart] : cStart, &ds, &dsIn));
61619566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumFields(ds, &Nf));
61629566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(ds, &totDim));
616307218a29SMatthew G. Knepley   PetscCall(PetscDSGetTotalDimension(dsIn, &totDimIn));
61649566063dSJacob Faibussowitsch   PetscCall(PetscDSHasBdJacobian(ds, &hasBdJac));
61659566063dSJacob Faibussowitsch   PetscCall(PetscDSHasBdJacobianPreconditioner(ds, &hasBdPrec));
61669566063dSJacob Faibussowitsch   PetscCall(DMGetAuxiliaryVec(dm, key[2].label, key[2].value, key[2].part, &locA[2]));
6167148442b3SMatthew G. Knepley   if (locA[2]) {
61681059d808SMatthew G. Knepley     const PetscInt cellStart = cells ? cells[cStart] : cStart;
61691059d808SMatthew G. Knepley 
61709566063dSJacob Faibussowitsch     PetscCall(VecGetDM(locA[2], &dmAux[2]));
61719566063dSJacob Faibussowitsch     PetscCall(DMConvert(dmAux[2], DMPLEX, &plexA));
61729566063dSJacob Faibussowitsch     PetscCall(DMGetSection(dmAux[2], &sectionAux[2]));
617307218a29SMatthew G. Knepley     PetscCall(DMGetCellDS(dmAux[2], cellStart, &dsAux[2], NULL));
61749566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalDimension(dsAux[2], &totDimAux[2]));
6175148442b3SMatthew G. Knepley     {
6176148442b3SMatthew G. Knepley       const PetscInt *cone;
6177148442b3SMatthew G. Knepley       PetscInt        c;
6178148442b3SMatthew G. Knepley 
61791059d808SMatthew G. Knepley       PetscCall(DMPlexGetCone(dm, cellStart, &cone));
6180148442b3SMatthew G. Knepley       for (c = 0; c < 2; ++c) {
6181148442b3SMatthew G. Knepley         const PetscInt *support;
6182148442b3SMatthew G. Knepley         PetscInt        ssize, s;
6183148442b3SMatthew G. Knepley 
61849566063dSJacob Faibussowitsch         PetscCall(DMPlexGetSupport(dm, cone[c], &support));
61859566063dSJacob Faibussowitsch         PetscCall(DMPlexGetSupportSize(dm, cone[c], &ssize));
61861059d808SMatthew G. Knepley         PetscCheck(ssize == 2, PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Face %" PetscInt_FMT " from cell %" PetscInt_FMT " has support size %" PetscInt_FMT " != 2", cone[c], cellStart, ssize);
61871059d808SMatthew G. Knepley         if (support[0] == cellStart) s = 1;
61881059d808SMatthew G. Knepley         else if (support[1] == cellStart) s = 0;
61891059d808SMatthew G. Knepley         else SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Face %" PetscInt_FMT " does not have cell %" PetscInt_FMT " in its support", cone[c], cellStart);
61909566063dSJacob Faibussowitsch         PetscCall(DMGetAuxiliaryVec(dm, key[c].label, key[c].value, key[c].part, &locA[c]));
61919566063dSJacob Faibussowitsch         if (locA[c]) PetscCall(VecGetDM(locA[c], &dmAux[c]));
6192ad540459SPierre Jolivet         else dmAux[c] = dmAux[2];
619307218a29SMatthew G. Knepley         PetscCall(DMGetCellDS(dmAux[c], support[s], &dsAux[c], NULL));
61949566063dSJacob Faibussowitsch         PetscCall(PetscDSGetTotalDimension(dsAux[c], &totDimAux[c]));
6195148442b3SMatthew G. Knepley       }
6196148442b3SMatthew G. Knepley     }
61973e9753d6SMatthew G. Knepley   }
619807218a29SMatthew G. Knepley   /* Handle mass matrix scaling
619907218a29SMatthew G. Knepley        The field in key[2] is the field to be scaled, and the scaling field is the first in the dsScale */
620007218a29SMatthew G. Knepley   PetscCall(DMGetAuxiliaryVec(dm, key[2].label, -key[2].value, key[2].part, &locS[2]));
620107218a29SMatthew G. Knepley   if (locS[2]) {
62023e2b0218SMatthew G. Knepley     const PetscInt cellStart = cells ? cells[cStart] : cStart;
620307218a29SMatthew G. Knepley     PetscInt       Nb, Nbs;
620407218a29SMatthew G. Knepley 
620507218a29SMatthew G. Knepley     PetscCall(VecGetDM(locS[2], &dmScale[2]));
620607218a29SMatthew G. Knepley     PetscCall(DMGetCellDS(dmScale[2], cells ? cells[cStart] : cStart, &dsScale[2], NULL));
62073e2b0218SMatthew G. Knepley     PetscCall(PetscDSGetTotalDimension(dsScale[2], &totDimScale[2]));
620807218a29SMatthew G. Knepley     // BRAD: This is not set correctly
620907218a29SMatthew G. Knepley     key[2].field = 2;
621007218a29SMatthew G. Knepley     PetscCall(PetscDSGetFieldSize(ds, key[2].field, &Nb));
621107218a29SMatthew G. Knepley     PetscCall(PetscDSGetFieldSize(dsScale[2], 0, &Nbs));
621207218a29SMatthew G. Knepley     PetscCheck(Nb == Nbs, PETSC_COMM_SELF, PETSC_ERR_ARG_INCOMP, "Field %" PetscInt_FMT " of size %" PetscInt_FMT " cannot be scaled by field of size %" PetscInt_FMT, key[2].field, Nb, Nbs);
62133e2b0218SMatthew G. Knepley     {
62143e2b0218SMatthew G. Knepley       const PetscInt *cone;
62153e2b0218SMatthew G. Knepley       PetscInt        c;
62163e2b0218SMatthew G. Knepley 
62173e2b0218SMatthew G. Knepley       locS[1] = locS[0] = locS[2];
62183e2b0218SMatthew G. Knepley       dmScale[1] = dmScale[0] = dmScale[2];
62193e2b0218SMatthew G. Knepley       PetscCall(DMPlexGetCone(dm, cellStart, &cone));
62203e2b0218SMatthew G. Knepley       for (c = 0; c < 2; ++c) {
62213e2b0218SMatthew G. Knepley         const PetscInt *support;
62223e2b0218SMatthew G. Knepley         PetscInt        ssize, s;
62233e2b0218SMatthew G. Knepley 
62243e2b0218SMatthew G. Knepley         PetscCall(DMPlexGetSupport(dm, cone[c], &support));
62253e2b0218SMatthew G. Knepley         PetscCall(DMPlexGetSupportSize(dm, cone[c], &ssize));
62263e2b0218SMatthew G. Knepley         PetscCheck(ssize == 2, PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Face %" PetscInt_FMT " from cell %" PetscInt_FMT " has support size %" PetscInt_FMT " != 2", cone[c], cellStart, ssize);
62273e2b0218SMatthew G. Knepley         if (support[0] == cellStart) s = 1;
62283e2b0218SMatthew G. Knepley         else if (support[1] == cellStart) s = 0;
62293e2b0218SMatthew G. Knepley         else SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Face %" PetscInt_FMT " does not have cell %" PetscInt_FMT " in its support", cone[c], cellStart);
62303e2b0218SMatthew G. Knepley         PetscCall(DMGetCellDS(dmScale[c], support[s], &dsScale[c], NULL));
62313e2b0218SMatthew G. Knepley         PetscCall(PetscDSGetTotalDimension(dsScale[c], &totDimScale[c]));
62323e2b0218SMatthew G. Knepley       }
62333e2b0218SMatthew G. Knepley     }
623407218a29SMatthew G. Knepley   }
623507218a29SMatthew G. Knepley   /* 2: Setup geometric data */
62369566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateField(dm, &coordField));
62379566063dSJacob Faibussowitsch   PetscCall(DMFieldGetDegree(coordField, cellIS, NULL, &maxDegree));
62383e9753d6SMatthew G. Knepley   if (maxDegree > 1) {
62393e9753d6SMatthew G. Knepley     PetscInt f;
62409566063dSJacob Faibussowitsch     PetscCall(PetscCalloc2(Nf, &quads, Nf, &geoms));
62413e9753d6SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
62423e9753d6SMatthew G. Knepley       PetscFE fe;
62433e9753d6SMatthew G. Knepley 
62449566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(ds, f, (PetscObject *)&fe));
62453e9753d6SMatthew G. Knepley       if (fe) {
62469566063dSJacob Faibussowitsch         PetscCall(PetscFEGetQuadrature(fe, &quads[f]));
62479566063dSJacob Faibussowitsch         PetscCall(PetscObjectReference((PetscObject)quads[f]));
62483e9753d6SMatthew G. Knepley       }
62493e9753d6SMatthew G. Knepley     }
62503e9753d6SMatthew G. Knepley   }
625107218a29SMatthew G. Knepley   /* Loop over chunks */
62523e9753d6SMatthew G. Knepley   cellChunkSize = numCells;
62533e9753d6SMatthew G. Knepley   numChunks     = !numCells ? 0 : PetscCeilReal(((PetscReal)numCells) / cellChunkSize);
625407218a29SMatthew G. Knepley   PetscCall(PetscCalloc1(2 * cellChunkSize, &faces));
6255a4158a15SMatthew G. Knepley   PetscCall(ISCreateGeneral(PETSC_COMM_SELF, 1 * cellChunkSize, faces, PETSC_USE_POINTER, &chunkIS));
625607218a29SMatthew G. Knepley   /* Extract field coefficients */
625707218a29SMatthew G. Knepley   /* NOTE This needs the end cap faces to have identical orientations */
625807218a29SMatthew G. Knepley   PetscCall(DMPlexGetHybridCellFields(dm, cellIS, locX, locX_t, locA[2], &u, &u_t, &a[2]));
625907218a29SMatthew G. Knepley   PetscCall(DMPlexGetHybridFields(dm, dmAux, dsAux, cellIS, locA, PETSC_TRUE, a));
62608bf0a22dSMatthew G. Knepley   PetscCall(DMPlexGetHybridFields(dm, dmScale, dsScale, cellIS, locS, PETSC_TRUE, s));
626107218a29SMatthew G. Knepley   PetscCall(DMGetWorkArray(dm, hasBdJac ? cellChunkSize * totDim * totDim : 0, MPIU_SCALAR, &elemMatNeg));
626207218a29SMatthew G. Knepley   PetscCall(DMGetWorkArray(dm, hasBdJac ? cellChunkSize * totDim * totDim : 0, MPIU_SCALAR, &elemMatPos));
626307218a29SMatthew G. Knepley   PetscCall(DMGetWorkArray(dm, hasBdJac ? cellChunkSize * totDim * totDim : 0, MPIU_SCALAR, &elemMatCoh));
626407218a29SMatthew G. Knepley   PetscCall(DMGetWorkArray(dm, hasBdPrec ? cellChunkSize * totDim * totDim : 0, MPIU_SCALAR, &elemMatNegP));
626507218a29SMatthew G. Knepley   PetscCall(DMGetWorkArray(dm, hasBdPrec ? cellChunkSize * totDim * totDim : 0, MPIU_SCALAR, &elemMatPosP));
626607218a29SMatthew G. Knepley   PetscCall(DMGetWorkArray(dm, hasBdPrec ? cellChunkSize * totDim * totDim : 0, MPIU_SCALAR, &elemMatCohP));
62673e9753d6SMatthew G. Knepley   for (chunk = 0; chunk < numChunks; ++chunk) {
62683e9753d6SMatthew G. Knepley     PetscInt cS = cStart + chunk * cellChunkSize, cE = PetscMin(cS + cellChunkSize, cEnd), numCells = cE - cS, c;
62693e9753d6SMatthew G. Knepley 
627007218a29SMatthew G. Knepley     if (hasBdJac) {
627107218a29SMatthew G. Knepley       PetscCall(PetscArrayzero(elemMatNeg, cellChunkSize * totDim * totDim));
627207218a29SMatthew G. Knepley       PetscCall(PetscArrayzero(elemMatPos, cellChunkSize * totDim * totDim));
627307218a29SMatthew G. Knepley       PetscCall(PetscArrayzero(elemMatCoh, cellChunkSize * totDim * totDim));
627407218a29SMatthew G. Knepley     }
627507218a29SMatthew G. Knepley     if (hasBdPrec) {
627607218a29SMatthew G. Knepley       PetscCall(PetscArrayzero(elemMatNegP, cellChunkSize * totDim * totDim));
627707218a29SMatthew G. Knepley       PetscCall(PetscArrayzero(elemMatPosP, cellChunkSize * totDim * totDim));
627807218a29SMatthew G. Knepley       PetscCall(PetscArrayzero(elemMatCohP, cellChunkSize * totDim * totDim));
627907218a29SMatthew G. Knepley     }
62803e9753d6SMatthew G. Knepley     /* Get faces */
62813e9753d6SMatthew G. Knepley     for (c = cS; c < cE; ++c) {
62823e9753d6SMatthew G. Knepley       const PetscInt  cell = cells ? cells[c] : c;
62833e9753d6SMatthew G. Knepley       const PetscInt *cone;
62849566063dSJacob Faibussowitsch       PetscCall(DMPlexGetCone(plex, cell, &cone));
628507218a29SMatthew G. Knepley       faces[(c - cS) * 2 + 0] = cone[0];
628607218a29SMatthew G. Knepley       faces[(c - cS) * 2 + 1] = cone[1];
62873e9753d6SMatthew G. Knepley     }
628807218a29SMatthew G. Knepley     PetscCall(ISGeneralSetIndices(chunkIS, 2 * cellChunkSize, faces, PETSC_USE_POINTER));
62893e9753d6SMatthew G. Knepley     if (maxDegree <= 1) {
62909566063dSJacob Faibussowitsch       if (!affineQuad) PetscCall(DMFieldCreateDefaultQuadrature(coordField, chunkIS, &affineQuad));
62919566063dSJacob Faibussowitsch       if (affineQuad) PetscCall(DMSNESGetFEGeom(coordField, chunkIS, affineQuad, PETSC_TRUE, &affineGeom));
62923e9753d6SMatthew G. Knepley     } else {
62933e9753d6SMatthew G. Knepley       PetscInt f;
62943e9753d6SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
62959566063dSJacob Faibussowitsch         if (quads[f]) PetscCall(DMSNESGetFEGeom(coordField, chunkIS, quads[f], PETSC_TRUE, &geoms[f]));
62963e9753d6SMatthew G. Knepley       }
62973e9753d6SMatthew G. Knepley     }
62983e9753d6SMatthew G. Knepley 
62993e9753d6SMatthew G. Knepley     for (fieldI = 0; fieldI < Nf; ++fieldI) {
63003e9753d6SMatthew G. Knepley       PetscFE         feI;
63013e9753d6SMatthew G. Knepley       PetscFEGeom    *geom      = affineGeom ? affineGeom : geoms[fieldI];
63023e9753d6SMatthew G. Knepley       PetscFEGeom    *chunkGeom = NULL, *remGeom = NULL;
63033e9753d6SMatthew G. Knepley       PetscQuadrature quad = affineQuad ? affineQuad : quads[fieldI];
63043e9753d6SMatthew G. Knepley       PetscInt        numChunks, numBatches, batchSize, numBlocks, blockSize, Ne, Nr, offset, Nq, Nb;
63055fedec97SMatthew G. Knepley       PetscBool       isCohesiveField;
63063e9753d6SMatthew G. Knepley 
63079566063dSJacob Faibussowitsch       PetscCall(PetscDSGetDiscretization(ds, fieldI, (PetscObject *)&feI));
63083e9753d6SMatthew G. Knepley       if (!feI) continue;
63099566063dSJacob Faibussowitsch       PetscCall(PetscFEGetTileSizes(feI, NULL, &numBlocks, NULL, &numBatches));
63109566063dSJacob Faibussowitsch       PetscCall(PetscQuadratureGetData(quad, NULL, NULL, &Nq, NULL, NULL));
63119566063dSJacob Faibussowitsch       PetscCall(PetscFEGetDimension(feI, &Nb));
63123e9753d6SMatthew G. Knepley       blockSize = Nb;
63133e9753d6SMatthew G. Knepley       batchSize = numBlocks * blockSize;
63149566063dSJacob Faibussowitsch       PetscCall(PetscFESetTileSizes(feI, blockSize, numBlocks, batchSize, numBatches));
63153e9753d6SMatthew G. Knepley       numChunks = numCells / (numBatches * batchSize);
63163e9753d6SMatthew G. Knepley       Ne        = numChunks * numBatches * batchSize;
63173e9753d6SMatthew G. Knepley       Nr        = numCells % (numBatches * batchSize);
63183e9753d6SMatthew G. Knepley       offset    = numCells - Nr;
631907218a29SMatthew G. Knepley       PetscCall(PetscFEGeomGetChunk(geom, 0, offset * 2, &chunkGeom));
632007218a29SMatthew G. Knepley       PetscCall(PetscFEGeomGetChunk(geom, offset * 2, numCells * 2, &remGeom));
63219566063dSJacob Faibussowitsch       PetscCall(PetscDSGetCohesive(ds, fieldI, &isCohesiveField));
63223e9753d6SMatthew G. Knepley       for (fieldJ = 0; fieldJ < Nf; ++fieldJ) {
63233e9753d6SMatthew G. Knepley         PetscFE feJ;
63243e9753d6SMatthew G. Knepley 
63259566063dSJacob Faibussowitsch         PetscCall(PetscDSGetDiscretization(ds, fieldJ, (PetscObject *)&feJ));
63263e9753d6SMatthew G. Knepley         if (!feJ) continue;
6327148442b3SMatthew G. Knepley         key[0].field = fieldI * Nf + fieldJ;
6328148442b3SMatthew G. Knepley         key[1].field = fieldI * Nf + fieldJ;
63295fedec97SMatthew G. Knepley         key[2].field = fieldI * Nf + fieldJ;
6330148442b3SMatthew G. Knepley         if (hasBdJac) {
633107218a29SMatthew G. Knepley           PetscCall(PetscFEIntegrateHybridJacobian(ds, dsIn, PETSCFE_JACOBIAN, key[0], 0, Ne, chunkGeom, u, u_t, dsAux[0], a[0], t, X_tShift, elemMatNeg));
63328e3a54c0SPierre Jolivet           PetscCall(PetscFEIntegrateHybridJacobian(ds, dsIn, PETSCFE_JACOBIAN, key[0], 0, Nr, remGeom, &u[offset * totDimIn], PetscSafePointerPlusOffset(u_t, offset * totDimIn), dsAux[0], PetscSafePointerPlusOffset(a[0], offset * totDimAux[0]), t, X_tShift, &elemMatNeg[offset * totDim * totDim]));
633307218a29SMatthew G. Knepley           PetscCall(PetscFEIntegrateHybridJacobian(ds, dsIn, PETSCFE_JACOBIAN, key[1], 1, Ne, chunkGeom, u, u_t, dsAux[1], a[1], t, X_tShift, elemMatPos));
63348e3a54c0SPierre Jolivet           PetscCall(PetscFEIntegrateHybridJacobian(ds, dsIn, PETSCFE_JACOBIAN, key[1], 1, Nr, remGeom, &u[offset * totDimIn], PetscSafePointerPlusOffset(u_t, offset * totDimIn), dsAux[1], PetscSafePointerPlusOffset(a[1], offset * totDimAux[1]), t, X_tShift, &elemMatPos[offset * totDim * totDim]));
6335148442b3SMatthew G. Knepley         }
6336148442b3SMatthew G. Knepley         if (hasBdPrec) {
633707218a29SMatthew G. Knepley           PetscCall(PetscFEIntegrateHybridJacobian(ds, dsIn, PETSCFE_JACOBIAN_PRE, key[0], 0, Ne, chunkGeom, u, u_t, dsAux[0], a[0], t, X_tShift, elemMatNegP));
63388e3a54c0SPierre Jolivet           PetscCall(PetscFEIntegrateHybridJacobian(ds, dsIn, PETSCFE_JACOBIAN_PRE, key[0], 0, Nr, remGeom, &u[offset * totDimIn], PetscSafePointerPlusOffset(u_t, offset * totDimIn), dsAux[0], &a[0][offset * totDimAux[0]], t, X_tShift, &elemMatNegP[offset * totDim * totDim]));
633907218a29SMatthew G. Knepley           PetscCall(PetscFEIntegrateHybridJacobian(ds, dsIn, PETSCFE_JACOBIAN_PRE, key[1], 1, Ne, chunkGeom, u, u_t, dsAux[1], a[1], t, X_tShift, elemMatPosP));
63408e3a54c0SPierre Jolivet           PetscCall(PetscFEIntegrateHybridJacobian(ds, dsIn, PETSCFE_JACOBIAN_PRE, key[1], 1, Nr, remGeom, &u[offset * totDimIn], PetscSafePointerPlusOffset(u_t, offset * totDimIn), dsAux[1], &a[1][offset * totDimAux[1]], t, X_tShift, &elemMatPosP[offset * totDim * totDim]));
6341148442b3SMatthew G. Knepley         }
63425fedec97SMatthew G. Knepley         if (hasBdJac) {
634307218a29SMatthew G. Knepley           PetscCall(PetscFEIntegrateHybridJacobian(ds, dsIn, PETSCFE_JACOBIAN, key[2], 2, Ne, chunkGeom, u, u_t, dsAux[2], a[2], t, X_tShift, elemMatCoh));
63448e3a54c0SPierre Jolivet           PetscCall(PetscFEIntegrateHybridJacobian(ds, dsIn, PETSCFE_JACOBIAN, key[2], 2, Nr, remGeom, &u[offset * totDimIn], PetscSafePointerPlusOffset(u_t, offset * totDimIn), dsAux[2], PetscSafePointerPlusOffset(a[2], offset * totDimAux[2]), t, X_tShift, &elemMatCoh[offset * totDim * totDim]));
6345148442b3SMatthew G. Knepley         }
63465fedec97SMatthew G. Knepley         if (hasBdPrec) {
634707218a29SMatthew G. Knepley           PetscCall(PetscFEIntegrateHybridJacobian(ds, dsIn, PETSCFE_JACOBIAN_PRE, key[2], 2, Ne, chunkGeom, u, u_t, dsAux[2], a[2], t, X_tShift, elemMatCohP));
63488e3a54c0SPierre Jolivet           PetscCall(PetscFEIntegrateHybridJacobian(ds, dsIn, PETSCFE_JACOBIAN_PRE, key[2], 2, Nr, remGeom, &u[offset * totDimIn], PetscSafePointerPlusOffset(u_t, offset * totDimIn), dsAux[2], &a[2][offset * totDimAux[2]], t, X_tShift, &elemMatCohP[offset * totDim * totDim]));
63493e9753d6SMatthew G. Knepley         }
63503e9753d6SMatthew G. Knepley       }
63519566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomRestoreChunk(geom, offset, numCells, &remGeom));
63529566063dSJacob Faibussowitsch       PetscCall(PetscFEGeomRestoreChunk(geom, 0, offset, &chunkGeom));
63533e9753d6SMatthew G. Knepley     }
63543e9753d6SMatthew G. Knepley     /* Insert values into matrix */
63553e9753d6SMatthew G. Knepley     for (c = cS; c < cE; ++c) {
63563e9753d6SMatthew G. Knepley       const PetscInt cell = cells ? cells[c] : c;
635707218a29SMatthew G. Knepley       const PetscInt cind = c - cS, coff = cind * totDim * totDim;
635807218a29SMatthew G. Knepley       PetscInt       i, j;
63593e9753d6SMatthew G. Knepley 
636007218a29SMatthew G. Knepley       /* Scale element values */
636107218a29SMatthew G. Knepley       if (locS[0]) {
63623e2b0218SMatthew G. Knepley         PetscInt  Nb, soff = cind * totDimScale[0], off = 0;
636307218a29SMatthew G. Knepley         PetscBool cohesive;
636407218a29SMatthew G. Knepley 
636507218a29SMatthew G. Knepley         for (fieldI = 0; fieldI < Nf; ++fieldI) {
636607218a29SMatthew G. Knepley           PetscCall(PetscDSGetFieldSize(ds, fieldI, &Nb));
636707218a29SMatthew G. Knepley           PetscCall(PetscDSGetCohesive(ds, fieldI, &cohesive));
636807218a29SMatthew G. Knepley 
636907218a29SMatthew G. Knepley           if (fieldI == key[2].field) {
637007218a29SMatthew G. Knepley             PetscCheck(cohesive, PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Scaling should not happen for face fields");
63718bf0a22dSMatthew G. Knepley             for (i = 0; i < Nb; ++i) {
637207218a29SMatthew G. Knepley               for (j = 0; j < totDim; ++j) elemMatCoh[coff + (off + i) * totDim + j] += s[0][soff + i] * elemMatNeg[coff + (off + i) * totDim + j] + s[1][soff + i] * elemMatPos[coff + (off + i) * totDim + j];
63738bf0a22dSMatthew G. Knepley               if (hasBdPrec)
63748bf0a22dSMatthew G. Knepley                 for (j = 0; j < totDim; ++j) elemMatCohP[coff + (off + i) * totDim + j] += s[0][soff + i] * elemMatNegP[coff + (off + i) * totDim + j] + s[1][soff + i] * elemMatPosP[coff + (off + i) * totDim + j];
63758bf0a22dSMatthew G. Knepley             }
637607218a29SMatthew G. Knepley             off += Nb;
637707218a29SMatthew G. Knepley           } else {
637807218a29SMatthew G. Knepley             const PetscInt N = cohesive ? Nb : Nb * 2;
637907218a29SMatthew G. Knepley 
63808bf0a22dSMatthew G. Knepley             for (i = 0; i < N; ++i) {
638107218a29SMatthew G. Knepley               for (j = 0; j < totDim; ++j) elemMatCoh[coff + (off + i) * totDim + j] += elemMatNeg[coff + (off + i) * totDim + j] + elemMatPos[coff + (off + i) * totDim + j];
63828bf0a22dSMatthew G. Knepley               if (hasBdPrec)
63838bf0a22dSMatthew G. Knepley                 for (j = 0; j < totDim; ++j) elemMatCohP[coff + (off + i) * totDim + j] += elemMatNegP[coff + (off + i) * totDim + j] + elemMatPosP[coff + (off + i) * totDim + j];
63848bf0a22dSMatthew G. Knepley             }
638507218a29SMatthew G. Knepley             off += N;
638607218a29SMatthew G. Knepley           }
638707218a29SMatthew G. Knepley         }
638807218a29SMatthew G. Knepley       } else {
638907218a29SMatthew G. Knepley         for (i = 0; i < totDim * totDim; ++i) elemMatCoh[coff + i] += elemMatNeg[coff + i] + elemMatPos[coff + i];
63908bf0a22dSMatthew G. Knepley         if (hasBdPrec)
63918bf0a22dSMatthew G. Knepley           for (i = 0; i < totDim * totDim; ++i) elemMatCohP[coff + i] += elemMatNegP[coff + i] + elemMatPosP[coff + i];
639207218a29SMatthew G. Knepley       }
63933e9753d6SMatthew G. Knepley       if (hasBdPrec) {
63943e9753d6SMatthew G. Knepley         if (hasBdJac) {
639507218a29SMatthew G. Knepley           if (mesh->printFEM > 1) PetscCall(DMPrintCellMatrix(cell, name, totDim, totDim, &elemMatCoh[cind * totDim * totDim]));
6396e8e188d2SZach Atkins           PetscCall(DMPlexMatSetClosure_Internal(plex, section, globalSection, mesh->useMatClPerm, Jac, cell, &elemMatCoh[cind * totDim * totDim], ADD_VALUES));
63973e9753d6SMatthew G. Knepley         }
639807218a29SMatthew G. Knepley         if (mesh->printFEM > 1) PetscCall(DMPrintCellMatrix(cell, name, totDim, totDim, &elemMatCohP[cind * totDim * totDim]));
639907218a29SMatthew G. Knepley         PetscCall(DMPlexMatSetClosure(plex, section, globalSection, JacP, cell, &elemMatCohP[cind * totDim * totDim], ADD_VALUES));
64003e9753d6SMatthew G. Knepley       } else if (hasBdJac) {
640107218a29SMatthew G. Knepley         if (mesh->printFEM > 1) PetscCall(DMPrintCellMatrix(cell, name, totDim, totDim, &elemMatCoh[cind * totDim * totDim]));
6402e8e188d2SZach Atkins         PetscCall(DMPlexMatSetClosure_Internal(plex, section, globalSection, mesh->useMatClPerm, JacP, cell, &elemMatCoh[cind * totDim * totDim], ADD_VALUES));
64033e9753d6SMatthew G. Knepley       }
64043e9753d6SMatthew G. Knepley     }
64053e9753d6SMatthew G. Knepley   }
64069566063dSJacob Faibussowitsch   PetscCall(DMPlexRestoreCellFields(dm, cellIS, locX, locX_t, locA[2], &u, &u_t, &a[2]));
640707218a29SMatthew G. Knepley   PetscCall(DMPlexRestoreHybridFields(dm, dmAux, dsAux, cellIS, locA, PETSC_TRUE, a));
640807218a29SMatthew G. Knepley   PetscCall(DMRestoreWorkArray(dm, hasBdJac ? cellChunkSize * totDim * totDim : 0, MPIU_SCALAR, &elemMatNeg));
640907218a29SMatthew G. Knepley   PetscCall(DMRestoreWorkArray(dm, hasBdJac ? cellChunkSize * totDim * totDim : 0, MPIU_SCALAR, &elemMatPos));
641007218a29SMatthew G. Knepley   PetscCall(DMRestoreWorkArray(dm, hasBdJac ? cellChunkSize * totDim * totDim : 0, MPIU_SCALAR, &elemMatCoh));
641107218a29SMatthew G. Knepley   PetscCall(DMRestoreWorkArray(dm, hasBdPrec ? cellChunkSize * totDim * totDim : 0, MPIU_SCALAR, &elemMatNegP));
641207218a29SMatthew G. Knepley   PetscCall(DMRestoreWorkArray(dm, hasBdPrec ? cellChunkSize * totDim * totDim : 0, MPIU_SCALAR, &elemMatPosP));
641307218a29SMatthew G. Knepley   PetscCall(DMRestoreWorkArray(dm, hasBdPrec ? cellChunkSize * totDim * totDim : 0, MPIU_SCALAR, &elemMatCohP));
64149566063dSJacob Faibussowitsch   PetscCall(PetscFree(faces));
64159566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&chunkIS));
64169566063dSJacob Faibussowitsch   PetscCall(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
64173e9753d6SMatthew G. Knepley   if (maxDegree <= 1) {
64189566063dSJacob Faibussowitsch     PetscCall(DMSNESRestoreFEGeom(coordField, cellIS, affineQuad, PETSC_FALSE, &affineGeom));
64199566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureDestroy(&affineQuad));
64203e9753d6SMatthew G. Knepley   } else {
64213e9753d6SMatthew G. Knepley     PetscInt f;
64223e9753d6SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
64239566063dSJacob Faibussowitsch       if (geoms) PetscCall(DMSNESRestoreFEGeom(coordField, cellIS, quads[f], PETSC_FALSE, &geoms[f]));
64249566063dSJacob Faibussowitsch       if (quads) PetscCall(PetscQuadratureDestroy(&quads[f]));
64253e9753d6SMatthew G. Knepley     }
64269566063dSJacob Faibussowitsch     PetscCall(PetscFree2(quads, geoms));
64273e9753d6SMatthew G. Knepley   }
64289566063dSJacob Faibussowitsch   if (dmAux[2]) PetscCall(DMDestroy(&plexA));
64299566063dSJacob Faibussowitsch   PetscCall(DMDestroy(&plex));
64303cc88e6aSStefano Zampini end:
64319566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_JacobianFEM, dm, 0, 0, 0));
64323ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
64333e9753d6SMatthew G. Knepley }
64348e3a2eefSMatthew G. Knepley 
64358e3a2eefSMatthew G. Knepley /*
64368e3a2eefSMatthew 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.
64378e3a2eefSMatthew G. Knepley 
64388e3a2eefSMatthew G. Knepley   Input Parameters:
64398e3a2eefSMatthew G. Knepley + dm     - The mesh
6440baca6076SPierre Jolivet . key    - The PetscWeakFormKey indicating where integration should happen
644106ad1575SMatthew G. Knepley . cellIS - The cells to integrate over
64428e3a2eefSMatthew G. Knepley . t      - The time
6443145b44c9SPierre Jolivet . X_tShift - The multiplier for the Jacobian with respect to X_t
64448e3a2eefSMatthew G. Knepley . X      - Local solution vector
64458e3a2eefSMatthew G. Knepley . X_t    - Time-derivative of the local solution vector
64468e3a2eefSMatthew G. Knepley . Y      - Local input vector
644706ad1575SMatthew G. Knepley - user   - the user context
64488e3a2eefSMatthew G. Knepley 
64498e3a2eefSMatthew G. Knepley   Output Parameter:
64508e3a2eefSMatthew G. Knepley . Z - Local output vector
64518e3a2eefSMatthew G. Knepley 
64528e3a2eefSMatthew G. Knepley   Note:
64538e3a2eefSMatthew G. Knepley   We form the residual one batch of elements at a time. This allows us to offload work onto an accelerator,
64548e3a2eefSMatthew G. Knepley   like a GPU, or vectorize on a multicore machine.
64558e3a2eefSMatthew G. Knepley */
6456d71ae5a4SJacob Faibussowitsch 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)
6457d71ae5a4SJacob Faibussowitsch {
64588e3a2eefSMatthew G. Knepley   DM_Plex        *mesh  = (DM_Plex *)dm->data;
64598e3a2eefSMatthew G. Knepley   const char     *name  = "Jacobian";
64608e3a2eefSMatthew G. Knepley   DM              dmAux = NULL, plex, plexAux = NULL;
64618e3a2eefSMatthew G. Knepley   DMEnclosureType encAux;
64628e3a2eefSMatthew G. Knepley   Vec             A;
64638e3a2eefSMatthew G. Knepley   DMField         coordField;
64648e3a2eefSMatthew G. Knepley   PetscDS         prob, probAux = NULL;
64658e3a2eefSMatthew G. Knepley   PetscQuadrature quad;
64668e3a2eefSMatthew G. Knepley   PetscSection    section, globalSection, sectionAux;
64678e3a2eefSMatthew G. Knepley   PetscScalar    *elemMat, *elemMatD, *u, *u_t, *a = NULL, *y, *z;
64688e3a2eefSMatthew G. Knepley   const PetscInt *cells;
64698e3a2eefSMatthew G. Knepley   PetscInt        Nf, fieldI, fieldJ;
64708e3a2eefSMatthew G. Knepley   PetscInt        totDim, totDimAux = 0, cStart, cEnd, numCells, c;
64718e3a2eefSMatthew G. Knepley   PetscBool       hasDyn;
64728e3a2eefSMatthew G. Knepley 
64738e3a2eefSMatthew G. Knepley   PetscFunctionBegin;
64749566063dSJacob Faibussowitsch   PetscCall(PetscLogEventBegin(DMPLEX_JacobianFEM, dm, 0, 0, 0));
64759566063dSJacob Faibussowitsch   PetscCall(DMConvert(dm, DMPLEX, &plex));
64769566063dSJacob Faibussowitsch   PetscCall(ISGetLocalSize(cellIS, &numCells));
64779566063dSJacob Faibussowitsch   PetscCall(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
64789566063dSJacob Faibussowitsch   PetscCall(DMGetLocalSection(dm, &section));
64799566063dSJacob Faibussowitsch   PetscCall(DMGetGlobalSection(dm, &globalSection));
648007218a29SMatthew G. Knepley   PetscCall(DMGetCellDS(dm, cells ? cells[cStart] : cStart, &prob, NULL));
64819566063dSJacob Faibussowitsch   PetscCall(PetscDSGetNumFields(prob, &Nf));
64829566063dSJacob Faibussowitsch   PetscCall(PetscDSGetTotalDimension(prob, &totDim));
64839566063dSJacob Faibussowitsch   PetscCall(PetscDSHasDynamicJacobian(prob, &hasDyn));
64848e3a2eefSMatthew G. Knepley   hasDyn = hasDyn && (X_tShift != 0.0) ? PETSC_TRUE : PETSC_FALSE;
64859566063dSJacob Faibussowitsch   PetscCall(DMGetAuxiliaryVec(dm, key.label, key.value, key.part, &A));
64868e3a2eefSMatthew G. Knepley   if (A) {
64879566063dSJacob Faibussowitsch     PetscCall(VecGetDM(A, &dmAux));
64889566063dSJacob Faibussowitsch     PetscCall(DMGetEnclosureRelation(dmAux, dm, &encAux));
64899566063dSJacob Faibussowitsch     PetscCall(DMConvert(dmAux, DMPLEX, &plexAux));
64909566063dSJacob Faibussowitsch     PetscCall(DMGetLocalSection(plexAux, &sectionAux));
64919566063dSJacob Faibussowitsch     PetscCall(DMGetDS(dmAux, &probAux));
64929566063dSJacob Faibussowitsch     PetscCall(PetscDSGetTotalDimension(probAux, &totDimAux));
64938e3a2eefSMatthew G. Knepley   }
64949566063dSJacob Faibussowitsch   PetscCall(VecSet(Z, 0.0));
64959566063dSJacob 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));
64969566063dSJacob Faibussowitsch   if (dmAux) PetscCall(PetscMalloc1(numCells * totDimAux, &a));
64979566063dSJacob Faibussowitsch   PetscCall(DMGetCoordinateField(dm, &coordField));
64988e3a2eefSMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
64998e3a2eefSMatthew G. Knepley     const PetscInt cell = cells ? cells[c] : c;
65008e3a2eefSMatthew G. Knepley     const PetscInt cind = c - cStart;
65018e3a2eefSMatthew G. Knepley     PetscScalar   *x = NULL, *x_t = NULL;
65028e3a2eefSMatthew G. Knepley     PetscInt       i;
65038e3a2eefSMatthew G. Knepley 
65049566063dSJacob Faibussowitsch     PetscCall(DMPlexVecGetClosure(plex, section, X, cell, NULL, &x));
65058e3a2eefSMatthew G. Knepley     for (i = 0; i < totDim; ++i) u[cind * totDim + i] = x[i];
65069566063dSJacob Faibussowitsch     PetscCall(DMPlexVecRestoreClosure(plex, section, X, cell, NULL, &x));
65078e3a2eefSMatthew G. Knepley     if (X_t) {
65089566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(plex, section, X_t, cell, NULL, &x_t));
65098e3a2eefSMatthew G. Knepley       for (i = 0; i < totDim; ++i) u_t[cind * totDim + i] = x_t[i];
65109566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(plex, section, X_t, cell, NULL, &x_t));
65118e3a2eefSMatthew G. Knepley     }
65128e3a2eefSMatthew G. Knepley     if (dmAux) {
65138e3a2eefSMatthew G. Knepley       PetscInt subcell;
65149566063dSJacob Faibussowitsch       PetscCall(DMGetEnclosurePoint(dmAux, dm, encAux, cell, &subcell));
65159566063dSJacob Faibussowitsch       PetscCall(DMPlexVecGetClosure(plexAux, sectionAux, A, subcell, NULL, &x));
65168e3a2eefSMatthew G. Knepley       for (i = 0; i < totDimAux; ++i) a[cind * totDimAux + i] = x[i];
65179566063dSJacob Faibussowitsch       PetscCall(DMPlexVecRestoreClosure(plexAux, sectionAux, A, subcell, NULL, &x));
65188e3a2eefSMatthew G. Knepley     }
65199566063dSJacob Faibussowitsch     PetscCall(DMPlexVecGetClosure(plex, section, Y, cell, NULL, &x));
65208e3a2eefSMatthew G. Knepley     for (i = 0; i < totDim; ++i) y[cind * totDim + i] = x[i];
65219566063dSJacob Faibussowitsch     PetscCall(DMPlexVecRestoreClosure(plex, section, Y, cell, NULL, &x));
65228e3a2eefSMatthew G. Knepley   }
65239566063dSJacob Faibussowitsch   PetscCall(PetscArrayzero(elemMat, numCells * totDim * totDim));
65249566063dSJacob Faibussowitsch   if (hasDyn) PetscCall(PetscArrayzero(elemMatD, numCells * totDim * totDim));
65258e3a2eefSMatthew G. Knepley   for (fieldI = 0; fieldI < Nf; ++fieldI) {
65268e3a2eefSMatthew G. Knepley     PetscFE  fe;
65278e3a2eefSMatthew G. Knepley     PetscInt Nb;
65288e3a2eefSMatthew G. Knepley     /* Conforming batches */
65298e3a2eefSMatthew G. Knepley     PetscInt numChunks, numBatches, numBlocks, Ne, blockSize, batchSize;
65308e3a2eefSMatthew G. Knepley     /* Remainder */
65318e3a2eefSMatthew G. Knepley     PetscInt        Nr, offset, Nq;
65328e3a2eefSMatthew G. Knepley     PetscQuadrature qGeom = NULL;
65338e3a2eefSMatthew G. Knepley     PetscInt        maxDegree;
65348e3a2eefSMatthew G. Knepley     PetscFEGeom    *cgeomFEM, *chunkGeom = NULL, *remGeom = NULL;
65358e3a2eefSMatthew G. Knepley 
65369566063dSJacob Faibussowitsch     PetscCall(PetscDSGetDiscretization(prob, fieldI, (PetscObject *)&fe));
65379566063dSJacob Faibussowitsch     PetscCall(PetscFEGetQuadrature(fe, &quad));
65389566063dSJacob Faibussowitsch     PetscCall(PetscFEGetDimension(fe, &Nb));
65399566063dSJacob Faibussowitsch     PetscCall(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
65409566063dSJacob Faibussowitsch     PetscCall(DMFieldGetDegree(coordField, cellIS, NULL, &maxDegree));
65419566063dSJacob Faibussowitsch     if (maxDegree <= 1) PetscCall(DMFieldCreateDefaultQuadrature(coordField, cellIS, &qGeom));
65428e3a2eefSMatthew G. Knepley     if (!qGeom) {
65439566063dSJacob Faibussowitsch       PetscCall(PetscFEGetQuadrature(fe, &qGeom));
65449566063dSJacob Faibussowitsch       PetscCall(PetscObjectReference((PetscObject)qGeom));
65458e3a2eefSMatthew G. Knepley     }
65469566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureGetData(qGeom, NULL, NULL, &Nq, NULL, NULL));
65479566063dSJacob Faibussowitsch     PetscCall(DMSNESGetFEGeom(coordField, cellIS, qGeom, PETSC_FALSE, &cgeomFEM));
65488e3a2eefSMatthew G. Knepley     blockSize = Nb;
65498e3a2eefSMatthew G. Knepley     batchSize = numBlocks * blockSize;
65509566063dSJacob Faibussowitsch     PetscCall(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
65518e3a2eefSMatthew G. Knepley     numChunks = numCells / (numBatches * batchSize);
65528e3a2eefSMatthew G. Knepley     Ne        = numChunks * numBatches * batchSize;
65538e3a2eefSMatthew G. Knepley     Nr        = numCells % (numBatches * batchSize);
65548e3a2eefSMatthew G. Knepley     offset    = numCells - Nr;
65559566063dSJacob Faibussowitsch     PetscCall(PetscFEGeomGetChunk(cgeomFEM, 0, offset, &chunkGeom));
65569566063dSJacob Faibussowitsch     PetscCall(PetscFEGeomGetChunk(cgeomFEM, offset, numCells, &remGeom));
65578e3a2eefSMatthew G. Knepley     for (fieldJ = 0; fieldJ < Nf; ++fieldJ) {
65588e3a2eefSMatthew G. Knepley       key.field = fieldI * Nf + fieldJ;
65599566063dSJacob Faibussowitsch       PetscCall(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN, key, Ne, chunkGeom, u, u_t, probAux, a, t, X_tShift, elemMat));
65608e3a54c0SPierre Jolivet       PetscCall(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN, key, Nr, remGeom, &u[offset * totDim], PetscSafePointerPlusOffset(u_t, offset * totDim), probAux, PetscSafePointerPlusOffset(a, offset * totDimAux), t, X_tShift, &elemMat[offset * totDim * totDim]));
65618e3a2eefSMatthew G. Knepley       if (hasDyn) {
65629566063dSJacob Faibussowitsch         PetscCall(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN_DYN, key, Ne, chunkGeom, u, u_t, probAux, a, t, X_tShift, elemMatD));
65638e3a54c0SPierre Jolivet         PetscCall(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN_DYN, key, Nr, remGeom, &u[offset * totDim], PetscSafePointerPlusOffset(u_t, offset * totDim), probAux, &a[offset * totDimAux], t, X_tShift, &elemMatD[offset * totDim * totDim]));
65648e3a2eefSMatthew G. Knepley       }
65658e3a2eefSMatthew G. Knepley     }
65669566063dSJacob Faibussowitsch     PetscCall(PetscFEGeomRestoreChunk(cgeomFEM, offset, numCells, &remGeom));
65679566063dSJacob Faibussowitsch     PetscCall(PetscFEGeomRestoreChunk(cgeomFEM, 0, offset, &chunkGeom));
65689566063dSJacob Faibussowitsch     PetscCall(DMSNESRestoreFEGeom(coordField, cellIS, qGeom, PETSC_FALSE, &cgeomFEM));
65699566063dSJacob Faibussowitsch     PetscCall(PetscQuadratureDestroy(&qGeom));
65708e3a2eefSMatthew G. Knepley   }
65718e3a2eefSMatthew G. Knepley   if (hasDyn) {
65728e3a2eefSMatthew G. Knepley     for (c = 0; c < numCells * totDim * totDim; ++c) elemMat[c] += X_tShift * elemMatD[c];
65738e3a2eefSMatthew G. Knepley   }
65748e3a2eefSMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
65758e3a2eefSMatthew G. Knepley     const PetscInt     cell = cells ? cells[c] : c;
65768e3a2eefSMatthew G. Knepley     const PetscInt     cind = c - cStart;
65776497c311SBarry Smith     const PetscBLASInt one  = 1;
65786497c311SBarry Smith     PetscBLASInt       M;
65798e3a2eefSMatthew G. Knepley     const PetscScalar  a = 1.0, b = 0.0;
65808e3a2eefSMatthew G. Knepley 
65816497c311SBarry Smith     PetscCall(PetscBLASIntCast(totDim, &M));
6582792fecdfSBarry Smith     PetscCallBLAS("BLASgemv", BLASgemv_("N", &M, &M, &a, &elemMat[cind * totDim * totDim], &M, &y[cind * totDim], &one, &b, z, &one));
65838e3a2eefSMatthew G. Knepley     if (mesh->printFEM > 1) {
65849566063dSJacob Faibussowitsch       PetscCall(DMPrintCellMatrix(c, name, totDim, totDim, &elemMat[cind * totDim * totDim]));
65859566063dSJacob Faibussowitsch       PetscCall(DMPrintCellVector(c, "Y", totDim, &y[cind * totDim]));
65869566063dSJacob Faibussowitsch       PetscCall(DMPrintCellVector(c, "Z", totDim, z));
65878e3a2eefSMatthew G. Knepley     }
65889566063dSJacob Faibussowitsch     PetscCall(DMPlexVecSetClosure(dm, section, Z, cell, z, ADD_VALUES));
65898e3a2eefSMatthew G. Knepley   }
65909566063dSJacob Faibussowitsch   PetscCall(PetscFree6(u, u_t, elemMat, elemMatD, y, z));
65918e3a2eefSMatthew G. Knepley   if (mesh->printFEM) {
65929566063dSJacob Faibussowitsch     PetscCall(PetscPrintf(PetscObjectComm((PetscObject)Z), "Z:\n"));
65939566063dSJacob Faibussowitsch     PetscCall(VecView(Z, NULL));
65948e3a2eefSMatthew G. Knepley   }
65951059d808SMatthew G. Knepley   PetscCall(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
65969566063dSJacob Faibussowitsch   PetscCall(PetscFree(a));
65979566063dSJacob Faibussowitsch   PetscCall(DMDestroy(&plexAux));
65989566063dSJacob Faibussowitsch   PetscCall(DMDestroy(&plex));
65999566063dSJacob Faibussowitsch   PetscCall(PetscLogEventEnd(DMPLEX_JacobianFEM, dm, 0, 0, 0));
66003ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
66018e3a2eefSMatthew G. Knepley }
6602