xref: /petsc/src/dm/impls/plex/plexfem.c (revision dadcf80911fb48939c55327431ae8d7e47dbe367)
1af0996ceSBarry Smith #include <petsc/private/dmpleximpl.h>   /*I      "petscdmplex.h"   I*/
2da97024aSMatthew G. Knepley #include <petscsf.h>
3cb1e1211SMatthew G Knepley 
48e3a2eefSMatthew G. Knepley #include <petscblaslapack.h>
5e8f14785SLisandro Dalcin #include <petsc/private/hashsetij.h>
6af0996ceSBarry Smith #include <petsc/private/petscfeimpl.h>
7af0996ceSBarry Smith #include <petsc/private/petscfvimpl.h>
8a0845e3aSMatthew G. Knepley 
95f0b18bfSMatthew G. Knepley PetscBool Clementcite = PETSC_FALSE;
105f0b18bfSMatthew G. Knepley const char ClementCitation[] = "@article{clement1975approximation,\n"
115f0b18bfSMatthew G. Knepley                                "  title   = {Approximation by finite element functions using local regularization},\n"
125f0b18bfSMatthew G. Knepley                                "  author  = {Philippe Cl{\\'e}ment},\n"
135f0b18bfSMatthew G. Knepley                                "  journal = {Revue fran{\\c{c}}aise d'automatique, informatique, recherche op{\\'e}rationnelle. Analyse num{\\'e}rique},\n"
145f0b18bfSMatthew G. Knepley                                "  volume  = {9},\n"
155f0b18bfSMatthew G. Knepley                                "  number  = {R2},\n"
165f0b18bfSMatthew G. Knepley                                "  pages   = {77--84},\n"
175f0b18bfSMatthew G. Knepley                                "  year    = {1975}\n}\n";
185f0b18bfSMatthew G. Knepley 
192f856554SMatthew G. Knepley static PetscErrorCode DMPlexConvertPlex(DM dm, DM *plex, PetscBool copy)
202f856554SMatthew G. Knepley {
212f856554SMatthew G. Knepley   PetscBool      isPlex;
222f856554SMatthew G. Knepley 
232f856554SMatthew G. Knepley   PetscFunctionBegin;
245f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscObjectTypeCompare((PetscObject) dm, DMPLEX, &isPlex));
252f856554SMatthew G. Knepley   if (isPlex) {
262f856554SMatthew G. Knepley     *plex = dm;
275f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectReference((PetscObject) dm));
282f856554SMatthew G. Knepley   } else {
295f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectQuery((PetscObject) dm, "dm_plex", (PetscObject *) plex));
302f856554SMatthew G. Knepley     if (!*plex) {
315f80ce2aSJacob Faibussowitsch       CHKERRQ(DMConvert(dm, DMPLEX, plex));
325f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscObjectCompose((PetscObject) dm, "dm_plex", (PetscObject) *plex));
332f856554SMatthew G. Knepley       if (copy) {
342f856554SMatthew G. Knepley         DMSubDomainHookLink link;
359a2a23afSMatthew G. Knepley 
365f80ce2aSJacob Faibussowitsch         CHKERRQ(DMCopyAuxiliaryVec(dm, *plex));
379a2a23afSMatthew G. Knepley         /* Run the subdomain hook (this will copy the DMSNES/DMTS) */
382f856554SMatthew G. Knepley         for (link = dm->subdomainhook; link; link = link->next) {
395f80ce2aSJacob Faibussowitsch           if (link->ddhook) CHKERRQ((*link->ddhook)(dm, *plex, link->ctx));
402f856554SMatthew G. Knepley         }
412f856554SMatthew G. Knepley       }
422f856554SMatthew G. Knepley     } else {
435f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscObjectReference((PetscObject) *plex));
442f856554SMatthew G. Knepley     }
452f856554SMatthew G. Knepley   }
462f856554SMatthew G. Knepley   PetscFunctionReturn(0);
472f856554SMatthew G. Knepley }
482f856554SMatthew G. Knepley 
499b6f715bSMatthew G. Knepley static PetscErrorCode PetscContainerUserDestroy_PetscFEGeom (void *ctx)
509b6f715bSMatthew G. Knepley {
519b6f715bSMatthew G. Knepley   PetscFEGeom *geom = (PetscFEGeom *) ctx;
529b6f715bSMatthew G. Knepley 
539b6f715bSMatthew G. Knepley   PetscFunctionBegin;
545f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFEGeomDestroy(&geom));
559b6f715bSMatthew G. Knepley   PetscFunctionReturn(0);
569b6f715bSMatthew G. Knepley }
579b6f715bSMatthew G. Knepley 
589b6f715bSMatthew G. Knepley static PetscErrorCode DMPlexGetFEGeom(DMField coordField, IS pointIS, PetscQuadrature quad, PetscBool faceData, PetscFEGeom **geom)
599b6f715bSMatthew G. Knepley {
609b6f715bSMatthew G. Knepley   char            composeStr[33] = {0};
619b6f715bSMatthew G. Knepley   PetscObjectId   id;
629b6f715bSMatthew G. Knepley   PetscContainer  container;
639b6f715bSMatthew G. Knepley 
649b6f715bSMatthew G. Knepley   PetscFunctionBegin;
655f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscObjectGetId((PetscObject)quad,&id));
665f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSNPrintf(composeStr, 32, "DMPlexGetFEGeom_%x\n", id));
675f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscObjectQuery((PetscObject) pointIS, composeStr, (PetscObject *) &container));
689b6f715bSMatthew G. Knepley   if (container) {
695f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscContainerGetPointer(container, (void **) geom));
709b6f715bSMatthew G. Knepley   } else {
715f80ce2aSJacob Faibussowitsch     CHKERRQ(DMFieldCreateFEGeom(coordField, pointIS, quad, faceData, geom));
725f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscContainerCreate(PETSC_COMM_SELF,&container));
735f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscContainerSetPointer(container, (void *) *geom));
745f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscContainerSetUserDestroy(container, PetscContainerUserDestroy_PetscFEGeom));
755f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectCompose((PetscObject) pointIS, composeStr, (PetscObject) container));
765f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscContainerDestroy(&container));
779b6f715bSMatthew G. Knepley   }
789b6f715bSMatthew G. Knepley   PetscFunctionReturn(0);
799b6f715bSMatthew G. Knepley }
809b6f715bSMatthew G. Knepley 
819b6f715bSMatthew G. Knepley static PetscErrorCode DMPlexRestoreFEGeom(DMField coordField, IS pointIS, PetscQuadrature quad, PetscBool faceData, PetscFEGeom **geom)
829b6f715bSMatthew G. Knepley {
839b6f715bSMatthew G. Knepley   PetscFunctionBegin;
849b6f715bSMatthew G. Knepley   *geom = NULL;
859b6f715bSMatthew G. Knepley   PetscFunctionReturn(0);
869b6f715bSMatthew G. Knepley }
879b6f715bSMatthew G. Knepley 
8846fa42a0SMatthew G. Knepley /*@
8946fa42a0SMatthew G. Knepley   DMPlexGetScale - Get the scale for the specified fundamental unit
9046fa42a0SMatthew G. Knepley 
9146fa42a0SMatthew G. Knepley   Not collective
9246fa42a0SMatthew G. Knepley 
934165533cSJose E. Roman   Input Parameters:
9446fa42a0SMatthew G. Knepley + dm   - the DM
9546fa42a0SMatthew G. Knepley - unit - The SI unit
9646fa42a0SMatthew G. Knepley 
974165533cSJose E. Roman   Output Parameter:
9846fa42a0SMatthew G. Knepley . scale - The value used to scale all quantities with this unit
9946fa42a0SMatthew G. Knepley 
10046fa42a0SMatthew G. Knepley   Level: advanced
10146fa42a0SMatthew G. Knepley 
10246fa42a0SMatthew G. Knepley .seealso: DMPlexSetScale(), PetscUnit
10346fa42a0SMatthew G. Knepley @*/
104cb1e1211SMatthew G Knepley PetscErrorCode DMPlexGetScale(DM dm, PetscUnit unit, PetscReal *scale)
105cb1e1211SMatthew G Knepley {
106cb1e1211SMatthew G Knepley   DM_Plex *mesh = (DM_Plex*) dm->data;
107cb1e1211SMatthew G Knepley 
108cb1e1211SMatthew G Knepley   PetscFunctionBegin;
109cb1e1211SMatthew G Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
110*dadcf809SJacob Faibussowitsch   PetscValidRealPointer(scale, 3);
111cb1e1211SMatthew G Knepley   *scale = mesh->scale[unit];
112cb1e1211SMatthew G Knepley   PetscFunctionReturn(0);
113cb1e1211SMatthew G Knepley }
114cb1e1211SMatthew G Knepley 
11546fa42a0SMatthew G. Knepley /*@
11646fa42a0SMatthew G. Knepley   DMPlexSetScale - Set the scale for the specified fundamental unit
11746fa42a0SMatthew G. Knepley 
11846fa42a0SMatthew G. Knepley   Not collective
11946fa42a0SMatthew G. Knepley 
1204165533cSJose E. Roman   Input Parameters:
12146fa42a0SMatthew G. Knepley + dm   - the DM
12246fa42a0SMatthew G. Knepley . unit - The SI unit
12346fa42a0SMatthew G. Knepley - scale - The value used to scale all quantities with this unit
12446fa42a0SMatthew G. Knepley 
12546fa42a0SMatthew G. Knepley   Level: advanced
12646fa42a0SMatthew G. Knepley 
12746fa42a0SMatthew G. Knepley .seealso: DMPlexGetScale(), PetscUnit
12846fa42a0SMatthew G. Knepley @*/
129cb1e1211SMatthew G Knepley PetscErrorCode DMPlexSetScale(DM dm, PetscUnit unit, PetscReal scale)
130cb1e1211SMatthew G Knepley {
131cb1e1211SMatthew G Knepley   DM_Plex *mesh = (DM_Plex*) dm->data;
132cb1e1211SMatthew G Knepley 
133cb1e1211SMatthew G Knepley   PetscFunctionBegin;
134cb1e1211SMatthew G Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
135cb1e1211SMatthew G Knepley   mesh->scale[unit] = scale;
136cb1e1211SMatthew G Knepley   PetscFunctionReturn(0);
137cb1e1211SMatthew G Knepley }
138cb1e1211SMatthew G Knepley 
139327779f2SMatthew Knepley static PetscErrorCode DMPlexProjectRigidBody_Private(PetscInt dim, PetscReal t, const PetscReal X[], PetscInt Nc, PetscScalar *mode, void *ctx)
140026175e5SToby Isaac {
14112adca46SMatthew G. Knepley   const PetscInt eps[3][3][3] = {{{0, 0, 0}, {0, 0, 1}, {0, -1, 0}}, {{0, 0, -1}, {0, 0, 0}, {1, 0, 0}}, {{0, 1, 0}, {-1, 0, 0}, {0, 0, 0}}};
142026175e5SToby Isaac   PetscInt *ctxInt  = (PetscInt *) ctx;
143ad917190SMatthew G. Knepley   PetscInt  dim2    = ctxInt[0];
144026175e5SToby Isaac   PetscInt  d       = ctxInt[1];
145026175e5SToby Isaac   PetscInt  i, j, k = dim > 2 ? d - dim : d;
146026175e5SToby Isaac 
147ad917190SMatthew G. Knepley   PetscFunctionBegin;
1485f80ce2aSJacob Faibussowitsch   PetscCheck(dim == dim2,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Input dimension %D does not match context dimension %D", dim, dim2);
149026175e5SToby Isaac   for (i = 0; i < dim; i++) mode[i] = 0.;
150026175e5SToby Isaac   if (d < dim) {
15112adca46SMatthew G. Knepley     mode[d] = 1.; /* Translation along axis d */
152ad917190SMatthew G. Knepley   } else {
153026175e5SToby Isaac     for (i = 0; i < dim; i++) {
154026175e5SToby Isaac       for (j = 0; j < dim; j++) {
15512adca46SMatthew G. Knepley         mode[j] += eps[i][j][k]*X[i]; /* Rotation about axis d */
156026175e5SToby Isaac       }
157026175e5SToby Isaac     }
158026175e5SToby Isaac   }
159ad917190SMatthew G. Knepley   PetscFunctionReturn(0);
160026175e5SToby Isaac }
161026175e5SToby Isaac 
162cc4e42d9SMartin Diehl /*@
16312adca46SMatthew G. Knepley   DMPlexCreateRigidBody - For the default global section, create rigid body modes by function space interpolation
164cb1e1211SMatthew G Knepley 
165d083f849SBarry Smith   Collective on dm
166cb1e1211SMatthew G Knepley 
1674165533cSJose E. Roman   Input Parameters:
16856cf3b9cSMatthew G. Knepley + dm - the DM
16956cf3b9cSMatthew G. Knepley - field - The field number for the rigid body space, or 0 for the default
170cb1e1211SMatthew G Knepley 
1714165533cSJose E. Roman   Output Parameter:
172cb1e1211SMatthew G Knepley . sp - the null space
173cb1e1211SMatthew G Knepley 
17412adca46SMatthew G. Knepley   Note: This is necessary to provide a suitable coarse space for algebraic multigrid
175cb1e1211SMatthew G Knepley 
176cb1e1211SMatthew G Knepley   Level: advanced
177cb1e1211SMatthew G Knepley 
17812adca46SMatthew G. Knepley .seealso: MatNullSpaceCreate(), PCGAMG
179cb1e1211SMatthew G Knepley @*/
18056cf3b9cSMatthew G. Knepley PetscErrorCode DMPlexCreateRigidBody(DM dm, PetscInt field, MatNullSpace *sp)
181cb1e1211SMatthew G Knepley {
18256cf3b9cSMatthew G. Knepley   PetscErrorCode (**func)(PetscInt, PetscReal, const PetscReal *, PetscInt, PetscScalar *, void *);
183cb1e1211SMatthew G Knepley   MPI_Comm          comm;
184026175e5SToby Isaac   Vec               mode[6];
185026175e5SToby Isaac   PetscSection      section, globalSection;
18656cf3b9cSMatthew G. Knepley   PetscInt          dim, dimEmbed, Nf, n, m, mmin, d, i, j;
187cb1e1211SMatthew G Knepley 
188cb1e1211SMatthew G Knepley   PetscFunctionBegin;
1895f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscObjectGetComm((PetscObject) dm, &comm));
1905f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dm, &dim));
1915f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateDim(dm, &dimEmbed));
1925f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetNumFields(dm, &Nf));
1932c71b3e2SJacob Faibussowitsch   PetscCheckFalse(Nf && (field < 0 || field >= Nf),comm, PETSC_ERR_ARG_OUTOFRANGE, "Field %D is not in [0, Nf)", field, Nf);
19456cf3b9cSMatthew G. Knepley   if (dim == 1 && Nf < 2) {
1955f80ce2aSJacob Faibussowitsch     CHKERRQ(MatNullSpaceCreate(comm, PETSC_TRUE, 0, NULL, sp));
196cb1e1211SMatthew G Knepley     PetscFunctionReturn(0);
197cb1e1211SMatthew G Knepley   }
1985f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &section));
1995f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetGlobalSection(dm, &globalSection));
2005f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetConstrainedStorageSize(globalSection, &n));
2015f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscCalloc1(Nf, &func));
202b247467aSMatthew G. Knepley   m    = (dim*(dim+1))/2;
2035f80ce2aSJacob Faibussowitsch   CHKERRQ(VecCreate(comm, &mode[0]));
2045f80ce2aSJacob Faibussowitsch   CHKERRQ(VecSetType(mode[0], dm->vectype));
2055f80ce2aSJacob Faibussowitsch   CHKERRQ(VecSetSizes(mode[0], n, PETSC_DETERMINE));
2065f80ce2aSJacob Faibussowitsch   CHKERRQ(VecSetUp(mode[0]));
2075f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetSize(mode[0], &n));
208b247467aSMatthew G. Knepley   mmin = PetscMin(m, n);
20956cf3b9cSMatthew G. Knepley   func[field] = DMPlexProjectRigidBody_Private;
2105f80ce2aSJacob Faibussowitsch   for (i = 1; i < m; ++i) CHKERRQ(VecDuplicate(mode[0], &mode[i]));
211026175e5SToby Isaac   for (d = 0; d < m; d++) {
212330485fdSToby Isaac     PetscInt ctx[2];
213026175e5SToby Isaac     void    *voidctx = (void *) (&ctx[0]);
214cb1e1211SMatthew G Knepley 
2159d8fbdeaSMatthew G. Knepley     ctx[0] = dimEmbed;
216330485fdSToby Isaac     ctx[1] = d;
2175f80ce2aSJacob Faibussowitsch     CHKERRQ(DMProjectFunction(dm, 0.0, func, &voidctx, INSERT_VALUES, mode[d]));
218cb1e1211SMatthew G Knepley   }
2193b2202bfSJacob Faibussowitsch   /* Orthonormalize system */
220b50a2c0aSJacob Faibussowitsch   for (i = 0; i < mmin; ++i) {
221b77f2eeeSJacob Faibussowitsch     PetscScalar dots[6];
222b50a2c0aSJacob Faibussowitsch 
2235f80ce2aSJacob Faibussowitsch     CHKERRQ(VecNormalize(mode[i], NULL));
2245f80ce2aSJacob Faibussowitsch     CHKERRQ(VecMDot(mode[i], mmin-i-1, mode+i+1, dots+i+1));
225b50a2c0aSJacob Faibussowitsch     for (j = i+1; j < mmin; ++j) {
226b77f2eeeSJacob Faibussowitsch       dots[j] *= -1.0;
2275f80ce2aSJacob Faibussowitsch       CHKERRQ(VecAXPY(mode[j], dots[j], mode[i]));
228b50a2c0aSJacob Faibussowitsch     }
229cb1e1211SMatthew G Knepley   }
2305f80ce2aSJacob Faibussowitsch   CHKERRQ(MatNullSpaceCreate(comm, PETSC_FALSE, mmin, mode, sp));
2315f80ce2aSJacob Faibussowitsch   for (i = 0; i < m; ++i) CHKERRQ(VecDestroy(&mode[i]));
2325f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree(func));
233cb1e1211SMatthew G Knepley   PetscFunctionReturn(0);
234cb1e1211SMatthew G Knepley }
235cb1e1211SMatthew G Knepley 
236cc4e42d9SMartin Diehl /*@
23712adca46SMatthew G. Knepley   DMPlexCreateRigidBodies - For the default global section, create rigid body modes by function space interpolation
23812adca46SMatthew G. Knepley 
239d083f849SBarry Smith   Collective on dm
24012adca46SMatthew G. Knepley 
2414165533cSJose E. Roman   Input Parameters:
24212adca46SMatthew G. Knepley + dm    - the DM
24312adca46SMatthew G. Knepley . nb    - The number of bodies
24412adca46SMatthew G. Knepley . label - The DMLabel marking each domain
24512adca46SMatthew G. Knepley . nids  - The number of ids per body
24612adca46SMatthew G. Knepley - ids   - An array of the label ids in sequence for each domain
24712adca46SMatthew G. Knepley 
2484165533cSJose E. Roman   Output Parameter:
24912adca46SMatthew G. Knepley . sp - the null space
25012adca46SMatthew G. Knepley 
25112adca46SMatthew G. Knepley   Note: This is necessary to provide a suitable coarse space for algebraic multigrid
25212adca46SMatthew G. Knepley 
25312adca46SMatthew G. Knepley   Level: advanced
25412adca46SMatthew G. Knepley 
25512adca46SMatthew G. Knepley .seealso: MatNullSpaceCreate()
25612adca46SMatthew G. Knepley @*/
25712adca46SMatthew G. Knepley PetscErrorCode DMPlexCreateRigidBodies(DM dm, PetscInt nb, DMLabel label, const PetscInt nids[], const PetscInt ids[], MatNullSpace *sp)
25812adca46SMatthew G. Knepley {
25912adca46SMatthew G. Knepley   MPI_Comm       comm;
26012adca46SMatthew G. Knepley   PetscSection   section, globalSection;
26112adca46SMatthew G. Knepley   Vec           *mode;
26212adca46SMatthew G. Knepley   PetscScalar   *dots;
26312adca46SMatthew G. Knepley   PetscInt       dim, dimEmbed, n, m, b, d, i, j, off;
26412adca46SMatthew G. Knepley 
26512adca46SMatthew G. Knepley   PetscFunctionBegin;
2665f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscObjectGetComm((PetscObject)dm,&comm));
2675f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dm, &dim));
2685f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateDim(dm, &dimEmbed));
2695f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &section));
2705f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetGlobalSection(dm, &globalSection));
2715f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetConstrainedStorageSize(globalSection, &n));
27212adca46SMatthew G. Knepley   m    = nb * (dim*(dim+1))/2;
2735f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc2(m, &mode, m, &dots));
2745f80ce2aSJacob Faibussowitsch   CHKERRQ(VecCreate(comm, &mode[0]));
2755f80ce2aSJacob Faibussowitsch   CHKERRQ(VecSetSizes(mode[0], n, PETSC_DETERMINE));
2765f80ce2aSJacob Faibussowitsch   CHKERRQ(VecSetUp(mode[0]));
2775f80ce2aSJacob Faibussowitsch   for (i = 1; i < m; ++i) CHKERRQ(VecDuplicate(mode[0], &mode[i]));
27812adca46SMatthew G. Knepley   for (b = 0, off = 0; b < nb; ++b) {
27912adca46SMatthew G. Knepley     for (d = 0; d < m/nb; ++d) {
28012adca46SMatthew G. Knepley       PetscInt         ctx[2];
28112adca46SMatthew G. Knepley       PetscErrorCode (*func)(PetscInt, PetscReal, const PetscReal *, PetscInt, PetscScalar *, void *) = DMPlexProjectRigidBody_Private;
28212adca46SMatthew G. Knepley       void            *voidctx = (void *) (&ctx[0]);
28312adca46SMatthew G. Knepley 
28412adca46SMatthew G. Knepley       ctx[0] = dimEmbed;
28512adca46SMatthew G. Knepley       ctx[1] = d;
2865f80ce2aSJacob Faibussowitsch       CHKERRQ(DMProjectFunctionLabel(dm, 0.0, label, nids[b], &ids[off], 0, NULL, &func, &voidctx, INSERT_VALUES, mode[d]));
28712adca46SMatthew G. Knepley       off   += nids[b];
28812adca46SMatthew G. Knepley     }
28912adca46SMatthew G. Knepley   }
2903b2202bfSJacob Faibussowitsch   /* Orthonormalize system */
291606c1a1cSJacob Faibussowitsch   for (i = 0; i < m; ++i) {
292b77f2eeeSJacob Faibussowitsch     PetscScalar dots[6];
2935a0e29b9SJacob Faibussowitsch 
2945f80ce2aSJacob Faibussowitsch     CHKERRQ(VecNormalize(mode[i], NULL));
2955f80ce2aSJacob Faibussowitsch     CHKERRQ(VecMDot(mode[i], m-i-1, mode+i+1, dots+i+1));
2965a0e29b9SJacob Faibussowitsch     for (j = i+1; j < m; ++j) {
297b77f2eeeSJacob Faibussowitsch       dots[j] *= -1.0;
2985f80ce2aSJacob Faibussowitsch       CHKERRQ(VecAXPY(mode[j], dots[j], mode[i]));
2995a0e29b9SJacob Faibussowitsch     }
30012adca46SMatthew G. Knepley   }
3015f80ce2aSJacob Faibussowitsch   CHKERRQ(MatNullSpaceCreate(comm, PETSC_FALSE, m, mode, sp));
3025f80ce2aSJacob Faibussowitsch   for (i = 0; i< m; ++i) CHKERRQ(VecDestroy(&mode[i]));
3035f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree2(mode, dots));
30412adca46SMatthew G. Knepley   PetscFunctionReturn(0);
30512adca46SMatthew G. Knepley }
30612adca46SMatthew G. Knepley 
307b29cfa1cSToby Isaac /*@
308b29cfa1cSToby Isaac   DMPlexSetMaxProjectionHeight - In DMPlexProjectXXXLocal() functions, the projected values of a basis function's dofs
309b29cfa1cSToby Isaac   are computed by associating the basis function with one of the mesh points in its transitively-closed support, and
310b29cfa1cSToby Isaac   evaluating the dual space basis of that point.  A basis function is associated with the point in its
311b29cfa1cSToby Isaac   transitively-closed support whose mesh height is highest (w.r.t. DAG height), but not greater than the maximum
312b29cfa1cSToby Isaac   projection height, which is set with this function.  By default, the maximum projection height is zero, which means
313b29cfa1cSToby Isaac   that only mesh cells are used to project basis functions.  A height of one, for example, evaluates a cell-interior
314b29cfa1cSToby Isaac   basis functions using its cells dual space basis, but all other basis functions with the dual space basis of a face.
315b29cfa1cSToby Isaac 
316b29cfa1cSToby Isaac   Input Parameters:
317b29cfa1cSToby Isaac + dm - the DMPlex object
318b29cfa1cSToby Isaac - height - the maximum projection height >= 0
319b29cfa1cSToby Isaac 
320b29cfa1cSToby Isaac   Level: advanced
321b29cfa1cSToby Isaac 
3224d6f44ffSToby Isaac .seealso: DMPlexGetMaxProjectionHeight(), DMProjectFunctionLocal(), DMProjectFunctionLabelLocal()
323b29cfa1cSToby Isaac @*/
324b29cfa1cSToby Isaac PetscErrorCode DMPlexSetMaxProjectionHeight(DM dm, PetscInt height)
325b29cfa1cSToby Isaac {
326b29cfa1cSToby Isaac   DM_Plex *plex = (DM_Plex *) dm->data;
327b29cfa1cSToby Isaac 
328b29cfa1cSToby Isaac   PetscFunctionBegin;
329b29cfa1cSToby Isaac   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
330b29cfa1cSToby Isaac   plex->maxProjectionHeight = height;
331b29cfa1cSToby Isaac   PetscFunctionReturn(0);
332b29cfa1cSToby Isaac }
333b29cfa1cSToby Isaac 
334b29cfa1cSToby Isaac /*@
335b29cfa1cSToby Isaac   DMPlexGetMaxProjectionHeight - Get the maximum height (w.r.t. DAG) of mesh points used to evaluate dual bases in
336b29cfa1cSToby Isaac   DMPlexProjectXXXLocal() functions.
337b29cfa1cSToby Isaac 
338b29cfa1cSToby Isaac   Input Parameters:
339b29cfa1cSToby Isaac . dm - the DMPlex object
340b29cfa1cSToby Isaac 
341b29cfa1cSToby Isaac   Output Parameters:
342b29cfa1cSToby Isaac . height - the maximum projection height
343b29cfa1cSToby Isaac 
344b29cfa1cSToby Isaac   Level: intermediate
345b29cfa1cSToby Isaac 
3464d6f44ffSToby Isaac .seealso: DMPlexSetMaxProjectionHeight(), DMProjectFunctionLocal(), DMProjectFunctionLabelLocal()
347b29cfa1cSToby Isaac @*/
348b29cfa1cSToby Isaac PetscErrorCode DMPlexGetMaxProjectionHeight(DM dm, PetscInt *height)
349b29cfa1cSToby Isaac {
350b29cfa1cSToby Isaac   DM_Plex *plex = (DM_Plex *) dm->data;
351b29cfa1cSToby Isaac 
352b29cfa1cSToby Isaac   PetscFunctionBegin;
353b29cfa1cSToby Isaac   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
354b29cfa1cSToby Isaac   *height = plex->maxProjectionHeight;
355b29cfa1cSToby Isaac   PetscFunctionReturn(0);
356b29cfa1cSToby Isaac }
357b29cfa1cSToby Isaac 
358ca3d3a14SMatthew G. Knepley typedef struct {
359ca3d3a14SMatthew G. Knepley   PetscReal    alpha; /* The first Euler angle, and in 2D the only one */
360ca3d3a14SMatthew G. Knepley   PetscReal    beta;  /* The second Euler angle */
361ca3d3a14SMatthew G. Knepley   PetscReal    gamma; /* The third Euler angle */
362ca3d3a14SMatthew G. Knepley   PetscInt     dim;   /* The dimension of R */
363ca3d3a14SMatthew G. Knepley   PetscScalar *R;     /* The rotation matrix, transforming a vector in the local basis to the global basis */
364ca3d3a14SMatthew G. Knepley   PetscScalar *RT;    /* The transposed rotation matrix, transforming a vector in the global basis to the local basis */
365ca3d3a14SMatthew G. Knepley } RotCtx;
366ca3d3a14SMatthew G. Knepley 
367ca3d3a14SMatthew G. Knepley /*
368ca3d3a14SMatthew G. Knepley   Note: Following https://en.wikipedia.org/wiki/Euler_angles, we will specify Euler angles by extrinsic rotations, meaning that
369ca3d3a14SMatthew G. Knepley   we rotate with respect to a fixed initial coordinate system, the local basis (x-y-z). The global basis (X-Y-Z) is reached as follows:
370ca3d3a14SMatthew G. Knepley   $ The XYZ system rotates about the z axis by alpha. The X axis is now at angle alpha with respect to the x axis.
371ca3d3a14SMatthew G. Knepley   $ The XYZ system rotates again about the x axis by beta. The Z axis is now at angle beta with respect to the z axis.
372ca3d3a14SMatthew G. Knepley   $ The XYZ system rotates a third time about the z axis by gamma.
373ca3d3a14SMatthew G. Knepley */
374ca3d3a14SMatthew G. Knepley static PetscErrorCode DMPlexBasisTransformSetUp_Rotation_Internal(DM dm, void *ctx)
375ca3d3a14SMatthew G. Knepley {
376ca3d3a14SMatthew G. Knepley   RotCtx        *rc  = (RotCtx *) ctx;
377ca3d3a14SMatthew G. Knepley   PetscInt       dim = rc->dim;
378ca3d3a14SMatthew G. Knepley   PetscReal      c1, s1, c2, s2, c3, s3;
379ca3d3a14SMatthew G. Knepley 
380ca3d3a14SMatthew G. Knepley   PetscFunctionBegin;
3815f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc2(PetscSqr(dim), &rc->R, PetscSqr(dim), &rc->RT));
382ca3d3a14SMatthew G. Knepley   switch (dim) {
383ca3d3a14SMatthew G. Knepley   case 2:
384ca3d3a14SMatthew G. Knepley     c1 = PetscCosReal(rc->alpha);s1 = PetscSinReal(rc->alpha);
385ca3d3a14SMatthew G. Knepley     rc->R[0] =  c1;rc->R[1] = s1;
386ca3d3a14SMatthew G. Knepley     rc->R[2] = -s1;rc->R[3] = c1;
3875f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscArraycpy(rc->RT, rc->R, PetscSqr(dim)));
388b458e8f1SJose E. Roman     DMPlex_Transpose2D_Internal(rc->RT);
389ca3d3a14SMatthew G. Knepley     break;
390ca3d3a14SMatthew G. Knepley   case 3:
391ca3d3a14SMatthew G. Knepley     c1 = PetscCosReal(rc->alpha);s1 = PetscSinReal(rc->alpha);
392ca3d3a14SMatthew G. Knepley     c2 = PetscCosReal(rc->beta); s2 = PetscSinReal(rc->beta);
393ca3d3a14SMatthew G. Knepley     c3 = PetscCosReal(rc->gamma);s3 = PetscSinReal(rc->gamma);
394ca3d3a14SMatthew G. Knepley     rc->R[0] =  c1*c3 - c2*s1*s3;rc->R[1] =  c3*s1    + c1*c2*s3;rc->R[2] = s2*s3;
395ca3d3a14SMatthew G. Knepley     rc->R[3] = -c1*s3 - c2*c3*s1;rc->R[4] =  c1*c2*c3 - s1*s3;   rc->R[5] = c3*s2;
396ca3d3a14SMatthew G. Knepley     rc->R[6] =  s1*s2;           rc->R[7] = -c1*s2;              rc->R[8] = c2;
3975f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscArraycpy(rc->RT, rc->R, PetscSqr(dim)));
398b458e8f1SJose E. Roman     DMPlex_Transpose3D_Internal(rc->RT);
399ca3d3a14SMatthew G. Knepley     break;
40098921bdaSJacob Faibussowitsch   default: SETERRQ(PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_OUTOFRANGE, "Dimension %D not supported", dim);
401ca3d3a14SMatthew G. Knepley   }
402ca3d3a14SMatthew G. Knepley   PetscFunctionReturn(0);
403ca3d3a14SMatthew G. Knepley }
404ca3d3a14SMatthew G. Knepley 
405ca3d3a14SMatthew G. Knepley static PetscErrorCode DMPlexBasisTransformDestroy_Rotation_Internal(DM dm, void *ctx)
406ca3d3a14SMatthew G. Knepley {
407ca3d3a14SMatthew G. Knepley   RotCtx        *rc = (RotCtx *) ctx;
408ca3d3a14SMatthew G. Knepley 
409ca3d3a14SMatthew G. Knepley   PetscFunctionBegin;
4105f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree2(rc->R, rc->RT));
4115f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree(rc));
412ca3d3a14SMatthew G. Knepley   PetscFunctionReturn(0);
413ca3d3a14SMatthew G. Knepley }
414ca3d3a14SMatthew G. Knepley 
415ca3d3a14SMatthew G. Knepley static PetscErrorCode DMPlexBasisTransformGetMatrix_Rotation_Internal(DM dm, const PetscReal x[], PetscBool l2g, const PetscScalar **A, void *ctx)
416ca3d3a14SMatthew G. Knepley {
417ca3d3a14SMatthew G. Knepley   RotCtx *rc = (RotCtx *) ctx;
418ca3d3a14SMatthew G. Knepley 
419ca3d3a14SMatthew G. Knepley   PetscFunctionBeginHot;
420ca3d3a14SMatthew G. Knepley   PetscValidPointer(ctx, 5);
421ca3d3a14SMatthew G. Knepley   if (l2g) {*A = rc->R;}
422ca3d3a14SMatthew G. Knepley   else     {*A = rc->RT;}
423ca3d3a14SMatthew G. Knepley   PetscFunctionReturn(0);
424ca3d3a14SMatthew G. Knepley }
425ca3d3a14SMatthew G. Knepley 
426ab6a9622SMatthew G. Knepley PetscErrorCode DMPlexBasisTransformApplyReal_Internal(DM dm, const PetscReal x[], PetscBool l2g, PetscInt dim, const PetscReal *y, PetscReal *z, void *ctx)
427ab6a9622SMatthew G. Knepley {
428ec277c0fSMatthew G. Knepley   PetscFunctionBegin;
429ab6a9622SMatthew G. Knepley   #if defined(PETSC_USE_COMPLEX)
430ab6a9622SMatthew G. Knepley   switch (dim) {
431ab6a9622SMatthew G. Knepley     case 2:
432ab6a9622SMatthew G. Knepley     {
43327104ee2SJacob Faibussowitsch       PetscScalar yt[2] = {y[0], y[1]}, zt[2] = {0.0,0.0};
434ab6a9622SMatthew G. Knepley 
4355f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexBasisTransformApply_Internal(dm, x, l2g, dim, yt, zt, ctx));
436ab6a9622SMatthew G. Knepley       z[0] = PetscRealPart(zt[0]); z[1] = PetscRealPart(zt[1]);
437ab6a9622SMatthew G. Knepley     }
4389b4815dcSMatthew G. Knepley     break;
439ab6a9622SMatthew G. Knepley     case 3:
440ab6a9622SMatthew G. Knepley     {
44127104ee2SJacob Faibussowitsch       PetscScalar yt[3] = {y[0], y[1], y[2]}, zt[3] = {0.0,0.0,0.0};
442ab6a9622SMatthew G. Knepley 
4435f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexBasisTransformApply_Internal(dm, x, l2g, dim, yt, zt, ctx));
444ab6a9622SMatthew G. Knepley       z[0] = PetscRealPart(zt[0]); z[1] = PetscRealPart(zt[1]); z[2] = PetscRealPart(zt[2]);
445ab6a9622SMatthew G. Knepley     }
4469b4815dcSMatthew G. Knepley     break;
447ab6a9622SMatthew G. Knepley   }
448ab6a9622SMatthew G. Knepley   #else
4495f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexBasisTransformApply_Internal(dm, x, l2g, dim, y, z, ctx));
450ab6a9622SMatthew G. Knepley   #endif
451ec277c0fSMatthew G. Knepley   PetscFunctionReturn(0);
452ab6a9622SMatthew G. Knepley }
453ab6a9622SMatthew G. Knepley 
454ec277c0fSMatthew G. Knepley PetscErrorCode DMPlexBasisTransformApply_Internal(DM dm, const PetscReal x[], PetscBool l2g, PetscInt dim, const PetscScalar *y, PetscScalar *z, void *ctx)
455ca3d3a14SMatthew G. Knepley {
456ca3d3a14SMatthew G. Knepley   const PetscScalar *A;
457ca3d3a14SMatthew G. Knepley 
458ca3d3a14SMatthew G. Knepley   PetscFunctionBeginHot;
4595f80ce2aSJacob Faibussowitsch   CHKERRQ((*dm->transformGetMatrix)(dm, x, l2g, &A, ctx));
460ca3d3a14SMatthew G. Knepley   switch (dim) {
4611fba962aSMatthew G. Knepley   case 2: DMPlex_Mult2D_Internal(A, 1, y, z);break;
4621fba962aSMatthew G. Knepley   case 3: DMPlex_Mult3D_Internal(A, 1, y, z);break;
463ca3d3a14SMatthew G. Knepley   }
464ca3d3a14SMatthew G. Knepley   PetscFunctionReturn(0);
465ca3d3a14SMatthew G. Knepley }
466ca3d3a14SMatthew G. Knepley 
467ca3d3a14SMatthew G. Knepley static PetscErrorCode DMPlexBasisTransformField_Internal(DM dm, DM tdm, Vec tv, PetscInt p, PetscInt f, PetscBool l2g, PetscScalar *a)
468ca3d3a14SMatthew G. Knepley {
469ca3d3a14SMatthew G. Knepley   PetscSection       ts;
470ca3d3a14SMatthew G. Knepley   const PetscScalar *ta, *tva;
471ca3d3a14SMatthew G. Knepley   PetscInt           dof;
472ca3d3a14SMatthew G. Knepley 
473ca3d3a14SMatthew G. Knepley   PetscFunctionBeginHot;
4745f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(tdm, &ts));
4755f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetFieldDof(ts, p, f, &dof));
4765f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetArrayRead(tv, &ta));
4775f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexPointLocalFieldRead(tdm, p, f, ta, &tva));
478ca3d3a14SMatthew G. Knepley   if (l2g) {
479ca3d3a14SMatthew G. Knepley     switch (dof) {
4801fba962aSMatthew G. Knepley     case 4: DMPlex_Mult2D_Internal(tva, 1, a, a);break;
4811fba962aSMatthew G. Knepley     case 9: DMPlex_Mult3D_Internal(tva, 1, a, a);break;
482ca3d3a14SMatthew G. Knepley     }
483ca3d3a14SMatthew G. Knepley   } else {
484ca3d3a14SMatthew G. Knepley     switch (dof) {
4851fba962aSMatthew G. Knepley     case 4: DMPlex_MultTranspose2D_Internal(tva, 1, a, a);break;
4861fba962aSMatthew G. Knepley     case 9: DMPlex_MultTranspose3D_Internal(tva, 1, a, a);break;
487ca3d3a14SMatthew G. Knepley     }
488ca3d3a14SMatthew G. Knepley   }
4895f80ce2aSJacob Faibussowitsch   CHKERRQ(VecRestoreArrayRead(tv, &ta));
490ca3d3a14SMatthew G. Knepley   PetscFunctionReturn(0);
491ca3d3a14SMatthew G. Knepley }
492ca3d3a14SMatthew G. Knepley 
493ca3d3a14SMatthew G. Knepley static PetscErrorCode DMPlexBasisTransformFieldTensor_Internal(DM dm, DM tdm, Vec tv, PetscInt pf, PetscInt f, PetscInt pg, PetscInt g, PetscBool l2g, PetscInt lda, PetscScalar *a)
494ca3d3a14SMatthew G. Knepley {
495ca3d3a14SMatthew G. Knepley   PetscSection       s, ts;
496ca3d3a14SMatthew G. Knepley   const PetscScalar *ta, *tvaf, *tvag;
497ca3d3a14SMatthew G. Knepley   PetscInt           fdof, gdof, fpdof, gpdof;
498ca3d3a14SMatthew G. Knepley 
499ca3d3a14SMatthew G. Knepley   PetscFunctionBeginHot;
5005f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &s));
5015f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(tdm, &ts));
5025f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetFieldDof(s, pf, f, &fpdof));
5035f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetFieldDof(s, pg, g, &gpdof));
5045f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetFieldDof(ts, pf, f, &fdof));
5055f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetFieldDof(ts, pg, g, &gdof));
5065f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetArrayRead(tv, &ta));
5075f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexPointLocalFieldRead(tdm, pf, f, ta, &tvaf));
5085f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexPointLocalFieldRead(tdm, pg, g, ta, &tvag));
509ca3d3a14SMatthew G. Knepley   if (l2g) {
510ca3d3a14SMatthew G. Knepley     switch (fdof) {
511ca3d3a14SMatthew G. Knepley     case 4: DMPlex_MatMult2D_Internal(tvaf, gpdof, lda, a, a);break;
512ca3d3a14SMatthew G. Knepley     case 9: DMPlex_MatMult3D_Internal(tvaf, gpdof, lda, a, a);break;
513ca3d3a14SMatthew G. Knepley     }
514ca3d3a14SMatthew G. Knepley     switch (gdof) {
515ca3d3a14SMatthew G. Knepley     case 4: DMPlex_MatMultTransposeLeft2D_Internal(tvag, fpdof, lda, a, a);break;
516ca3d3a14SMatthew G. Knepley     case 9: DMPlex_MatMultTransposeLeft3D_Internal(tvag, fpdof, lda, a, a);break;
517ca3d3a14SMatthew G. Knepley     }
518ca3d3a14SMatthew G. Knepley   } else {
519ca3d3a14SMatthew G. Knepley     switch (fdof) {
520ca3d3a14SMatthew G. Knepley     case 4: DMPlex_MatMultTranspose2D_Internal(tvaf, gpdof, lda, a, a);break;
521ca3d3a14SMatthew G. Knepley     case 9: DMPlex_MatMultTranspose3D_Internal(tvaf, gpdof, lda, a, a);break;
522ca3d3a14SMatthew G. Knepley     }
523ca3d3a14SMatthew G. Knepley     switch (gdof) {
524ca3d3a14SMatthew G. Knepley     case 4: DMPlex_MatMultLeft2D_Internal(tvag, fpdof, lda, a, a);break;
525ca3d3a14SMatthew G. Knepley     case 9: DMPlex_MatMultLeft3D_Internal(tvag, fpdof, lda, a, a);break;
526ca3d3a14SMatthew G. Knepley     }
527ca3d3a14SMatthew G. Knepley   }
5285f80ce2aSJacob Faibussowitsch   CHKERRQ(VecRestoreArrayRead(tv, &ta));
529ca3d3a14SMatthew G. Knepley   PetscFunctionReturn(0);
530ca3d3a14SMatthew G. Knepley }
531ca3d3a14SMatthew G. Knepley 
532ca3d3a14SMatthew G. Knepley PetscErrorCode DMPlexBasisTransformPoint_Internal(DM dm, DM tdm, Vec tv, PetscInt p, PetscBool fieldActive[], PetscBool l2g, PetscScalar *a)
533ca3d3a14SMatthew G. Knepley {
534ca3d3a14SMatthew G. Knepley   PetscSection    s;
535ca3d3a14SMatthew G. Knepley   PetscSection    clSection;
536ca3d3a14SMatthew G. Knepley   IS              clPoints;
537ca3d3a14SMatthew G. Knepley   const PetscInt *clp;
538ca3d3a14SMatthew G. Knepley   PetscInt       *points = NULL;
539ca3d3a14SMatthew G. Knepley   PetscInt        Nf, f, Np, cp, dof, d = 0;
540ca3d3a14SMatthew G. Knepley 
541ca3d3a14SMatthew G. Knepley   PetscFunctionBegin;
5425f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &s));
5435f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetNumFields(s, &Nf));
5445f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetCompressedClosure(dm, s, p, &Np, &points, &clSection, &clPoints, &clp));
545ca3d3a14SMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
546ca3d3a14SMatthew G. Knepley     for (cp = 0; cp < Np*2; cp += 2) {
5475f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscSectionGetFieldDof(s, points[cp], f, &dof));
548ca3d3a14SMatthew G. Knepley       if (!dof) continue;
5495f80ce2aSJacob Faibussowitsch       if (fieldActive[f]) CHKERRQ(DMPlexBasisTransformField_Internal(dm, tdm, tv, points[cp], f, l2g, &a[d]));
550ca3d3a14SMatthew G. Knepley       d += dof;
551ca3d3a14SMatthew G. Knepley     }
552ca3d3a14SMatthew G. Knepley   }
5535f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexRestoreCompressedClosure(dm, s, p, &Np, &points, &clSection, &clPoints, &clp));
554ca3d3a14SMatthew G. Knepley   PetscFunctionReturn(0);
555ca3d3a14SMatthew G. Knepley }
556ca3d3a14SMatthew G. Knepley 
557ca3d3a14SMatthew G. Knepley PetscErrorCode DMPlexBasisTransformPointTensor_Internal(DM dm, DM tdm, Vec tv, PetscInt p, PetscBool l2g, PetscInt lda, PetscScalar *a)
558ca3d3a14SMatthew G. Knepley {
559ca3d3a14SMatthew G. Knepley   PetscSection    s;
560ca3d3a14SMatthew G. Knepley   PetscSection    clSection;
561ca3d3a14SMatthew G. Knepley   IS              clPoints;
562ca3d3a14SMatthew G. Knepley   const PetscInt *clp;
563ca3d3a14SMatthew G. Knepley   PetscInt       *points = NULL;
5648bdb3c71SMatthew G. Knepley   PetscInt        Nf, f, g, Np, cpf, cpg, fdof, gdof, r, c = 0;
565ca3d3a14SMatthew G. Knepley 
566ca3d3a14SMatthew G. Knepley   PetscFunctionBegin;
5675f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &s));
5685f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetNumFields(s, &Nf));
5695f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetCompressedClosure(dm, s, p, &Np, &points, &clSection, &clPoints, &clp));
570ca3d3a14SMatthew G. Knepley   for (f = 0, r = 0; f < Nf; ++f) {
571ca3d3a14SMatthew G. Knepley     for (cpf = 0; cpf < Np*2; cpf += 2) {
5725f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscSectionGetFieldDof(s, points[cpf], f, &fdof));
573ca3d3a14SMatthew G. Knepley       for (g = 0, c = 0; g < Nf; ++g) {
574ca3d3a14SMatthew G. Knepley         for (cpg = 0; cpg < Np*2; cpg += 2) {
5755f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscSectionGetFieldDof(s, points[cpg], g, &gdof));
5765f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexBasisTransformFieldTensor_Internal(dm, tdm, tv, points[cpf], f, points[cpg], g, l2g, lda, &a[r*lda+c]));
577ca3d3a14SMatthew G. Knepley           c += gdof;
578ca3d3a14SMatthew G. Knepley         }
579ca3d3a14SMatthew G. Knepley       }
5805f80ce2aSJacob Faibussowitsch       PetscCheck(c == lda,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Invalid number of columns %D should be %D", c, lda);
581ca3d3a14SMatthew G. Knepley       r += fdof;
582ca3d3a14SMatthew G. Knepley     }
583ca3d3a14SMatthew G. Knepley   }
5845f80ce2aSJacob Faibussowitsch   PetscCheck(r == lda,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Invalid number of rows %D should be %D", c, lda);
5855f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexRestoreCompressedClosure(dm, s, p, &Np, &points, &clSection, &clPoints, &clp));
586ca3d3a14SMatthew G. Knepley   PetscFunctionReturn(0);
587ca3d3a14SMatthew G. Knepley }
588ca3d3a14SMatthew G. Knepley 
589ca3d3a14SMatthew G. Knepley static PetscErrorCode DMPlexBasisTransform_Internal(DM dm, Vec lv, PetscBool l2g)
590ca3d3a14SMatthew G. Knepley {
591ca3d3a14SMatthew G. Knepley   DM                 tdm;
592ca3d3a14SMatthew G. Knepley   Vec                tv;
593ca3d3a14SMatthew G. Knepley   PetscSection       ts, s;
594ca3d3a14SMatthew G. Knepley   const PetscScalar *ta;
595ca3d3a14SMatthew G. Knepley   PetscScalar       *a, *va;
596ca3d3a14SMatthew G. Knepley   PetscInt           pStart, pEnd, p, Nf, f;
597ca3d3a14SMatthew G. Knepley 
598ca3d3a14SMatthew G. Knepley   PetscFunctionBegin;
5995f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetBasisTransformDM_Internal(dm, &tdm));
6005f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetBasisTransformVec_Internal(dm, &tv));
6015f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(tdm, &ts));
6025f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &s));
6035f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetChart(s, &pStart, &pEnd));
6045f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetNumFields(s, &Nf));
6055f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetArray(lv, &a));
6065f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetArrayRead(tv, &ta));
607ca3d3a14SMatthew G. Knepley   for (p = pStart; p < pEnd; ++p) {
608ca3d3a14SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
6095f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexPointLocalFieldRef(dm, p, f, a, &va));
6105f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexBasisTransformField_Internal(dm, tdm, tv, p, f, l2g, va));
611ca3d3a14SMatthew G. Knepley     }
612ca3d3a14SMatthew G. Knepley   }
6135f80ce2aSJacob Faibussowitsch   CHKERRQ(VecRestoreArray(lv, &a));
6145f80ce2aSJacob Faibussowitsch   CHKERRQ(VecRestoreArrayRead(tv, &ta));
615ca3d3a14SMatthew G. Knepley   PetscFunctionReturn(0);
616ca3d3a14SMatthew G. Knepley }
617ca3d3a14SMatthew G. Knepley 
618ca3d3a14SMatthew G. Knepley /*@
619ca3d3a14SMatthew G. Knepley   DMPlexGlobalToLocalBasis - Transform the values in the given local vector from the global basis to the local basis
620ca3d3a14SMatthew G. Knepley 
621ca3d3a14SMatthew G. Knepley   Input Parameters:
622ca3d3a14SMatthew G. Knepley + dm - The DM
623ca3d3a14SMatthew G. Knepley - lv - A local vector with values in the global basis
624ca3d3a14SMatthew G. Knepley 
625ca3d3a14SMatthew G. Knepley   Output Parameters:
626ca3d3a14SMatthew G. Knepley . lv - A local vector with values in the local basis
627ca3d3a14SMatthew G. Knepley 
628c0f8e1fdSMatthew G. Knepley   Note: This method is only intended to be called inside DMGlobalToLocal(). It is unlikely that a user will have a local vector full of coefficients for the global basis unless they are reimplementing GlobalToLocal.
629c0f8e1fdSMatthew G. Knepley 
630ca3d3a14SMatthew G. Knepley   Level: developer
631ca3d3a14SMatthew G. Knepley 
632436bc73aSJed Brown .seealso: DMPlexLocalToGlobalBasis(), DMGetLocalSection(), DMPlexCreateBasisRotation()
633ca3d3a14SMatthew G. Knepley @*/
634ca3d3a14SMatthew G. Knepley PetscErrorCode DMPlexGlobalToLocalBasis(DM dm, Vec lv)
635ca3d3a14SMatthew G. Knepley {
636ca3d3a14SMatthew G. Knepley   PetscFunctionBegin;
637ca3d3a14SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
638ca3d3a14SMatthew G. Knepley   PetscValidHeaderSpecific(lv, VEC_CLASSID, 2);
6395f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexBasisTransform_Internal(dm, lv, PETSC_FALSE));
640ca3d3a14SMatthew G. Knepley   PetscFunctionReturn(0);
641ca3d3a14SMatthew G. Knepley }
642ca3d3a14SMatthew G. Knepley 
643ca3d3a14SMatthew G. Knepley /*@
644ca3d3a14SMatthew G. Knepley   DMPlexLocalToGlobalBasis - Transform the values in the given local vector from the local basis to the global basis
645ca3d3a14SMatthew G. Knepley 
646ca3d3a14SMatthew G. Knepley   Input Parameters:
647ca3d3a14SMatthew G. Knepley + dm - The DM
648ca3d3a14SMatthew G. Knepley - lv - A local vector with values in the local basis
649ca3d3a14SMatthew G. Knepley 
650ca3d3a14SMatthew G. Knepley   Output Parameters:
651ca3d3a14SMatthew G. Knepley . lv - A local vector with values in the global basis
652ca3d3a14SMatthew G. Knepley 
653c0f8e1fdSMatthew G. Knepley   Note: This method is only intended to be called inside DMGlobalToLocal(). It is unlikely that a user would want a local vector full of coefficients for the global basis unless they are reimplementing GlobalToLocal.
654c0f8e1fdSMatthew G. Knepley 
655ca3d3a14SMatthew G. Knepley   Level: developer
656ca3d3a14SMatthew G. Knepley 
657436bc73aSJed Brown .seealso: DMPlexGlobalToLocalBasis(), DMGetLocalSection(), DMPlexCreateBasisRotation()
658ca3d3a14SMatthew G. Knepley @*/
659ca3d3a14SMatthew G. Knepley PetscErrorCode DMPlexLocalToGlobalBasis(DM dm, Vec lv)
660ca3d3a14SMatthew G. Knepley {
661ca3d3a14SMatthew G. Knepley   PetscFunctionBegin;
662ca3d3a14SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
663ca3d3a14SMatthew G. Knepley   PetscValidHeaderSpecific(lv, VEC_CLASSID, 2);
6645f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexBasisTransform_Internal(dm, lv, PETSC_TRUE));
665ca3d3a14SMatthew G. Knepley   PetscFunctionReturn(0);
666ca3d3a14SMatthew G. Knepley }
667ca3d3a14SMatthew G. Knepley 
668ca3d3a14SMatthew G. Knepley /*@
669ca3d3a14SMatthew G. Knepley   DMPlexCreateBasisRotation - Create an internal transformation from the global basis, used to specify boundary conditions
670ca3d3a14SMatthew G. Knepley     and global solutions, to a local basis, appropriate for discretization integrals and assembly.
671ca3d3a14SMatthew G. Knepley 
672ca3d3a14SMatthew G. Knepley   Input Parameters:
673ca3d3a14SMatthew G. Knepley + dm    - The DM
674ca3d3a14SMatthew G. Knepley . alpha - The first Euler angle, and in 2D the only one
675ca3d3a14SMatthew G. Knepley . beta  - The second Euler angle
676f0fc11ceSJed Brown - gamma - The third Euler angle
677ca3d3a14SMatthew G. Knepley 
678ca3d3a14SMatthew G. Knepley   Note: Following https://en.wikipedia.org/wiki/Euler_angles, we will specify Euler angles by extrinsic rotations, meaning that
679ca3d3a14SMatthew G. Knepley   we rotate with respect to a fixed initial coordinate system, the local basis (x-y-z). The global basis (X-Y-Z) is reached as follows:
680ca3d3a14SMatthew G. Knepley   $ The XYZ system rotates about the z axis by alpha. The X axis is now at angle alpha with respect to the x axis.
681ca3d3a14SMatthew G. Knepley   $ The XYZ system rotates again about the x axis by beta. The Z axis is now at angle beta with respect to the z axis.
682ca3d3a14SMatthew G. Knepley   $ The XYZ system rotates a third time about the z axis by gamma.
683ca3d3a14SMatthew G. Knepley 
684ca3d3a14SMatthew G. Knepley   Level: developer
685ca3d3a14SMatthew G. Knepley 
686ca3d3a14SMatthew G. Knepley .seealso: DMPlexGlobalToLocalBasis(), DMPlexLocalToGlobalBasis()
687ca3d3a14SMatthew G. Knepley @*/
688ca3d3a14SMatthew G. Knepley PetscErrorCode DMPlexCreateBasisRotation(DM dm, PetscReal alpha, PetscReal beta, PetscReal gamma)
689ca3d3a14SMatthew G. Knepley {
690ca3d3a14SMatthew G. Knepley   RotCtx        *rc;
691ca3d3a14SMatthew G. Knepley   PetscInt       cdim;
692ca3d3a14SMatthew G. Knepley 
693362febeeSStefano Zampini   PetscFunctionBegin;
6945f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateDim(dm, &cdim));
6955f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc1(1, &rc));
696ca3d3a14SMatthew G. Knepley   dm->transformCtx       = rc;
697ca3d3a14SMatthew G. Knepley   dm->transformSetUp     = DMPlexBasisTransformSetUp_Rotation_Internal;
698ca3d3a14SMatthew G. Knepley   dm->transformDestroy   = DMPlexBasisTransformDestroy_Rotation_Internal;
699ca3d3a14SMatthew G. Knepley   dm->transformGetMatrix = DMPlexBasisTransformGetMatrix_Rotation_Internal;
700ca3d3a14SMatthew G. Knepley   rc->dim   = cdim;
701ca3d3a14SMatthew G. Knepley   rc->alpha = alpha;
702ca3d3a14SMatthew G. Knepley   rc->beta  = beta;
703ca3d3a14SMatthew G. Knepley   rc->gamma = gamma;
7045f80ce2aSJacob Faibussowitsch   CHKERRQ((*dm->transformSetUp)(dm, dm->transformCtx));
7055f80ce2aSJacob Faibussowitsch   CHKERRQ(DMConstructBasisTransform_Internal(dm));
706ca3d3a14SMatthew G. Knepley   PetscFunctionReturn(0);
707ca3d3a14SMatthew G. Knepley }
708ca3d3a14SMatthew G. Knepley 
709b278463cSMatthew G. Knepley /*@C
710ece3a9fcSMatthew G. Knepley   DMPlexInsertBoundaryValuesEssential - Insert boundary values into a local vector using a function of the coordinates
711b278463cSMatthew G. Knepley 
712b278463cSMatthew G. Knepley   Input Parameters:
713b278463cSMatthew G. Knepley + dm     - The DM, with a PetscDS that matches the problem being constrained
714b278463cSMatthew G. Knepley . time   - The time
715b278463cSMatthew G. Knepley . field  - The field to constrain
7161c531cf8SMatthew G. Knepley . Nc     - The number of constrained field components, or 0 for all components
7171c531cf8SMatthew G. Knepley . comps  - An array of constrained component numbers, or NULL for all components
718b278463cSMatthew G. Knepley . label  - The DMLabel defining constrained points
719b278463cSMatthew G. Knepley . numids - The number of DMLabel ids for constrained points
720b278463cSMatthew G. Knepley . ids    - An array of ids for constrained points
721b278463cSMatthew G. Knepley . func   - A pointwise function giving boundary values
722b278463cSMatthew G. Knepley - ctx    - An optional user context for bcFunc
723b278463cSMatthew G. Knepley 
724b278463cSMatthew G. Knepley   Output Parameter:
725b278463cSMatthew G. Knepley . locX   - A local vector to receives the boundary values
726b278463cSMatthew G. Knepley 
727b278463cSMatthew G. Knepley   Level: developer
728b278463cSMatthew G. Knepley 
729ece3a9fcSMatthew G. Knepley .seealso: DMPlexInsertBoundaryValuesEssentialField(), DMPlexInsertBoundaryValuesEssentialBdField(), DMAddBoundary()
730b278463cSMatthew G. Knepley @*/
7311c531cf8SMatthew G. Knepley PetscErrorCode DMPlexInsertBoundaryValuesEssential(DM dm, PetscReal time, PetscInt field, PetscInt Nc, const PetscInt comps[], DMLabel label, PetscInt numids, const PetscInt ids[], PetscErrorCode (*func)(PetscInt, PetscReal, const PetscReal[], PetscInt, PetscScalar *, void *), void *ctx, Vec locX)
73255f2e967SMatthew G. Knepley {
7330163fd50SMatthew G. Knepley   PetscErrorCode (**funcs)(PetscInt, PetscReal, const PetscReal x[], PetscInt, PetscScalar *u, void *ctx);
73455f2e967SMatthew G. Knepley   void            **ctxs;
735d7ddef95SMatthew G. Knepley   PetscInt          numFields;
736d7ddef95SMatthew G. Knepley 
737d7ddef95SMatthew G. Knepley   PetscFunctionBegin;
7385f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetNumFields(dm, &numFields));
7395f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscCalloc2(numFields,&funcs,numFields,&ctxs));
740d7ddef95SMatthew G. Knepley   funcs[field] = func;
741d7ddef95SMatthew G. Knepley   ctxs[field]  = ctx;
7425f80ce2aSJacob Faibussowitsch   CHKERRQ(DMProjectFunctionLabelLocal(dm, time, label, numids, ids, Nc, comps, funcs, ctxs, INSERT_BC_VALUES, locX));
7435f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree2(funcs,ctxs));
744d7ddef95SMatthew G. Knepley   PetscFunctionReturn(0);
745d7ddef95SMatthew G. Knepley }
746d7ddef95SMatthew G. Knepley 
747b278463cSMatthew G. Knepley /*@C
748ece3a9fcSMatthew G. Knepley   DMPlexInsertBoundaryValuesEssentialField - Insert boundary values into a local vector using a function of the coordinates and field data
749b278463cSMatthew G. Knepley 
750b278463cSMatthew G. Knepley   Input Parameters:
751b278463cSMatthew G. Knepley + dm     - The DM, with a PetscDS that matches the problem being constrained
752b278463cSMatthew G. Knepley . time   - The time
753b278463cSMatthew G. Knepley . locU   - A local vector with the input solution values
754b278463cSMatthew G. Knepley . field  - The field to constrain
7551c531cf8SMatthew G. Knepley . Nc     - The number of constrained field components, or 0 for all components
7561c531cf8SMatthew G. Knepley . comps  - An array of constrained component numbers, or NULL for all components
757b278463cSMatthew G. Knepley . label  - The DMLabel defining constrained points
758b278463cSMatthew G. Knepley . numids - The number of DMLabel ids for constrained points
759b278463cSMatthew G. Knepley . ids    - An array of ids for constrained points
760b278463cSMatthew G. Knepley . func   - A pointwise function giving boundary values
761b278463cSMatthew G. Knepley - ctx    - An optional user context for bcFunc
762b278463cSMatthew G. Knepley 
763b278463cSMatthew G. Knepley   Output Parameter:
764b278463cSMatthew G. Knepley . locX   - A local vector to receives the boundary values
765b278463cSMatthew G. Knepley 
766b278463cSMatthew G. Knepley   Level: developer
767b278463cSMatthew G. Knepley 
768ece3a9fcSMatthew G. Knepley .seealso: DMPlexInsertBoundaryValuesEssential(), DMPlexInsertBoundaryValuesEssentialBdField(), DMAddBoundary()
769b278463cSMatthew G. Knepley @*/
7701c531cf8SMatthew G. Knepley PetscErrorCode DMPlexInsertBoundaryValuesEssentialField(DM dm, PetscReal time, Vec locU, PetscInt field, PetscInt Nc, const PetscInt comps[], DMLabel label, PetscInt numids, const PetscInt ids[],
771c60e475cSMatthew G. Knepley                                                         void (*func)(PetscInt, PetscInt, PetscInt,
772c60e475cSMatthew G. Knepley                                                                      const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
773c60e475cSMatthew G. Knepley                                                                      const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
77497b6e6e8SMatthew G. Knepley                                                                      PetscReal, const PetscReal[], PetscInt, const PetscScalar[],
775b278463cSMatthew G. Knepley                                                                      PetscScalar[]),
776b278463cSMatthew G. Knepley                                                         void *ctx, Vec locX)
777c60e475cSMatthew G. Knepley {
778c60e475cSMatthew G. Knepley   void (**funcs)(PetscInt, PetscInt, PetscInt,
779c60e475cSMatthew G. Knepley                  const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
780c60e475cSMatthew G. Knepley                  const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
78197b6e6e8SMatthew G. Knepley                  PetscReal, const PetscReal[], PetscInt, const PetscScalar[], PetscScalar[]);
782c60e475cSMatthew G. Knepley   void            **ctxs;
783c60e475cSMatthew G. Knepley   PetscInt          numFields;
784c60e475cSMatthew G. Knepley 
785c60e475cSMatthew G. Knepley   PetscFunctionBegin;
7865f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetNumFields(dm, &numFields));
7875f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscCalloc2(numFields,&funcs,numFields,&ctxs));
788c60e475cSMatthew G. Knepley   funcs[field] = func;
789c60e475cSMatthew G. Knepley   ctxs[field]  = ctx;
7905f80ce2aSJacob Faibussowitsch   CHKERRQ(DMProjectFieldLabelLocal(dm, time, label, numids, ids, Nc, comps, locU, funcs, INSERT_BC_VALUES, locX));
7915f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree2(funcs,ctxs));
792c60e475cSMatthew G. Knepley   PetscFunctionReturn(0);
793c60e475cSMatthew G. Knepley }
794c60e475cSMatthew G. Knepley 
795b278463cSMatthew G. Knepley /*@C
796ece3a9fcSMatthew G. Knepley   DMPlexInsertBoundaryValuesEssentialBdField - Insert boundary values into a local vector using a function of the coodinates and boundary field data
797ece3a9fcSMatthew G. Knepley 
798ece3a9fcSMatthew G. Knepley   Collective on dm
799ece3a9fcSMatthew G. Knepley 
800ece3a9fcSMatthew G. Knepley   Input Parameters:
801ece3a9fcSMatthew G. Knepley + dm     - The DM, with a PetscDS that matches the problem being constrained
802ece3a9fcSMatthew G. Knepley . time   - The time
803ece3a9fcSMatthew G. Knepley . locU   - A local vector with the input solution values
804ece3a9fcSMatthew G. Knepley . field  - The field to constrain
805ece3a9fcSMatthew G. Knepley . Nc     - The number of constrained field components, or 0 for all components
806ece3a9fcSMatthew G. Knepley . comps  - An array of constrained component numbers, or NULL for all components
807ece3a9fcSMatthew G. Knepley . label  - The DMLabel defining constrained points
808ece3a9fcSMatthew G. Knepley . numids - The number of DMLabel ids for constrained points
809ece3a9fcSMatthew G. Knepley . ids    - An array of ids for constrained points
810ece3a9fcSMatthew G. Knepley . func   - A pointwise function giving boundary values, the calling sequence is given in DMProjectBdFieldLabelLocal()
811ece3a9fcSMatthew G. Knepley - ctx    - An optional user context for bcFunc
812ece3a9fcSMatthew G. Knepley 
813ece3a9fcSMatthew G. Knepley   Output Parameter:
814ece3a9fcSMatthew G. Knepley . locX   - A local vector to receive the boundary values
815ece3a9fcSMatthew G. Knepley 
816ece3a9fcSMatthew G. Knepley   Level: developer
817ece3a9fcSMatthew G. Knepley 
818ece3a9fcSMatthew G. Knepley .seealso: DMProjectBdFieldLabelLocal(), DMPlexInsertBoundaryValuesEssential(), DMPlexInsertBoundaryValuesEssentialField(), DMAddBoundary()
819ece3a9fcSMatthew G. Knepley @*/
820ece3a9fcSMatthew G. Knepley PetscErrorCode DMPlexInsertBoundaryValuesEssentialBdField(DM dm, PetscReal time, Vec locU, PetscInt field, PetscInt Nc, const PetscInt comps[], DMLabel label, PetscInt numids, const PetscInt ids[],
821ece3a9fcSMatthew G. Knepley                                                           void (*func)(PetscInt, PetscInt, PetscInt,
822ece3a9fcSMatthew G. Knepley                                                                        const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
823ece3a9fcSMatthew G. Knepley                                                                        const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
824ece3a9fcSMatthew G. Knepley                                                                        PetscReal, const PetscReal[], const PetscReal[], PetscInt, const PetscScalar[],
825ece3a9fcSMatthew G. Knepley                                                                        PetscScalar[]),
826ece3a9fcSMatthew G. Knepley                                                           void *ctx, Vec locX)
827ece3a9fcSMatthew G. Knepley {
828ece3a9fcSMatthew G. Knepley   void (**funcs)(PetscInt, PetscInt, PetscInt,
829ece3a9fcSMatthew G. Knepley                  const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
830ece3a9fcSMatthew G. Knepley                  const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
831ece3a9fcSMatthew G. Knepley                  PetscReal, const PetscReal[], const PetscReal[], PetscInt, const PetscScalar[], PetscScalar[]);
832ece3a9fcSMatthew G. Knepley   void            **ctxs;
833ece3a9fcSMatthew G. Knepley   PetscInt          numFields;
834ece3a9fcSMatthew G. Knepley 
835ece3a9fcSMatthew G. Knepley   PetscFunctionBegin;
8365f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetNumFields(dm, &numFields));
8375f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscCalloc2(numFields,&funcs,numFields,&ctxs));
838ece3a9fcSMatthew G. Knepley   funcs[field] = func;
839ece3a9fcSMatthew G. Knepley   ctxs[field]  = ctx;
8405f80ce2aSJacob Faibussowitsch   CHKERRQ(DMProjectBdFieldLabelLocal(dm, time, label, numids, ids, Nc, comps, locU, funcs, INSERT_BC_VALUES, locX));
8415f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree2(funcs,ctxs));
842ece3a9fcSMatthew G. Knepley   PetscFunctionReturn(0);
843ece3a9fcSMatthew G. Knepley }
844ece3a9fcSMatthew G. Knepley 
845ece3a9fcSMatthew G. Knepley /*@C
846b278463cSMatthew G. Knepley   DMPlexInsertBoundaryValuesRiemann - Insert boundary values into a local vector
847b278463cSMatthew G. Knepley 
848b278463cSMatthew G. Knepley   Input Parameters:
849b278463cSMatthew G. Knepley + dm     - The DM, with a PetscDS that matches the problem being constrained
850b278463cSMatthew G. Knepley . time   - The time
851b278463cSMatthew G. Knepley . faceGeometry - A vector with the FVM face geometry information
852b278463cSMatthew G. Knepley . cellGeometry - A vector with the FVM cell geometry information
853b278463cSMatthew G. Knepley . Grad         - A vector with the FVM cell gradient information
854b278463cSMatthew G. Knepley . field  - The field to constrain
8551c531cf8SMatthew G. Knepley . Nc     - The number of constrained field components, or 0 for all components
8561c531cf8SMatthew G. Knepley . comps  - An array of constrained component numbers, or NULL for all components
857b278463cSMatthew G. Knepley . label  - The DMLabel defining constrained points
858b278463cSMatthew G. Knepley . numids - The number of DMLabel ids for constrained points
859b278463cSMatthew G. Knepley . ids    - An array of ids for constrained points
860b278463cSMatthew G. Knepley . func   - A pointwise function giving boundary values
861b278463cSMatthew G. Knepley - ctx    - An optional user context for bcFunc
862b278463cSMatthew G. Knepley 
863b278463cSMatthew G. Knepley   Output Parameter:
864b278463cSMatthew G. Knepley . locX   - A local vector to receives the boundary values
865b278463cSMatthew G. Knepley 
866b278463cSMatthew G. Knepley   Note: This implementation currently ignores the numcomps/comps argument from DMAddBoundary()
867b278463cSMatthew G. Knepley 
868b278463cSMatthew G. Knepley   Level: developer
869b278463cSMatthew G. Knepley 
870b278463cSMatthew G. Knepley .seealso: DMPlexInsertBoundaryValuesEssential(), DMPlexInsertBoundaryValuesEssentialField(), DMAddBoundary()
871b278463cSMatthew G. Knepley @*/
8721c531cf8SMatthew G. Knepley PetscErrorCode DMPlexInsertBoundaryValuesRiemann(DM dm, PetscReal time, Vec faceGeometry, Vec cellGeometry, Vec Grad, PetscInt field, PetscInt Nc, const PetscInt comps[], DMLabel label, PetscInt numids, const PetscInt ids[],
873b278463cSMatthew G. Knepley                                                  PetscErrorCode (*func)(PetscReal,const PetscReal*,const PetscReal*,const PetscScalar*,PetscScalar*,void*), void *ctx, Vec locX)
874d7ddef95SMatthew G. Knepley {
87561f58d28SMatthew G. Knepley   PetscDS            prob;
876da97024aSMatthew G. Knepley   PetscSF            sf;
877d7ddef95SMatthew G. Knepley   DM                 dmFace, dmCell, dmGrad;
87820369375SToby Isaac   const PetscScalar *facegeom, *cellgeom = NULL, *grad;
879da97024aSMatthew G. Knepley   const PetscInt    *leaves;
880d7ddef95SMatthew G. Knepley   PetscScalar       *x, *fx;
881520b3818SMatthew G. Knepley   PetscInt           dim, nleaves, loc, fStart, fEnd, pdim, i;
8825f80ce2aSJacob Faibussowitsch   PetscErrorCode     ierru = 0;
883d7ddef95SMatthew G. Knepley 
884d7ddef95SMatthew G. Knepley   PetscFunctionBegin;
8855f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetPointSF(dm, &sf));
8865f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSFGetGraph(sf, NULL, &nleaves, &leaves, NULL));
887da97024aSMatthew G. Knepley   nleaves = PetscMax(0, nleaves);
8885f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dm, &dim));
8895f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetHeightStratum(dm, 1, &fStart, &fEnd));
8905f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDS(dm, &prob));
8915f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetDM(faceGeometry, &dmFace));
8925f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetArrayRead(faceGeometry, &facegeom));
89320369375SToby Isaac   if (cellGeometry) {
8945f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetDM(cellGeometry, &dmCell));
8955f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetArrayRead(cellGeometry, &cellgeom));
89620369375SToby Isaac   }
897d7ddef95SMatthew G. Knepley   if (Grad) {
898c0a6632aSMatthew G. Knepley     PetscFV fv;
899c0a6632aSMatthew G. Knepley 
9005f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, field, (PetscObject *) &fv));
9015f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetDM(Grad, &dmGrad));
9025f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetArrayRead(Grad, &grad));
9035f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFVGetNumComponents(fv, &pdim));
9045f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetWorkArray(dm, pdim, MPIU_SCALAR, &fx));
905d7ddef95SMatthew G. Knepley   }
9065f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetArray(locX, &x));
907d7ddef95SMatthew G. Knepley   for (i = 0; i < numids; ++i) {
908d7ddef95SMatthew G. Knepley     IS              faceIS;
909d7ddef95SMatthew G. Knepley     const PetscInt *faces;
910d7ddef95SMatthew G. Knepley     PetscInt        numFaces, f;
911d7ddef95SMatthew G. Knepley 
9125f80ce2aSJacob Faibussowitsch     CHKERRQ(DMLabelGetStratumIS(label, ids[i], &faceIS));
913d7ddef95SMatthew G. Knepley     if (!faceIS) continue; /* No points with that id on this process */
9145f80ce2aSJacob Faibussowitsch     CHKERRQ(ISGetLocalSize(faceIS, &numFaces));
9155f80ce2aSJacob Faibussowitsch     CHKERRQ(ISGetIndices(faceIS, &faces));
916d7ddef95SMatthew G. Knepley     for (f = 0; f < numFaces; ++f) {
917d7ddef95SMatthew G. Knepley       const PetscInt         face = faces[f], *cells;
918640bce14SSatish Balay       PetscFVFaceGeom        *fg;
919d7ddef95SMatthew G. Knepley 
920d7ddef95SMatthew G. Knepley       if ((face < fStart) || (face >= fEnd)) continue; /* Refinement adds non-faces to labels */
9215f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFindInt(face, nleaves, (PetscInt *) leaves, &loc));
922da97024aSMatthew G. Knepley       if (loc >= 0) continue;
9235f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexPointLocalRead(dmFace, face, facegeom, &fg));
9245f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetSupport(dm, face, &cells));
925d7ddef95SMatthew G. Knepley       if (Grad) {
926640bce14SSatish Balay         PetscFVCellGeom       *cg;
927640bce14SSatish Balay         PetscScalar           *cx, *cgrad;
928d7ddef95SMatthew G. Knepley         PetscScalar           *xG;
929d7ddef95SMatthew G. Knepley         PetscReal              dx[3];
930d7ddef95SMatthew G. Knepley         PetscInt               d;
931d7ddef95SMatthew G. Knepley 
9325f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexPointLocalRead(dmCell, cells[0], cellgeom, &cg));
9335f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexPointLocalRead(dm, cells[0], x, &cx));
9345f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexPointLocalRead(dmGrad, cells[0], grad, &cgrad));
9355f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexPointLocalFieldRef(dm, cells[1], field, x, &xG));
936d7ddef95SMatthew G. Knepley         DMPlex_WaxpyD_Internal(dim, -1, cg->centroid, fg->centroid, dx);
937d7ddef95SMatthew G. Knepley         for (d = 0; d < pdim; ++d) fx[d] = cx[d] + DMPlex_DotD_Internal(dim, &cgrad[d*dim], dx);
9385f80ce2aSJacob Faibussowitsch         CHKERRQ((*func)(time, fg->centroid, fg->normal, fx, xG, ctx));
939d7ddef95SMatthew G. Knepley       } else {
940640bce14SSatish Balay         PetscScalar *xI;
941d7ddef95SMatthew G. Knepley         PetscScalar *xG;
942d7ddef95SMatthew G. Knepley 
9435f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexPointLocalRead(dm, cells[0], x, &xI));
9445f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexPointLocalFieldRef(dm, cells[1], field, x, &xG));
945e735a8a9SMatthew G. Knepley         ierru = (*func)(time, fg->centroid, fg->normal, xI, xG, ctx);
946e735a8a9SMatthew G. Knepley         if (ierru) {
9475f80ce2aSJacob Faibussowitsch           CHKERRQ(ISRestoreIndices(faceIS, &faces));
9485f80ce2aSJacob Faibussowitsch           CHKERRQ(ISDestroy(&faceIS));
949e735a8a9SMatthew G. Knepley           goto cleanup;
950e735a8a9SMatthew G. Knepley         }
951d7ddef95SMatthew G. Knepley       }
952d7ddef95SMatthew G. Knepley     }
9535f80ce2aSJacob Faibussowitsch     CHKERRQ(ISRestoreIndices(faceIS, &faces));
9545f80ce2aSJacob Faibussowitsch     CHKERRQ(ISDestroy(&faceIS));
955d7ddef95SMatthew G. Knepley   }
956e735a8a9SMatthew G. Knepley   cleanup:
9575f80ce2aSJacob Faibussowitsch   CHKERRQ(VecRestoreArray(locX, &x));
958d7ddef95SMatthew G. Knepley   if (Grad) {
9595f80ce2aSJacob Faibussowitsch     CHKERRQ(DMRestoreWorkArray(dm, pdim, MPIU_SCALAR, &fx));
9605f80ce2aSJacob Faibussowitsch     CHKERRQ(VecRestoreArrayRead(Grad, &grad));
961d7ddef95SMatthew G. Knepley   }
9625f80ce2aSJacob Faibussowitsch   if (cellGeometry) CHKERRQ(VecRestoreArrayRead(cellGeometry, &cellgeom));
9635f80ce2aSJacob Faibussowitsch   CHKERRQ(VecRestoreArrayRead(faceGeometry, &facegeom));
964e735a8a9SMatthew G. Knepley   CHKERRQ(ierru);
965d7ddef95SMatthew G. Knepley   PetscFunctionReturn(0);
966d7ddef95SMatthew G. Knepley }
967d7ddef95SMatthew G. Knepley 
9680c364540SMatthew G. Knepley static PetscErrorCode zero(PetscInt dim, PetscReal time, const PetscReal x[], PetscInt Nc, PetscScalar *u, void *ctx)
9690c364540SMatthew G. Knepley {
9700c364540SMatthew G. Knepley   PetscInt c;
9710c364540SMatthew G. Knepley   for (c = 0; c < Nc; ++c) u[c] = 0.0;
9720c364540SMatthew G. Knepley   return 0;
9730c364540SMatthew G. Knepley }
9740c364540SMatthew G. Knepley 
975f1d73a7aSMatthew G. Knepley PetscErrorCode DMPlexInsertBoundaryValues_Plex(DM dm, PetscBool insertEssential, Vec locX, PetscReal time, Vec faceGeomFVM, Vec cellGeomFVM, Vec gradFVM)
976d7ddef95SMatthew G. Knepley {
9770c364540SMatthew G. Knepley   PetscObject    isZero;
978e5e52638SMatthew G. Knepley   PetscDS        prob;
979d7ddef95SMatthew G. Knepley   PetscInt       numBd, b;
98055f2e967SMatthew G. Knepley 
98155f2e967SMatthew G. Knepley   PetscFunctionBegin;
9825f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDS(dm, &prob));
9835f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetNumBoundary(prob, &numBd));
9845f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscObjectQuery((PetscObject) locX, "__Vec_bc_zero__", &isZero));
98555f2e967SMatthew G. Knepley   for (b = 0; b < numBd; ++b) {
98645480ffeSMatthew G. Knepley     PetscWeakForm           wf;
987f971fd6bSMatthew G. Knepley     DMBoundaryConditionType type;
98845480ffeSMatthew G. Knepley     const char             *name;
989d7ddef95SMatthew G. Knepley     DMLabel                 label;
9901c531cf8SMatthew G. Knepley     PetscInt                field, Nc;
9911c531cf8SMatthew G. Knepley     const PetscInt         *comps;
992d7ddef95SMatthew G. Knepley     PetscObject             obj;
993d7ddef95SMatthew G. Knepley     PetscClassId            id;
99445480ffeSMatthew G. Knepley     void                  (*bvfunc)(void);
995d7ddef95SMatthew G. Knepley     PetscInt                numids;
996d7ddef95SMatthew G. Knepley     const PetscInt         *ids;
99755f2e967SMatthew G. Knepley     void                   *ctx;
99855f2e967SMatthew G. Knepley 
9995f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetBoundary(prob, b, &wf, &type, &name, &label, &numids, &ids, &field, &Nc, &comps, &bvfunc, NULL, &ctx));
1000f971fd6bSMatthew G. Knepley     if (insertEssential != (type & DM_BC_ESSENTIAL)) continue;
10015f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetField(dm, field, NULL, &obj));
10025f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
1003d7ddef95SMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
1004c60e475cSMatthew G. Knepley       switch (type) {
1005c60e475cSMatthew G. Knepley         /* for FEM, there is no insertion to be done for non-essential boundary conditions */
1006c60e475cSMatthew G. Knepley       case DM_BC_ESSENTIAL:
100745480ffeSMatthew G. Knepley         {
100845480ffeSMatthew G. Knepley           PetscSimplePointFunc func = (PetscSimplePointFunc) bvfunc;
100945480ffeSMatthew G. Knepley 
101045480ffeSMatthew G. Knepley           if (isZero) func = zero;
10115f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexLabelAddCells(dm,label));
10125f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexInsertBoundaryValuesEssential(dm, time, field, Nc, comps, label, numids, ids, func, ctx, locX));
10135f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexLabelClearCells(dm,label));
101445480ffeSMatthew G. Knepley         }
1015c60e475cSMatthew G. Knepley         break;
1016c60e475cSMatthew G. Knepley       case DM_BC_ESSENTIAL_FIELD:
101745480ffeSMatthew G. Knepley         {
101845480ffeSMatthew G. Knepley           PetscPointFunc func = (PetscPointFunc) bvfunc;
101945480ffeSMatthew G. Knepley 
10205f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexLabelAddCells(dm,label));
10215f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexInsertBoundaryValuesEssentialField(dm, time, locX, field, Nc, comps, label, numids, ids, func, ctx, locX));
10225f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexLabelClearCells(dm,label));
102345480ffeSMatthew G. Knepley         }
1024c60e475cSMatthew G. Knepley         break;
1025c60e475cSMatthew G. Knepley       default: break;
1026c60e475cSMatthew G. Knepley       }
1027d7ddef95SMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
102845480ffeSMatthew G. Knepley       {
102945480ffeSMatthew G. Knepley         PetscErrorCode (*func)(PetscReal,const PetscReal*,const PetscReal*,const PetscScalar*,PetscScalar*,void*) = (PetscErrorCode (*)(PetscReal,const PetscReal*,const PetscReal*,const PetscScalar*,PetscScalar*,void*)) bvfunc;
103045480ffeSMatthew G. Knepley 
103143ea7facSMatthew G. Knepley         if (!faceGeomFVM) continue;
10325f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexInsertBoundaryValuesRiemann(dm, time, faceGeomFVM, cellGeomFVM, gradFVM, field, Nc, comps, label, numids, ids, func, ctx, locX));
103345480ffeSMatthew G. Knepley       }
103498921bdaSJacob Faibussowitsch     } else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", field);
103555f2e967SMatthew G. Knepley   }
103655f2e967SMatthew G. Knepley   PetscFunctionReturn(0);
103755f2e967SMatthew G. Knepley }
103855f2e967SMatthew G. Knepley 
103956cf3b9cSMatthew G. Knepley PetscErrorCode DMPlexInsertTimeDerivativeBoundaryValues_Plex(DM dm, PetscBool insertEssential, Vec locX, PetscReal time, Vec faceGeomFVM, Vec cellGeomFVM, Vec gradFVM)
104056cf3b9cSMatthew G. Knepley {
104156cf3b9cSMatthew G. Knepley   PetscObject    isZero;
104256cf3b9cSMatthew G. Knepley   PetscDS        prob;
104356cf3b9cSMatthew G. Knepley   PetscInt       numBd, b;
104456cf3b9cSMatthew G. Knepley 
104556cf3b9cSMatthew G. Knepley   PetscFunctionBegin;
104656cf3b9cSMatthew G. Knepley   if (!locX) PetscFunctionReturn(0);
10475f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDS(dm, &prob));
10485f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetNumBoundary(prob, &numBd));
10495f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscObjectQuery((PetscObject) locX, "__Vec_bc_zero__", &isZero));
105056cf3b9cSMatthew G. Knepley   for (b = 0; b < numBd; ++b) {
105145480ffeSMatthew G. Knepley     PetscWeakForm           wf;
105256cf3b9cSMatthew G. Knepley     DMBoundaryConditionType type;
105345480ffeSMatthew G. Knepley     const char             *name;
105456cf3b9cSMatthew G. Knepley     DMLabel                 label;
105556cf3b9cSMatthew G. Knepley     PetscInt                field, Nc;
105656cf3b9cSMatthew G. Knepley     const PetscInt         *comps;
105756cf3b9cSMatthew G. Knepley     PetscObject             obj;
105856cf3b9cSMatthew G. Knepley     PetscClassId            id;
105956cf3b9cSMatthew G. Knepley     PetscInt                numids;
106056cf3b9cSMatthew G. Knepley     const PetscInt         *ids;
106145480ffeSMatthew G. Knepley     void                  (*bvfunc)(void);
106256cf3b9cSMatthew G. Knepley     void                   *ctx;
106356cf3b9cSMatthew G. Knepley 
10645f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetBoundary(prob, b, &wf, &type, &name, &label, &numids, &ids, &field, &Nc, &comps, NULL, &bvfunc, &ctx));
106556cf3b9cSMatthew G. Knepley     if (insertEssential != (type & DM_BC_ESSENTIAL)) continue;
10665f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetField(dm, field, NULL, &obj));
10675f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
106856cf3b9cSMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
106956cf3b9cSMatthew G. Knepley       switch (type) {
107056cf3b9cSMatthew G. Knepley         /* for FEM, there is no insertion to be done for non-essential boundary conditions */
107156cf3b9cSMatthew G. Knepley       case DM_BC_ESSENTIAL:
107245480ffeSMatthew G. Knepley         {
107345480ffeSMatthew G. Knepley           PetscSimplePointFunc func_t = (PetscSimplePointFunc) bvfunc;
107445480ffeSMatthew G. Knepley 
107545480ffeSMatthew G. Knepley           if (isZero) func_t = zero;
10765f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexLabelAddCells(dm,label));
10775f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexInsertBoundaryValuesEssential(dm, time, field, Nc, comps, label, numids, ids, func_t, ctx, locX));
10785f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexLabelClearCells(dm,label));
107945480ffeSMatthew G. Knepley         }
108056cf3b9cSMatthew G. Knepley         break;
108156cf3b9cSMatthew G. Knepley       case DM_BC_ESSENTIAL_FIELD:
108245480ffeSMatthew G. Knepley         {
108345480ffeSMatthew G. Knepley           PetscPointFunc func_t = (PetscPointFunc) bvfunc;
108445480ffeSMatthew G. Knepley 
10855f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexLabelAddCells(dm,label));
10865f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexInsertBoundaryValuesEssentialField(dm, time, locX, field, Nc, comps, label, numids, ids, func_t, ctx, locX));
10875f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexLabelClearCells(dm,label));
108845480ffeSMatthew G. Knepley         }
108956cf3b9cSMatthew G. Knepley         break;
109056cf3b9cSMatthew G. Knepley       default: break;
109156cf3b9cSMatthew G. Knepley       }
109298921bdaSJacob Faibussowitsch     } else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", field);
109356cf3b9cSMatthew G. Knepley   }
109456cf3b9cSMatthew G. Knepley   PetscFunctionReturn(0);
109556cf3b9cSMatthew G. Knepley }
109656cf3b9cSMatthew G. Knepley 
1097f1d73a7aSMatthew G. Knepley /*@
1098f1d73a7aSMatthew G. Knepley   DMPlexInsertBoundaryValues - Puts coefficients which represent boundary values into the local solution vector
1099f1d73a7aSMatthew G. Knepley 
1100ed808b8fSJed Brown   Not Collective
1101ed808b8fSJed Brown 
1102f1d73a7aSMatthew G. Knepley   Input Parameters:
1103f1d73a7aSMatthew G. Knepley + dm - The DM
1104f1d73a7aSMatthew G. Knepley . insertEssential - Should I insert essential (e.g. Dirichlet) or inessential (e.g. Neumann) boundary conditions
1105f1d73a7aSMatthew G. Knepley . time - The time
1106f1d73a7aSMatthew G. Knepley . faceGeomFVM - Face geometry data for FV discretizations
1107f1d73a7aSMatthew G. Knepley . cellGeomFVM - Cell geometry data for FV discretizations
1108f1d73a7aSMatthew G. Knepley - gradFVM - Gradient reconstruction data for FV discretizations
1109f1d73a7aSMatthew G. Knepley 
1110f1d73a7aSMatthew G. Knepley   Output Parameters:
1111f1d73a7aSMatthew G. Knepley . locX - Solution updated with boundary values
1112f1d73a7aSMatthew G. Knepley 
1113ed808b8fSJed Brown   Level: intermediate
1114f1d73a7aSMatthew G. Knepley 
1115ed808b8fSJed Brown .seealso: DMProjectFunctionLabelLocal(), DMAddBoundary()
1116f1d73a7aSMatthew G. Knepley @*/
1117f1d73a7aSMatthew G. Knepley PetscErrorCode DMPlexInsertBoundaryValues(DM dm, PetscBool insertEssential, Vec locX, PetscReal time, Vec faceGeomFVM, Vec cellGeomFVM, Vec gradFVM)
1118f1d73a7aSMatthew G. Knepley {
1119f1d73a7aSMatthew G. Knepley   PetscFunctionBegin;
1120f1d73a7aSMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
1121064a246eSJacob Faibussowitsch   PetscValidHeaderSpecific(locX, VEC_CLASSID, 3);
1122064a246eSJacob Faibussowitsch   if (faceGeomFVM) {PetscValidHeaderSpecific(faceGeomFVM, VEC_CLASSID, 5);}
1123064a246eSJacob Faibussowitsch   if (cellGeomFVM) {PetscValidHeaderSpecific(cellGeomFVM, VEC_CLASSID, 6);}
1124064a246eSJacob Faibussowitsch   if (gradFVM)     {PetscValidHeaderSpecific(gradFVM, VEC_CLASSID, 7);}
11255f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscTryMethod(dm,"DMPlexInsertBoundaryValues_C",(DM,PetscBool,Vec,PetscReal,Vec,Vec,Vec),(dm,insertEssential,locX,time,faceGeomFVM,cellGeomFVM,gradFVM)));
1126f1d73a7aSMatthew G. Knepley   PetscFunctionReturn(0);
1127f1d73a7aSMatthew G. Knepley }
1128f1d73a7aSMatthew G. Knepley 
112956cf3b9cSMatthew G. Knepley /*@
1130a5b23f4aSJose E. Roman   DMPlexInsertTimeDerivativeBoundaryValues - Puts coefficients which represent boundary values of the time derivative into the local solution vector
113156cf3b9cSMatthew G. Knepley 
113256cf3b9cSMatthew G. Knepley   Input Parameters:
113356cf3b9cSMatthew G. Knepley + dm - The DM
113456cf3b9cSMatthew G. Knepley . insertEssential - Should I insert essential (e.g. Dirichlet) or inessential (e.g. Neumann) boundary conditions
113556cf3b9cSMatthew G. Knepley . time - The time
113656cf3b9cSMatthew G. Knepley . faceGeomFVM - Face geometry data for FV discretizations
113756cf3b9cSMatthew G. Knepley . cellGeomFVM - Cell geometry data for FV discretizations
113856cf3b9cSMatthew G. Knepley - gradFVM - Gradient reconstruction data for FV discretizations
113956cf3b9cSMatthew G. Knepley 
114056cf3b9cSMatthew G. Knepley   Output Parameters:
114156cf3b9cSMatthew G. Knepley . locX_t - Solution updated with boundary values
114256cf3b9cSMatthew G. Knepley 
114356cf3b9cSMatthew G. Knepley   Level: developer
114456cf3b9cSMatthew G. Knepley 
114556cf3b9cSMatthew G. Knepley .seealso: DMProjectFunctionLabelLocal()
114656cf3b9cSMatthew G. Knepley @*/
114756cf3b9cSMatthew G. Knepley PetscErrorCode DMPlexInsertTimeDerivativeBoundaryValues(DM dm, PetscBool insertEssential, Vec locX_t, PetscReal time, Vec faceGeomFVM, Vec cellGeomFVM, Vec gradFVM)
114856cf3b9cSMatthew G. Knepley {
114956cf3b9cSMatthew G. Knepley   PetscFunctionBegin;
115056cf3b9cSMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
1151064a246eSJacob Faibussowitsch   if (locX_t)      {PetscValidHeaderSpecific(locX_t, VEC_CLASSID, 3);}
1152064a246eSJacob Faibussowitsch   if (faceGeomFVM) {PetscValidHeaderSpecific(faceGeomFVM, VEC_CLASSID, 5);}
1153064a246eSJacob Faibussowitsch   if (cellGeomFVM) {PetscValidHeaderSpecific(cellGeomFVM, VEC_CLASSID, 6);}
1154064a246eSJacob Faibussowitsch   if (gradFVM)     {PetscValidHeaderSpecific(gradFVM, VEC_CLASSID, 7);}
11555f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscTryMethod(dm,"DMPlexInsertTimeDerviativeBoundaryValues_C",(DM,PetscBool,Vec,PetscReal,Vec,Vec,Vec),(dm,insertEssential,locX_t,time,faceGeomFVM,cellGeomFVM,gradFVM)));
115656cf3b9cSMatthew G. Knepley   PetscFunctionReturn(0);
115756cf3b9cSMatthew G. Knepley }
115856cf3b9cSMatthew G. Knepley 
11590709b2feSToby Isaac PetscErrorCode DMComputeL2Diff_Plex(DM dm, PetscReal time, PetscErrorCode (**funcs)(PetscInt, PetscReal, const PetscReal [], PetscInt, PetscScalar *, void *), void **ctxs, Vec X, PetscReal *diff)
1160cb1e1211SMatthew G Knepley {
1161574a98acSMatthew G. Knepley   Vec              localX;
1162574a98acSMatthew G. Knepley 
1163574a98acSMatthew G. Knepley   PetscFunctionBegin;
11645f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalVector(dm, &localX));
11655f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexInsertBoundaryValues(dm, PETSC_TRUE, localX, time, NULL, NULL, NULL));
11665f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGlobalToLocalBegin(dm, X, INSERT_VALUES, localX));
11675f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGlobalToLocalEnd(dm, X, INSERT_VALUES, localX));
11685f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexComputeL2DiffLocal(dm, time, funcs, ctxs, localX, diff));
11695f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreLocalVector(dm, &localX));
1170574a98acSMatthew G. Knepley   PetscFunctionReturn(0);
1171574a98acSMatthew G. Knepley }
1172574a98acSMatthew G. Knepley 
1173574a98acSMatthew G. Knepley /*@C
1174ca3d3a14SMatthew G. Knepley   DMComputeL2DiffLocal - This function computes the L_2 difference between a function u and an FEM interpolant solution u_h.
1175574a98acSMatthew G. Knepley 
1176d083f849SBarry Smith   Collective on dm
1177c0f8e1fdSMatthew G. Knepley 
1178574a98acSMatthew G. Knepley   Input Parameters:
1179574a98acSMatthew G. Knepley + dm     - The DM
1180574a98acSMatthew G. Knepley . time   - The time
1181574a98acSMatthew G. Knepley . funcs  - The functions to evaluate for each field component
1182574a98acSMatthew G. Knepley . ctxs   - Optional array of contexts to pass to each function, or NULL.
1183574a98acSMatthew G. Knepley - localX - The coefficient vector u_h, a local vector
1184574a98acSMatthew G. Knepley 
1185574a98acSMatthew G. Knepley   Output Parameter:
1186574a98acSMatthew G. Knepley . diff - The diff ||u - u_h||_2
1187574a98acSMatthew G. Knepley 
1188574a98acSMatthew G. Knepley   Level: developer
1189574a98acSMatthew G. Knepley 
1190574a98acSMatthew G. Knepley .seealso: DMProjectFunction(), DMComputeL2FieldDiff(), DMComputeL2GradientDiff()
1191574a98acSMatthew G. Knepley @*/
1192574a98acSMatthew G. Knepley PetscErrorCode DMPlexComputeL2DiffLocal(DM dm, PetscReal time, PetscErrorCode (**funcs)(PetscInt, PetscReal, const PetscReal [], PetscInt, PetscScalar *, void *), void **ctxs, Vec localX, PetscReal *diff)
1193574a98acSMatthew G. Knepley {
11940f09c10fSMatthew G. Knepley   const PetscInt   debug = ((DM_Plex*)dm->data)->printL2;
1195ca3d3a14SMatthew G. Knepley   DM               tdm;
1196ca3d3a14SMatthew G. Knepley   Vec              tv;
1197cb1e1211SMatthew G Knepley   PetscSection     section;
1198c5bbbd5bSMatthew G. Knepley   PetscQuadrature  quad;
11994bee2e38SMatthew G. Knepley   PetscFEGeom      fegeom;
120015496722SMatthew G. Knepley   PetscScalar     *funcVal, *interpolant;
12014bee2e38SMatthew G. Knepley   PetscReal       *coords, *gcoords;
1202cb1e1211SMatthew G Knepley   PetscReal        localDiff = 0.0;
12037318780aSToby Isaac   const PetscReal *quadWeights;
1204412e9a14SMatthew G. Knepley   PetscInt         dim, coordDim, numFields, numComponents = 0, qNc, Nq, cellHeight, cStart, cEnd, c, field, fieldOffset;
1205ca3d3a14SMatthew G. Knepley   PetscBool        transform;
1206cb1e1211SMatthew G Knepley   PetscErrorCode   ierr;
1207cb1e1211SMatthew G Knepley 
1208cb1e1211SMatthew G Knepley   PetscFunctionBegin;
12095f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dm, &dim));
12105f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateDim(dm, &coordDim));
12112a4e142eSMatthew G. Knepley   fegeom.dimEmbed = coordDim;
12125f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &section));
12135f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetNumFields(section, &numFields));
12145f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetBasisTransformDM_Internal(dm, &tdm));
12155f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetBasisTransformVec_Internal(dm, &tv));
12165f80ce2aSJacob Faibussowitsch   CHKERRQ(DMHasBasisTransform(dm, &transform));
1217cb1e1211SMatthew G Knepley   for (field = 0; field < numFields; ++field) {
121815496722SMatthew G. Knepley     PetscObject  obj;
121915496722SMatthew G. Knepley     PetscClassId id;
1220c5bbbd5bSMatthew G. Knepley     PetscInt     Nc;
1221c5bbbd5bSMatthew G. Knepley 
12225f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetField(dm, field, NULL, &obj));
12235f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
122415496722SMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
122515496722SMatthew G. Knepley       PetscFE fe = (PetscFE) obj;
122615496722SMatthew G. Knepley 
12275f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetQuadrature(fe, &quad));
12285f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetNumComponents(fe, &Nc));
122915496722SMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
123015496722SMatthew G. Knepley       PetscFV fv = (PetscFV) obj;
123115496722SMatthew G. Knepley 
12325f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetQuadrature(fv, &quad));
12335f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetNumComponents(fv, &Nc));
123498921bdaSJacob Faibussowitsch     } else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", field);
1235c5bbbd5bSMatthew G. Knepley     numComponents += Nc;
1236cb1e1211SMatthew G Knepley   }
12375f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscQuadratureGetData(quad, NULL, &qNc, &Nq, NULL, &quadWeights));
12382c71b3e2SJacob Faibussowitsch   PetscCheckFalse((qNc != 1) && (qNc != numComponents),PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_SIZ, "Quadrature components %D != %D field components", qNc, numComponents);
12395f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc6(numComponents,&funcVal,numComponents,&interpolant,coordDim*Nq,&coords,Nq,&fegeom.detJ,coordDim*coordDim*Nq,&fegeom.J,coordDim*coordDim*Nq,&fegeom.invJ));
12405f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetVTKCellHeight(dm, &cellHeight));
12415f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetSimplexOrBoxCells(dm, cellHeight, &cStart, &cEnd));
1242cb1e1211SMatthew G Knepley   for (c = cStart; c < cEnd; ++c) {
1243a1e44745SMatthew G. Knepley     PetscScalar *x = NULL;
1244cb1e1211SMatthew G Knepley     PetscReal    elemDiff = 0.0;
12459c3cf19fSMatthew G. Knepley     PetscInt     qc = 0;
1246cb1e1211SMatthew G Knepley 
12475f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexComputeCellGeometryFEM(dm, c, quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
12485f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecGetClosure(dm, NULL, localX, c, NULL, &x));
1249cb1e1211SMatthew G Knepley 
125015496722SMatthew G. Knepley     for (field = 0, fieldOffset = 0; field < numFields; ++field) {
125115496722SMatthew G. Knepley       PetscObject  obj;
125215496722SMatthew G. Knepley       PetscClassId id;
1253c110b1eeSGeoffrey Irving       void * const ctx = ctxs ? ctxs[field] : NULL;
125415496722SMatthew G. Knepley       PetscInt     Nb, Nc, q, fc;
1255cb1e1211SMatthew G Knepley 
12565f80ce2aSJacob Faibussowitsch       CHKERRQ(DMGetField(dm, field, NULL, &obj));
12575f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscObjectGetClassId(obj, &id));
12585f80ce2aSJacob Faibussowitsch       if (id == PETSCFE_CLASSID)      {CHKERRQ(PetscFEGetNumComponents((PetscFE) obj, &Nc));CHKERRQ(PetscFEGetDimension((PetscFE) obj, &Nb));}
12595f80ce2aSJacob Faibussowitsch       else if (id == PETSCFV_CLASSID) {CHKERRQ(PetscFVGetNumComponents((PetscFV) obj, &Nc));Nb = 1;}
126098921bdaSJacob Faibussowitsch       else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", field);
1261cb1e1211SMatthew G Knepley       if (debug) {
1262cb1e1211SMatthew G Knepley         char title[1024];
12635f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscSNPrintf(title, 1023, "Solution for Field %D", field));
12645f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPrintCellVector(c, title, Nb, &x[fieldOffset]));
1265cb1e1211SMatthew G Knepley       }
12667318780aSToby Isaac       for (q = 0; q < Nq; ++q) {
12672a4e142eSMatthew G. Knepley         PetscFEGeom qgeom;
12682a4e142eSMatthew G. Knepley 
12692a4e142eSMatthew G. Knepley         qgeom.dimEmbed = fegeom.dimEmbed;
12702a4e142eSMatthew G. Knepley         qgeom.J        = &fegeom.J[q*coordDim*coordDim];
12712a4e142eSMatthew G. Knepley         qgeom.invJ     = &fegeom.invJ[q*coordDim*coordDim];
12722a4e142eSMatthew G. Knepley         qgeom.detJ     = &fegeom.detJ[q];
12735f80ce2aSJacob Faibussowitsch         PetscCheck(fegeom.detJ[q] > 0.0,PETSC_COMM_SELF, PETSC_ERR_ARG_OUTOFRANGE, "Invalid determinant %g for element %D, point %D", (double)fegeom.detJ[q], c, q);
1274d3a7d86cSMatthew G. Knepley         if (transform) {
1275d3a7d86cSMatthew G. Knepley           gcoords = &coords[coordDim*Nq];
12765f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexBasisTransformApplyReal_Internal(dm, &coords[coordDim*q], PETSC_TRUE, coordDim, &coords[coordDim*q], gcoords, dm->transformCtx));
1277d3a7d86cSMatthew G. Knepley         } else {
1278d3a7d86cSMatthew G. Knepley           gcoords = &coords[coordDim*q];
1279d3a7d86cSMatthew G. Knepley         }
12805f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscArrayzero(funcVal,Nc));
1281ca3d3a14SMatthew G. Knepley         ierr = (*funcs[field])(coordDim, time, gcoords, Nc, funcVal, ctx);
1282e735a8a9SMatthew G. Knepley         if (ierr) {
12835f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexVecRestoreClosure(dm, NULL, localX, c, NULL, &x));
12845f80ce2aSJacob Faibussowitsch           CHKERRQ(DMRestoreLocalVector(dm, &localX));
12855f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFree6(funcVal,interpolant,coords,fegeom.detJ,fegeom.J,fegeom.invJ));
1286e735a8a9SMatthew G. Knepley           CHKERRQ(ierr);
1287e735a8a9SMatthew G. Knepley         }
12885f80ce2aSJacob Faibussowitsch         if (transform) CHKERRQ(DMPlexBasisTransformApply_Internal(dm, &coords[coordDim*q], PETSC_FALSE, Nc, funcVal, funcVal, dm->transformCtx));
12895f80ce2aSJacob Faibussowitsch         if (id == PETSCFE_CLASSID)      CHKERRQ(PetscFEInterpolate_Static((PetscFE) obj, &x[fieldOffset], &qgeom, q, interpolant));
12905f80ce2aSJacob Faibussowitsch         else if (id == PETSCFV_CLASSID) CHKERRQ(PetscFVInterpolate_Static((PetscFV) obj, &x[fieldOffset], q, interpolant));
12912df84da0SMatthew G. Knepley         else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %" PetscInt_FMT, field);
129215496722SMatthew G. Knepley         for (fc = 0; fc < Nc; ++fc) {
1293beaa55a6SMatthew G. Knepley           const PetscReal wt = quadWeights[q*qNc+(qNc == 1 ? 0 : qc+fc)];
12945f80ce2aSJacob Faibussowitsch           if (debug) CHKERRQ(PetscPrintf(PETSC_COMM_SELF, "    elem %" PetscInt_FMT " field %" PetscInt_FMT ",%" PetscInt_FMT " point %g %g %g diff %g (%g, %g)\n", c, field, fc, (double)(coordDim > 0 ? coords[coordDim*q] : 0.), (double)(coordDim > 1 ? coords[coordDim*q+1] : 0.),(double)(coordDim > 2 ? coords[coordDim*q+2] : 0.), (double)(PetscSqr(PetscRealPart(interpolant[fc] - funcVal[fc]))*wt*fegeom.detJ[q]), PetscRealPart(interpolant[fc]), PetscRealPart(funcVal[fc])));
12954bee2e38SMatthew G. Knepley           elemDiff += PetscSqr(PetscRealPart(interpolant[fc] - funcVal[fc]))*wt*fegeom.detJ[q];
1296cb1e1211SMatthew G Knepley         }
1297cb1e1211SMatthew G Knepley       }
12989c3cf19fSMatthew G. Knepley       fieldOffset += Nb;
1299beaa55a6SMatthew G. Knepley       qc += Nc;
1300cb1e1211SMatthew G Knepley     }
13015f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecRestoreClosure(dm, NULL, localX, c, NULL, &x));
13025f80ce2aSJacob Faibussowitsch     if (debug) CHKERRQ(PetscPrintf(PETSC_COMM_SELF, "  elem %" PetscInt_FMT " diff %g\n", c, (double)elemDiff));
1303cb1e1211SMatthew G Knepley     localDiff += elemDiff;
1304cb1e1211SMatthew G Knepley   }
13055f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree6(funcVal,interpolant,coords,fegeom.detJ,fegeom.J,fegeom.invJ));
13065f80ce2aSJacob Faibussowitsch   CHKERRMPI(MPIU_Allreduce(&localDiff, diff, 1, MPIU_REAL, MPIU_SUM, PetscObjectComm((PetscObject)dm)));
1307cb1e1211SMatthew G Knepley   *diff = PetscSqrtReal(*diff);
1308cb1e1211SMatthew G Knepley   PetscFunctionReturn(0);
1309cb1e1211SMatthew G Knepley }
1310cb1e1211SMatthew G Knepley 
1311b698f381SToby Isaac PetscErrorCode DMComputeL2GradientDiff_Plex(DM dm, PetscReal time, PetscErrorCode (**funcs)(PetscInt, PetscReal, const PetscReal [], const PetscReal [], PetscInt, PetscScalar *, void *), void **ctxs, Vec X, const PetscReal n[], PetscReal *diff)
1312cb1e1211SMatthew G Knepley {
13130f09c10fSMatthew G. Knepley   const PetscInt   debug = ((DM_Plex*)dm->data)->printL2;
1314ca3d3a14SMatthew G. Knepley   DM               tdm;
1315cb1e1211SMatthew G Knepley   PetscSection     section;
131640e14135SMatthew G. Knepley   PetscQuadrature  quad;
1317ca3d3a14SMatthew G. Knepley   Vec              localX, tv;
13189c3cf19fSMatthew G. Knepley   PetscScalar     *funcVal, *interpolant;
13192a4e142eSMatthew G. Knepley   const PetscReal *quadWeights;
13204bee2e38SMatthew G. Knepley   PetscFEGeom      fegeom;
13214bee2e38SMatthew G. Knepley   PetscReal       *coords, *gcoords;
132240e14135SMatthew G. Knepley   PetscReal        localDiff = 0.0;
1323485ad865SMatthew G. Knepley   PetscInt         dim, coordDim, qNc = 0, Nq = 0, numFields, numComponents = 0, cStart, cEnd, c, field, fieldOffset;
1324ca3d3a14SMatthew G. Knepley   PetscBool        transform;
1325cb1e1211SMatthew G Knepley   PetscErrorCode   ierr;
1326cb1e1211SMatthew G Knepley 
1327cb1e1211SMatthew G Knepley   PetscFunctionBegin;
13285f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dm, &dim));
13295f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateDim(dm, &coordDim));
13304bee2e38SMatthew G. Knepley   fegeom.dimEmbed = coordDim;
13315f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &section));
13325f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetNumFields(section, &numFields));
13335f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalVector(dm, &localX));
13345f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGlobalToLocalBegin(dm, X, INSERT_VALUES, localX));
13355f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGlobalToLocalEnd(dm, X, INSERT_VALUES, localX));
13365f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetBasisTransformDM_Internal(dm, &tdm));
13375f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetBasisTransformVec_Internal(dm, &tv));
13385f80ce2aSJacob Faibussowitsch   CHKERRQ(DMHasBasisTransform(dm, &transform));
1339652b88e8SMatthew G. Knepley   for (field = 0; field < numFields; ++field) {
13400f2d7e86SMatthew G. Knepley     PetscFE  fe;
134140e14135SMatthew G. Knepley     PetscInt Nc;
1342652b88e8SMatthew G. Knepley 
13435f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetField(dm, field, NULL, (PetscObject *) &fe));
13445f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGetQuadrature(fe, &quad));
13455f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGetNumComponents(fe, &Nc));
134640e14135SMatthew G. Knepley     numComponents += Nc;
1347652b88e8SMatthew G. Knepley   }
13485f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscQuadratureGetData(quad, NULL, &qNc, &Nq, NULL, &quadWeights));
13492c71b3e2SJacob Faibussowitsch   PetscCheckFalse((qNc != 1) && (qNc != numComponents),PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_SIZ, "Quadrature components %D != %D field components", qNc, numComponents);
13505f80ce2aSJacob Faibussowitsch   /* CHKERRQ(DMProjectFunctionLocal(dm, fe, funcs, INSERT_BC_VALUES, localX)); */
13515f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc6(numComponents,&funcVal,coordDim*Nq,&coords,coordDim*coordDim*Nq,&fegeom.J,coordDim*coordDim*Nq,&fegeom.invJ,numComponents*coordDim,&interpolant,Nq,&fegeom.detJ));
13525f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetSimplexOrBoxCells(dm, 0, &cStart, &cEnd));
135340e14135SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
135440e14135SMatthew G. Knepley     PetscScalar *x = NULL;
135540e14135SMatthew G. Knepley     PetscReal    elemDiff = 0.0;
13569c3cf19fSMatthew G. Knepley     PetscInt     qc = 0;
1357652b88e8SMatthew G. Knepley 
13585f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexComputeCellGeometryFEM(dm, c, quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
13595f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecGetClosure(dm, NULL, localX, c, NULL, &x));
136040e14135SMatthew G. Knepley 
13619c3cf19fSMatthew G. Knepley     for (field = 0, fieldOffset = 0; field < numFields; ++field) {
13620f2d7e86SMatthew G. Knepley       PetscFE          fe;
136351259fa3SMatthew G. Knepley       void * const     ctx = ctxs ? ctxs[field] : NULL;
13649c3cf19fSMatthew G. Knepley       PetscInt         Nb, Nc, q, fc;
136540e14135SMatthew G. Knepley 
13665f80ce2aSJacob Faibussowitsch       CHKERRQ(DMGetField(dm, field, NULL, (PetscObject *) &fe));
13675f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetDimension(fe, &Nb));
13685f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetNumComponents(fe, &Nc));
136940e14135SMatthew G. Knepley       if (debug) {
137040e14135SMatthew G. Knepley         char title[1024];
13715f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscSNPrintf(title, 1023, "Solution for Field %" PetscInt_FMT, field));
13725f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPrintCellVector(c, title, Nb, &x[fieldOffset]));
1373652b88e8SMatthew G. Knepley       }
13749c3cf19fSMatthew G. Knepley       for (q = 0; q < Nq; ++q) {
13752a4e142eSMatthew G. Knepley         PetscFEGeom qgeom;
13762a4e142eSMatthew G. Knepley 
13772a4e142eSMatthew G. Knepley         qgeom.dimEmbed = fegeom.dimEmbed;
13782a4e142eSMatthew G. Knepley         qgeom.J        = &fegeom.J[q*coordDim*coordDim];
13792a4e142eSMatthew G. Knepley         qgeom.invJ     = &fegeom.invJ[q*coordDim*coordDim];
13802a4e142eSMatthew G. Knepley         qgeom.detJ     = &fegeom.detJ[q];
13812df84da0SMatthew G. Knepley         PetscCheck(fegeom.detJ[q] > 0.0, PETSC_COMM_SELF, PETSC_ERR_ARG_OUTOFRANGE, "Invalid determinant %g for element %" PetscInt_FMT ", quadrature points %" PetscInt_FMT, (double)fegeom.detJ[q], c, q);
1382d3a7d86cSMatthew G. Knepley         if (transform) {
1383d3a7d86cSMatthew G. Knepley           gcoords = &coords[coordDim*Nq];
13845f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexBasisTransformApplyReal_Internal(dm, &coords[coordDim*q], PETSC_TRUE, coordDim, &coords[coordDim*q], gcoords, dm->transformCtx));
1385d3a7d86cSMatthew G. Knepley         } else {
1386d3a7d86cSMatthew G. Knepley           gcoords = &coords[coordDim*q];
1387d3a7d86cSMatthew G. Knepley         }
13885f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscArrayzero(funcVal,Nc));
13894bee2e38SMatthew G. Knepley         ierr = (*funcs[field])(coordDim, time, gcoords, n, Nc, funcVal, ctx);
1390e735a8a9SMatthew G. Knepley         if (ierr) {
13915f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexVecRestoreClosure(dm, NULL, localX, c, NULL, &x));
13925f80ce2aSJacob Faibussowitsch           CHKERRQ(DMRestoreLocalVector(dm, &localX));
13935f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFree6(funcVal,coords,fegeom.J,fegeom.invJ,interpolant,fegeom.detJ));
1394e735a8a9SMatthew G. Knepley           CHKERRQ(ierr);
1395e735a8a9SMatthew G. Knepley         }
13965f80ce2aSJacob Faibussowitsch         if (transform) CHKERRQ(DMPlexBasisTransformApply_Internal(dm, &coords[coordDim*q], PETSC_FALSE, Nc, funcVal, funcVal, dm->transformCtx));
13975f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEInterpolateGradient_Static(fe, 1, &x[fieldOffset], &qgeom, q, interpolant));
13984bee2e38SMatthew G. Knepley         /* Overwrite with the dot product if the normal is given */
13994bee2e38SMatthew G. Knepley         if (n) {
14004bee2e38SMatthew G. Knepley           for (fc = 0; fc < Nc; ++fc) {
14014bee2e38SMatthew G. Knepley             PetscScalar sum = 0.0;
14024bee2e38SMatthew G. Knepley             PetscInt    d;
14034bee2e38SMatthew G. Knepley             for (d = 0; d < dim; ++d) sum += interpolant[fc*dim+d]*n[d];
14044bee2e38SMatthew G. Knepley             interpolant[fc] = sum;
14054bee2e38SMatthew G. Knepley           }
14064bee2e38SMatthew G. Knepley         }
14079c3cf19fSMatthew G. Knepley         for (fc = 0; fc < Nc; ++fc) {
1408beaa55a6SMatthew G. Knepley           const PetscReal wt = quadWeights[q*qNc+(qNc == 1 ? 0 : qc+fc)];
14095f80ce2aSJacob Faibussowitsch           if (debug) CHKERRQ(PetscPrintf(PETSC_COMM_SELF, "    elem %D fieldDer %D,%D diff %g\n", c, field, fc, (double)(PetscSqr(PetscRealPart(interpolant[fc] - funcVal[fc]))*wt*fegeom.detJ[q])));
14104bee2e38SMatthew G. Knepley           elemDiff += PetscSqr(PetscRealPart(interpolant[fc] - funcVal[fc]))*wt*fegeom.detJ[q];
141140e14135SMatthew G. Knepley         }
141240e14135SMatthew G. Knepley       }
14139c3cf19fSMatthew G. Knepley       fieldOffset += Nb;
14149c3cf19fSMatthew G. Knepley       qc          += Nc;
141540e14135SMatthew G. Knepley     }
14165f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecRestoreClosure(dm, NULL, localX, c, NULL, &x));
14175f80ce2aSJacob Faibussowitsch     if (debug) CHKERRQ(PetscPrintf(PETSC_COMM_SELF, "  elem %D diff %g\n", c, (double)elemDiff));
141840e14135SMatthew G. Knepley     localDiff += elemDiff;
141940e14135SMatthew G. Knepley   }
14205f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree6(funcVal,coords,fegeom.J,fegeom.invJ,interpolant,fegeom.detJ));
14215f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreLocalVector(dm, &localX));
14225f80ce2aSJacob Faibussowitsch   CHKERRMPI(MPIU_Allreduce(&localDiff, diff, 1, MPIU_REAL, MPIU_SUM, PetscObjectComm((PetscObject)dm)));
142340e14135SMatthew G. Knepley   *diff = PetscSqrtReal(*diff);
1424cb1e1211SMatthew G Knepley   PetscFunctionReturn(0);
1425cb1e1211SMatthew G Knepley }
1426cb1e1211SMatthew G Knepley 
1427c6eecec3SToby Isaac PetscErrorCode DMComputeL2FieldDiff_Plex(DM dm, PetscReal time, PetscErrorCode (**funcs)(PetscInt, PetscReal, const PetscReal [], PetscInt, PetscScalar *, void *), void **ctxs, Vec X, PetscReal *diff)
142873d901b8SMatthew G. Knepley {
14290f09c10fSMatthew G. Knepley   const PetscInt   debug = ((DM_Plex*)dm->data)->printL2;
1430ca3d3a14SMatthew G. Knepley   DM               tdm;
1431083401c6SMatthew G. Knepley   DMLabel          depthLabel;
143273d901b8SMatthew G. Knepley   PetscSection     section;
1433ca3d3a14SMatthew G. Knepley   Vec              localX, tv;
143473d901b8SMatthew G. Knepley   PetscReal       *localDiff;
1435083401c6SMatthew G. Knepley   PetscInt         dim, depth, dE, Nf, f, Nds, s;
1436ca3d3a14SMatthew G. Knepley   PetscBool        transform;
143773d901b8SMatthew G. Knepley   PetscErrorCode   ierr;
143873d901b8SMatthew G. Knepley 
143973d901b8SMatthew G. Knepley   PetscFunctionBegin;
14405f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dm, &dim));
14415f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateDim(dm, &dE));
14425f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &section));
14435f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalVector(dm, &localX));
14445f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetBasisTransformDM_Internal(dm, &tdm));
14455f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetBasisTransformVec_Internal(dm, &tv));
14465f80ce2aSJacob Faibussowitsch   CHKERRQ(DMHasBasisTransform(dm, &transform));
14475f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetNumFields(dm, &Nf));
14485f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetDepthLabel(dm, &depthLabel));
14495f80ce2aSJacob Faibussowitsch   CHKERRQ(DMLabelGetNumValues(depthLabel, &depth));
1450083401c6SMatthew G. Knepley 
14515f80ce2aSJacob Faibussowitsch   CHKERRQ(VecSet(localX, 0.0));
14525f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGlobalToLocalBegin(dm, X, INSERT_VALUES, localX));
14535f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGlobalToLocalEnd(dm, X, INSERT_VALUES, localX));
14545f80ce2aSJacob Faibussowitsch   CHKERRQ(DMProjectFunctionLocal(dm, time, funcs, ctxs, INSERT_BC_VALUES, localX));
14555f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetNumDS(dm, &Nds));
14565f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscCalloc1(Nf, &localDiff));
1457083401c6SMatthew G. Knepley   for (s = 0; s < Nds; ++s) {
1458083401c6SMatthew G. Knepley     PetscDS          ds;
1459083401c6SMatthew G. Knepley     DMLabel          label;
1460083401c6SMatthew G. Knepley     IS               fieldIS, pointIS;
1461083401c6SMatthew G. Knepley     const PetscInt  *fields, *points = NULL;
1462083401c6SMatthew G. Knepley     PetscQuadrature  quad;
1463083401c6SMatthew G. Knepley     const PetscReal *quadPoints, *quadWeights;
1464083401c6SMatthew G. Knepley     PetscFEGeom      fegeom;
1465083401c6SMatthew G. Knepley     PetscReal       *coords, *gcoords;
1466083401c6SMatthew G. Knepley     PetscScalar     *funcVal, *interpolant;
14675fedec97SMatthew G. Knepley     PetscBool        isCohesive;
1468083401c6SMatthew G. Knepley     PetscInt         qNc, Nq, totNc, cStart = 0, cEnd, c, dsNf;
146973d901b8SMatthew G. Knepley 
14705f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetRegionNumDS(dm, s, &label, &fieldIS, &ds));
14715f80ce2aSJacob Faibussowitsch     CHKERRQ(ISGetIndices(fieldIS, &fields));
14725f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSIsCohesive(ds, &isCohesive));
14735f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetNumFields(ds, &dsNf));
14745f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetTotalComponents(ds, &totNc));
14755f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetQuadrature(ds, &quad));
14765f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscQuadratureGetData(quad, NULL, &qNc, &Nq, &quadPoints, &quadWeights));
14772c71b3e2SJacob Faibussowitsch     PetscCheckFalse((qNc != 1) && (qNc != totNc),PETSC_COMM_SELF, PETSC_ERR_ARG_SIZ, "Quadrature components %D != %D field components", qNc, totNc);
14785f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscCalloc6(totNc, &funcVal, totNc, &interpolant, dE*(Nq+1), &coords,Nq, &fegeom.detJ, dE*dE*Nq, &fegeom.J, dE*dE*Nq, &fegeom.invJ));
1479083401c6SMatthew G. Knepley     if (!label) {
14805f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetSimplexOrBoxCells(dm, 0, &cStart, &cEnd));
1481083401c6SMatthew G. Knepley     } else {
14825f80ce2aSJacob Faibussowitsch       CHKERRQ(DMLabelGetStratumIS(label, 1, &pointIS));
14835f80ce2aSJacob Faibussowitsch       CHKERRQ(ISGetLocalSize(pointIS, &cEnd));
14845f80ce2aSJacob Faibussowitsch       CHKERRQ(ISGetIndices(pointIS, &points));
1485083401c6SMatthew G. Knepley     }
148673d901b8SMatthew G. Knepley     for (c = cStart; c < cEnd; ++c) {
1487083401c6SMatthew G. Knepley       const PetscInt cell  = points ? points[c] : c;
148873d901b8SMatthew G. Knepley       PetscScalar    *x    = NULL;
14895fedec97SMatthew G. Knepley       const PetscInt *cone;
14905fedec97SMatthew G. Knepley       PetscInt        qc   = 0, fOff = 0, dep;
149173d901b8SMatthew G. Knepley 
14925f80ce2aSJacob Faibussowitsch       CHKERRQ(DMLabelGetValue(depthLabel, cell, &dep));
1493083401c6SMatthew G. Knepley       if (dep != depth-1) continue;
14945fedec97SMatthew G. Knepley       if (isCohesive) {
14955f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexGetCone(dm, cell, &cone));
14965f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexComputeCellGeometryFEM(dm, cone[0], quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
149796959cd1SMatthew G. Knepley       } else {
14985f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexComputeCellGeometryFEM(dm, cell, quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
149996959cd1SMatthew G. Knepley       }
15005f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecGetClosure(dm, NULL, localX, cell, NULL, &x));
15015fedec97SMatthew G. Knepley       for (f = 0; f < dsNf; ++f) {
150215496722SMatthew G. Knepley         PetscObject  obj;
150315496722SMatthew G. Knepley         PetscClassId id;
1504083401c6SMatthew G. Knepley         void * const ctx = ctxs ? ctxs[fields[f]] : NULL;
150515496722SMatthew G. Knepley         PetscInt     Nb, Nc, q, fc;
150615496722SMatthew G. Knepley         PetscReal    elemDiff = 0.0;
15075fedec97SMatthew G. Knepley         PetscBool    cohesive;
150815496722SMatthew G. Knepley 
15095f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDSGetCohesive(ds, f, &cohesive));
15105fedec97SMatthew G. Knepley         if (isCohesive && !cohesive) continue;
15115f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDSGetDiscretization(ds, f, &obj));
15125f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscObjectGetClassId(obj, &id));
15135f80ce2aSJacob Faibussowitsch         if (id == PETSCFE_CLASSID)      {CHKERRQ(PetscFEGetNumComponents((PetscFE) obj, &Nc));CHKERRQ(PetscFEGetDimension((PetscFE) obj, &Nb));}
15145f80ce2aSJacob Faibussowitsch         else if (id == PETSCFV_CLASSID) {CHKERRQ(PetscFVGetNumComponents((PetscFV) obj, &Nc));Nb = 1;}
151598921bdaSJacob Faibussowitsch         else SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", fields[f]);
151673d901b8SMatthew G. Knepley         if (debug) {
151773d901b8SMatthew G. Knepley           char title[1024];
15185f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscSNPrintf(title, 1023, "Solution for Field %D", fields[f]));
15195f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPrintCellVector(cell, title, Nb, &x[fOff]));
152073d901b8SMatthew G. Knepley         }
15217318780aSToby Isaac         for (q = 0; q < Nq; ++q) {
15222a4e142eSMatthew G. Knepley           PetscFEGeom qgeom;
15232a4e142eSMatthew G. Knepley 
15242a4e142eSMatthew G. Knepley           qgeom.dimEmbed = fegeom.dimEmbed;
1525083401c6SMatthew G. Knepley           qgeom.J        = &fegeom.J[q*dE*dE];
1526083401c6SMatthew G. Knepley           qgeom.invJ     = &fegeom.invJ[q*dE*dE];
15272a4e142eSMatthew G. Knepley           qgeom.detJ     = &fegeom.detJ[q];
15285f80ce2aSJacob Faibussowitsch           PetscCheck(fegeom.detJ[q] > 0.0,PETSC_COMM_SELF, PETSC_ERR_ARG_OUTOFRANGE, "Invalid determinant %g for cell %D, quadrature point %D", (double)fegeom.detJ[q], cell, q);
1529d3a7d86cSMatthew G. Knepley           if (transform) {
1530083401c6SMatthew G. Knepley             gcoords = &coords[dE*Nq];
15315f80ce2aSJacob Faibussowitsch             CHKERRQ(DMPlexBasisTransformApplyReal_Internal(dm, &coords[dE*q], PETSC_TRUE, dE, &coords[dE*q], gcoords, dm->transformCtx));
1532d3a7d86cSMatthew G. Knepley           } else {
1533083401c6SMatthew G. Knepley             gcoords = &coords[dE*q];
1534d3a7d86cSMatthew G. Knepley           }
15352df84da0SMatthew G. Knepley           for (fc = 0; fc < Nc; ++fc) funcVal[fc] = 0.;
1536083401c6SMatthew G. Knepley           ierr = (*funcs[fields[f]])(dE, time, gcoords, Nc, funcVal, ctx);
1537e735a8a9SMatthew G. Knepley           if (ierr) {
15385f80ce2aSJacob Faibussowitsch             CHKERRQ(DMPlexVecRestoreClosure(dm, NULL, localX, cell, NULL, &x));
15395f80ce2aSJacob Faibussowitsch             CHKERRQ(DMRestoreLocalVector(dm, &localX));
15405f80ce2aSJacob Faibussowitsch             CHKERRQ(PetscFree6(funcVal,interpolant,coords,fegeom.detJ,fegeom.J,fegeom.invJ));
1541e735a8a9SMatthew G. Knepley             CHKERRQ(ierr);
1542e735a8a9SMatthew G. Knepley           }
15435f80ce2aSJacob Faibussowitsch           if (transform) CHKERRQ(DMPlexBasisTransformApply_Internal(dm, &coords[dE*q], PETSC_FALSE, Nc, funcVal, funcVal, dm->transformCtx));
154496959cd1SMatthew G. Knepley           /* Call once for each face, except for lagrange field */
15455f80ce2aSJacob Faibussowitsch           if (id == PETSCFE_CLASSID)      CHKERRQ(PetscFEInterpolate_Static((PetscFE) obj, &x[fOff], &qgeom, q, interpolant));
15465f80ce2aSJacob Faibussowitsch           else if (id == PETSCFV_CLASSID) CHKERRQ(PetscFVInterpolate_Static((PetscFV) obj, &x[fOff], q, interpolant));
154798921bdaSJacob Faibussowitsch           else SETERRQ(PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", fields[f]);
154815496722SMatthew G. Knepley           for (fc = 0; fc < Nc; ++fc) {
1549beaa55a6SMatthew G. Knepley             const PetscReal wt = quadWeights[q*qNc+(qNc == 1 ? 0 : qc+fc)];
15505f80ce2aSJacob Faibussowitsch             if (debug) CHKERRQ(PetscPrintf(PETSC_COMM_SELF, "    cell %D field %D,%D point %g %g %g diff %g\n", cell, fields[f], fc, (double)(dE > 0 ? coords[dE*q] : 0.), (double)(dE > 1 ? coords[dE*q+1] : 0.),(double)(dE > 2 ? coords[dE*q+2] : 0.), (double)(PetscSqr(PetscRealPart(interpolant[fc] - funcVal[fc]))*wt*fegeom.detJ[q])));
15514bee2e38SMatthew G. Knepley             elemDiff += PetscSqr(PetscRealPart(interpolant[fc] - funcVal[fc]))*wt*fegeom.detJ[q];
155273d901b8SMatthew G. Knepley           }
155373d901b8SMatthew G. Knepley         }
1554083401c6SMatthew G. Knepley         fOff += Nb;
15559c3cf19fSMatthew G. Knepley         qc   += Nc;
1556083401c6SMatthew G. Knepley         localDiff[fields[f]] += elemDiff;
15575f80ce2aSJacob Faibussowitsch         if (debug) CHKERRQ(PetscPrintf(PETSC_COMM_SELF, "  cell %D field %D cum diff %g\n", cell, fields[f], (double)localDiff[fields[f]]));
155873d901b8SMatthew G. Knepley       }
15595f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecRestoreClosure(dm, NULL, localX, cell, NULL, &x));
1560083401c6SMatthew G. Knepley     }
1561083401c6SMatthew G. Knepley     if (label) {
15625f80ce2aSJacob Faibussowitsch       CHKERRQ(ISRestoreIndices(pointIS, &points));
15635f80ce2aSJacob Faibussowitsch       CHKERRQ(ISDestroy(&pointIS));
1564083401c6SMatthew G. Knepley     }
15655f80ce2aSJacob Faibussowitsch     CHKERRQ(ISRestoreIndices(fieldIS, &fields));
15665f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFree6(funcVal, interpolant, coords, fegeom.detJ, fegeom.J, fegeom.invJ));
156773d901b8SMatthew G. Knepley   }
15685f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreLocalVector(dm, &localX));
15695f80ce2aSJacob Faibussowitsch   CHKERRMPI(MPIU_Allreduce(localDiff, diff, Nf, MPIU_REAL, MPIU_SUM, PetscObjectComm((PetscObject)dm)));
15705f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree(localDiff));
1571083401c6SMatthew G. Knepley   for (f = 0; f < Nf; ++f) diff[f] = PetscSqrtReal(diff[f]);
157273d901b8SMatthew G. Knepley   PetscFunctionReturn(0);
157373d901b8SMatthew G. Knepley }
157473d901b8SMatthew G. Knepley 
1575e729f68cSMatthew G. Knepley /*@C
1576e729f68cSMatthew G. Knepley   DMPlexComputeL2DiffVec - This function computes the cellwise L_2 difference between a function u and an FEM interpolant solution u_h, and stores it in a Vec.
1577e729f68cSMatthew G. Knepley 
1578d083f849SBarry Smith   Collective on dm
1579c0f8e1fdSMatthew G. Knepley 
1580e729f68cSMatthew G. Knepley   Input Parameters:
1581e729f68cSMatthew G. Knepley + dm    - The DM
15820163fd50SMatthew G. Knepley . time  - The time
1583ca3eba1bSToby Isaac . funcs - The functions to evaluate for each field component: NULL means that component does not contribute to error calculation
1584e729f68cSMatthew G. Knepley . ctxs  - Optional array of contexts to pass to each function, or NULL.
1585e729f68cSMatthew G. Knepley - X     - The coefficient vector u_h
1586e729f68cSMatthew G. Knepley 
1587e729f68cSMatthew G. Knepley   Output Parameter:
1588e729f68cSMatthew G. Knepley . D - A Vec which holds the difference ||u - u_h||_2 for each cell
1589e729f68cSMatthew G. Knepley 
1590e729f68cSMatthew G. Knepley   Level: developer
1591e729f68cSMatthew G. Knepley 
1592b698f381SToby Isaac .seealso: DMProjectFunction(), DMComputeL2Diff(), DMPlexComputeL2FieldDiff(), DMComputeL2GradientDiff()
1593e729f68cSMatthew G. Knepley @*/
15940163fd50SMatthew G. Knepley PetscErrorCode DMPlexComputeL2DiffVec(DM dm, PetscReal time, PetscErrorCode (**funcs)(PetscInt, PetscReal, const PetscReal [], PetscInt, PetscScalar *, void *), void **ctxs, Vec X, Vec D)
1595e729f68cSMatthew G. Knepley {
1596e729f68cSMatthew G. Knepley   PetscSection     section;
1597e729f68cSMatthew G. Knepley   PetscQuadrature  quad;
1598e729f68cSMatthew G. Knepley   Vec              localX;
15994bee2e38SMatthew G. Knepley   PetscFEGeom      fegeom;
1600e729f68cSMatthew G. Knepley   PetscScalar     *funcVal, *interpolant;
16014bee2e38SMatthew G. Knepley   PetscReal       *coords;
1602e729f68cSMatthew G. Knepley   const PetscReal *quadPoints, *quadWeights;
1603485ad865SMatthew G. Knepley   PetscInt         dim, coordDim, numFields, numComponents = 0, qNc, Nq, cStart, cEnd, c, field, fieldOffset;
1604e729f68cSMatthew G. Knepley 
1605e729f68cSMatthew G. Knepley   PetscFunctionBegin;
16065f80ce2aSJacob Faibussowitsch   CHKERRQ(VecSet(D, 0.0));
16075f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dm, &dim));
16085f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateDim(dm, &coordDim));
16095f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &section));
16105f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetNumFields(section, &numFields));
16115f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalVector(dm, &localX));
16125f80ce2aSJacob Faibussowitsch   CHKERRQ(DMProjectFunctionLocal(dm, time, funcs, ctxs, INSERT_BC_VALUES, localX));
16135f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGlobalToLocalBegin(dm, X, INSERT_VALUES, localX));
16145f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGlobalToLocalEnd(dm, X, INSERT_VALUES, localX));
1615e729f68cSMatthew G. Knepley   for (field = 0; field < numFields; ++field) {
1616e729f68cSMatthew G. Knepley     PetscObject  obj;
1617e729f68cSMatthew G. Knepley     PetscClassId id;
1618e729f68cSMatthew G. Knepley     PetscInt     Nc;
1619e729f68cSMatthew G. Knepley 
16205f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetField(dm, field, NULL, &obj));
16215f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
1622e729f68cSMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
1623e729f68cSMatthew G. Knepley       PetscFE fe = (PetscFE) obj;
1624e729f68cSMatthew G. Knepley 
16255f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetQuadrature(fe, &quad));
16265f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetNumComponents(fe, &Nc));
1627e729f68cSMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
1628e729f68cSMatthew G. Knepley       PetscFV fv = (PetscFV) obj;
1629e729f68cSMatthew G. Knepley 
16305f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetQuadrature(fv, &quad));
16315f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetNumComponents(fv, &Nc));
163298921bdaSJacob Faibussowitsch     } else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", field);
1633e729f68cSMatthew G. Knepley     numComponents += Nc;
1634e729f68cSMatthew G. Knepley   }
16355f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscQuadratureGetData(quad, NULL, &qNc, &Nq, &quadPoints, &quadWeights));
16362c71b3e2SJacob Faibussowitsch   PetscCheckFalse((qNc != 1) && (qNc != numComponents),PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_SIZ, "Quadrature components %D != %D field components", qNc, numComponents);
16375f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc6(numComponents,&funcVal,numComponents,&interpolant,coordDim*Nq,&coords,Nq,&fegeom.detJ,coordDim*coordDim*Nq,&fegeom.J,coordDim*coordDim*Nq,&fegeom.invJ));
16385f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetSimplexOrBoxCells(dm, 0, &cStart, &cEnd));
1639e729f68cSMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
1640e729f68cSMatthew G. Knepley     PetscScalar *x = NULL;
16416f288a59SMatthew G. Knepley     PetscScalar  elemDiff = 0.0;
16429c3cf19fSMatthew G. Knepley     PetscInt     qc = 0;
1643e729f68cSMatthew G. Knepley 
16445f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexComputeCellGeometryFEM(dm, c, quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
16455f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecGetClosure(dm, NULL, localX, c, NULL, &x));
1646e729f68cSMatthew G. Knepley 
1647e729f68cSMatthew G. Knepley     for (field = 0, fieldOffset = 0; field < numFields; ++field) {
1648e729f68cSMatthew G. Knepley       PetscObject  obj;
1649e729f68cSMatthew G. Knepley       PetscClassId id;
1650e729f68cSMatthew G. Knepley       void * const ctx = ctxs ? ctxs[field] : NULL;
1651e729f68cSMatthew G. Knepley       PetscInt     Nb, Nc, q, fc;
1652e729f68cSMatthew G. Knepley 
16535f80ce2aSJacob Faibussowitsch       CHKERRQ(DMGetField(dm, field, NULL, &obj));
16545f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscObjectGetClassId(obj, &id));
16555f80ce2aSJacob Faibussowitsch       if (id == PETSCFE_CLASSID)      {CHKERRQ(PetscFEGetNumComponents((PetscFE) obj, &Nc));CHKERRQ(PetscFEGetDimension((PetscFE) obj, &Nb));}
16565f80ce2aSJacob Faibussowitsch       else if (id == PETSCFV_CLASSID) {CHKERRQ(PetscFVGetNumComponents((PetscFV) obj, &Nc));Nb = 1;}
165798921bdaSJacob Faibussowitsch       else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", field);
165823f34ed2SToby Isaac       if (funcs[field]) {
16597318780aSToby Isaac         for (q = 0; q < Nq; ++q) {
16602a4e142eSMatthew G. Knepley           PetscFEGeom qgeom;
16612a4e142eSMatthew G. Knepley 
16622a4e142eSMatthew G. Knepley           qgeom.dimEmbed = fegeom.dimEmbed;
16632a4e142eSMatthew G. Knepley           qgeom.J        = &fegeom.J[q*coordDim*coordDim];
16642a4e142eSMatthew G. Knepley           qgeom.invJ     = &fegeom.invJ[q*coordDim*coordDim];
16652a4e142eSMatthew G. Knepley           qgeom.detJ     = &fegeom.detJ[q];
16665f80ce2aSJacob Faibussowitsch           PetscCheck(fegeom.detJ[q] > 0.0,PETSC_COMM_SELF, PETSC_ERR_ARG_OUTOFRANGE, "Invalid determinant %g for element %D, quadrature points %D", (double)fegeom.detJ[q], c, q);
16675f80ce2aSJacob Faibussowitsch           CHKERRQ((*funcs[field])(coordDim, time, &coords[q*coordDim], Nc, funcVal, ctx));
1668c3e24edfSBarry Smith #if defined(needs_fix_with_return_code_argument)
1669e735a8a9SMatthew G. Knepley           if (ierr) {
1670c3e24edfSBarry Smith             PetscErrorCode ierr;
16715f80ce2aSJacob Faibussowitsch             CHKERRQ(DMPlexVecRestoreClosure(dm, NULL, localX, c, NULL, &x));
16725f80ce2aSJacob Faibussowitsch             CHKERRQ(PetscFree6(funcVal,interpolant,coords,fegeom.detJ,fegeom.J,fegeom.invJ));
16735f80ce2aSJacob Faibussowitsch             CHKERRQ(DMRestoreLocalVector(dm, &localX));
1674e735a8a9SMatthew G. Knepley           }
1675c3e24edfSBarry Smith #endif
16765f80ce2aSJacob Faibussowitsch           if (id == PETSCFE_CLASSID)      CHKERRQ(PetscFEInterpolate_Static((PetscFE) obj, &x[fieldOffset], &qgeom, q, interpolant));
16775f80ce2aSJacob Faibussowitsch           else if (id == PETSCFV_CLASSID) CHKERRQ(PetscFVInterpolate_Static((PetscFV) obj, &x[fieldOffset], q, interpolant));
167898921bdaSJacob Faibussowitsch           else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", field);
1679e729f68cSMatthew G. Knepley           for (fc = 0; fc < Nc; ++fc) {
1680beaa55a6SMatthew G. Knepley             const PetscReal wt = quadWeights[q*qNc+(qNc == 1 ? 0 : qc+fc)];
16814bee2e38SMatthew G. Knepley             elemDiff += PetscSqr(PetscRealPart(interpolant[fc] - funcVal[fc]))*wt*fegeom.detJ[q];
1682e729f68cSMatthew G. Knepley           }
1683e729f68cSMatthew G. Knepley         }
168423f34ed2SToby Isaac       }
1685beaa55a6SMatthew G. Knepley       fieldOffset += Nb;
16869c3cf19fSMatthew G. Knepley       qc          += Nc;
1687e729f68cSMatthew G. Knepley     }
16885f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecRestoreClosure(dm, NULL, localX, c, NULL, &x));
16895f80ce2aSJacob Faibussowitsch     CHKERRQ(VecSetValue(D, c - cStart, elemDiff, INSERT_VALUES));
1690e729f68cSMatthew G. Knepley   }
16915f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree6(funcVal,interpolant,coords,fegeom.detJ,fegeom.J,fegeom.invJ));
16925f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreLocalVector(dm, &localX));
16935f80ce2aSJacob Faibussowitsch   CHKERRQ(VecSqrtAbs(D));
1694e729f68cSMatthew G. Knepley   PetscFunctionReturn(0);
1695e729f68cSMatthew G. Knepley }
1696e729f68cSMatthew G. Knepley 
16975f0b18bfSMatthew G. Knepley /*@
16985f0b18bfSMatthew G. Knepley   DMPlexComputeClementInterpolant - This function computes the L2 projection of the cellwise values of a function u onto P1, and stores it in a Vec.
16995f0b18bfSMatthew G. Knepley 
17005f0b18bfSMatthew G. Knepley   Collective on dm
17015f0b18bfSMatthew G. Knepley 
17025f0b18bfSMatthew G. Knepley   Input Parameters:
17035f0b18bfSMatthew G. Knepley + dm - The DM
17045f0b18bfSMatthew G. Knepley - locX  - The coefficient vector u_h
17055f0b18bfSMatthew G. Knepley 
17065f0b18bfSMatthew G. Knepley   Output Parameter:
17075f0b18bfSMatthew G. Knepley . locC - A Vec which holds the Clement interpolant of the function
17085f0b18bfSMatthew G. Knepley 
17095f0b18bfSMatthew G. Knepley   Notes:
17105f0b18bfSMatthew G. Knepley   u_h(v_i) = \sum_{T_i \in support(v_i)} |T_i| u_h(T_i) / \sum_{T_i \in support(v_i)} |T_i| where |T_i| is the cell volume
17115f0b18bfSMatthew G. Knepley 
17125f0b18bfSMatthew G. Knepley   Level: developer
17135f0b18bfSMatthew G. Knepley 
17145f0b18bfSMatthew G. Knepley .seealso: DMProjectFunction(), DMComputeL2Diff(), DMPlexComputeL2FieldDiff(), DMComputeL2GradientDiff()
17155f0b18bfSMatthew G. Knepley @*/
17165f0b18bfSMatthew G. Knepley PetscErrorCode DMPlexComputeClementInterpolant(DM dm, Vec locX, Vec locC)
17175f0b18bfSMatthew G. Knepley {
17185f0b18bfSMatthew G. Knepley   PetscInt         debug = ((DM_Plex *) dm->data)->printFEM;
17195f0b18bfSMatthew G. Knepley   DM               dmc;
17205f0b18bfSMatthew G. Knepley   PetscQuadrature  quad;
17215f0b18bfSMatthew G. Knepley   PetscScalar     *interpolant, *valsum;
17225f0b18bfSMatthew G. Knepley   PetscFEGeom      fegeom;
17235f0b18bfSMatthew G. Knepley   PetscReal       *coords;
17245f0b18bfSMatthew G. Knepley   const PetscReal *quadPoints, *quadWeights;
17255f0b18bfSMatthew G. Knepley   PetscInt         dim, cdim, Nf, f, Nc = 0, Nq, qNc, cStart, cEnd, vStart, vEnd, v;
17265f0b18bfSMatthew G. Knepley 
17275f0b18bfSMatthew G. Knepley   PetscFunctionBegin;
17285f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscCitationsRegister(ClementCitation, &Clementcite));
17295f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetDM(locC, &dmc));
17305f80ce2aSJacob Faibussowitsch   CHKERRQ(VecSet(locC, 0.0));
17315f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dm, &dim));
17325f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateDim(dm, &cdim));
17335f0b18bfSMatthew G. Knepley   fegeom.dimEmbed = cdim;
17345f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetNumFields(dm, &Nf));
17355f0b18bfSMatthew G. Knepley   PetscCheck(Nf > 0, PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of fields is zero!");
17365f0b18bfSMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
17375f0b18bfSMatthew G. Knepley     PetscObject  obj;
17385f0b18bfSMatthew G. Knepley     PetscClassId id;
17395f0b18bfSMatthew G. Knepley     PetscInt     fNc;
17405f0b18bfSMatthew G. Knepley 
17415f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetField(dm, f, NULL, &obj));
17425f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
17435f0b18bfSMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
17445f0b18bfSMatthew G. Knepley       PetscFE fe = (PetscFE) obj;
17455f0b18bfSMatthew G. Knepley 
17465f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetQuadrature(fe, &quad));
17475f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetNumComponents(fe, &fNc));
17485f0b18bfSMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
17495f0b18bfSMatthew G. Knepley       PetscFV fv = (PetscFV) obj;
17505f0b18bfSMatthew G. Knepley 
17515f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetQuadrature(fv, &quad));
17525f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetNumComponents(fv, &fNc));
17535f0b18bfSMatthew G. Knepley     } else SETERRQ(PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", f);
17545f0b18bfSMatthew G. Knepley     Nc += fNc;
17555f0b18bfSMatthew G. Knepley   }
17565f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscQuadratureGetData(quad, NULL, &qNc, &Nq, &quadPoints, &quadWeights));
17575f0b18bfSMatthew G. Knepley   PetscCheck(qNc == 1,PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_SIZ, "Quadrature components %D > 1", qNc);
17585f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc6(Nc*2, &valsum, Nc, &interpolant, cdim*Nq, &coords, Nq, &fegeom.detJ, cdim*cdim*Nq, &fegeom.J, cdim*cdim*Nq, &fegeom.invJ));
17595f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetDepthStratum(dm, 0, &vStart, &vEnd));
17605f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetSimplexOrBoxCells(dm, 0, &cStart, &cEnd));
17615f0b18bfSMatthew G. Knepley   for (v = vStart; v < vEnd; ++v) {
17625f0b18bfSMatthew G. Knepley     PetscScalar volsum = 0.0;
17635f0b18bfSMatthew G. Knepley     PetscInt   *star   = NULL;
17645f0b18bfSMatthew G. Knepley     PetscInt    starSize, st, fc;
17655f0b18bfSMatthew G. Knepley 
17665f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscArrayzero(valsum, Nc));
17675f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexGetTransitiveClosure(dm, v, PETSC_FALSE, &starSize, &star));
17685f0b18bfSMatthew G. Knepley     for (st = 0; st < starSize*2; st += 2) {
17695f0b18bfSMatthew G. Knepley       const PetscInt cell = star[st];
17705f0b18bfSMatthew G. Knepley       PetscScalar   *val  = &valsum[Nc];
17715f0b18bfSMatthew G. Knepley       PetscScalar   *x    = NULL;
17725f0b18bfSMatthew G. Knepley       PetscReal      vol  = 0.0;
17735f0b18bfSMatthew G. Knepley       PetscInt       foff = 0;
17745f0b18bfSMatthew G. Knepley 
17755f0b18bfSMatthew G. Knepley       if ((cell < cStart) || (cell >= cEnd)) continue;
17765f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexComputeCellGeometryFEM(dm, cell, quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
17775f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecGetClosure(dm, NULL, locX, cell, NULL, &x));
17785f0b18bfSMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
17795f0b18bfSMatthew G. Knepley         PetscObject  obj;
17805f0b18bfSMatthew G. Knepley         PetscClassId id;
17815f0b18bfSMatthew G. Knepley         PetscInt     Nb, fNc, q;
17825f0b18bfSMatthew G. Knepley 
17835f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscArrayzero(val, Nc));
17845f80ce2aSJacob Faibussowitsch         CHKERRQ(DMGetField(dm, f, NULL, &obj));
17855f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscObjectGetClassId(obj, &id));
17865f80ce2aSJacob Faibussowitsch         if (id == PETSCFE_CLASSID)      {CHKERRQ(PetscFEGetNumComponents((PetscFE) obj, &fNc));CHKERRQ(PetscFEGetDimension((PetscFE) obj, &Nb));}
17875f80ce2aSJacob Faibussowitsch         else if (id == PETSCFV_CLASSID) {CHKERRQ(PetscFVGetNumComponents((PetscFV) obj, &fNc));Nb = 1;}
17885f0b18bfSMatthew G. Knepley         else SETERRQ(PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", f);
17895f0b18bfSMatthew G. Knepley         for (q = 0; q < Nq; ++q) {
17905f0b18bfSMatthew G. Knepley           const PetscReal wt = quadWeights[q]*fegeom.detJ[q];
17915f0b18bfSMatthew G. Knepley           PetscFEGeom     qgeom;
17925f0b18bfSMatthew G. Knepley 
17935f0b18bfSMatthew G. Knepley           qgeom.dimEmbed = fegeom.dimEmbed;
17945f0b18bfSMatthew G. Knepley           qgeom.J        = &fegeom.J[q*cdim*cdim];
17955f0b18bfSMatthew G. Knepley           qgeom.invJ     = &fegeom.invJ[q*cdim*cdim];
17965f0b18bfSMatthew G. Knepley           qgeom.detJ     = &fegeom.detJ[q];
17975f0b18bfSMatthew G. Knepley           PetscCheck(fegeom.detJ[q] > 0.0, PETSC_COMM_SELF, PETSC_ERR_ARG_OUTOFRANGE, "Invalid determinant %g for element %D, quadrature points %D", (double) fegeom.detJ[q], cell, q);
17985f80ce2aSJacob Faibussowitsch           if (id == PETSCFE_CLASSID) CHKERRQ(PetscFEInterpolate_Static((PetscFE) obj, &x[foff], &qgeom, q, interpolant));
17995f0b18bfSMatthew G. Knepley           else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", f);
18005f0b18bfSMatthew G. Knepley           for (fc = 0; fc < fNc; ++fc) val[foff+fc] += interpolant[fc]*wt;
18015f0b18bfSMatthew G. Knepley           vol += wt;
18025f0b18bfSMatthew G. Knepley         }
18035f0b18bfSMatthew G. Knepley         foff += Nb;
18045f0b18bfSMatthew G. Knepley       }
18055f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecRestoreClosure(dm, NULL, locX, cell, NULL, &x));
18065f0b18bfSMatthew G. Knepley       for (fc = 0; fc < Nc; ++fc) valsum[fc] += val[fc];
18075f0b18bfSMatthew G. Knepley       volsum += vol;
18085f0b18bfSMatthew G. Knepley       if (debug) {
18095f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscPrintf(PETSC_COMM_SELF, "Vertex %" PetscInt_FMT " Cell %" PetscInt_FMT " value: [", v, cell));
18105f0b18bfSMatthew G. Knepley         for (fc = 0; fc < Nc; ++fc) {
18115f80ce2aSJacob Faibussowitsch           if (fc) CHKERRQ(PetscPrintf(PETSC_COMM_SELF, ", "));
18125f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscPrintf(PETSC_COMM_SELF, "%g", (double) PetscRealPart(val[fc])));
18135f0b18bfSMatthew G. Knepley         }
18145f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscPrintf(PETSC_COMM_SELF, "]\n"));
18155f0b18bfSMatthew G. Knepley       }
18165f0b18bfSMatthew G. Knepley     }
18175f0b18bfSMatthew G. Knepley     for (fc = 0; fc < Nc; ++fc) valsum[fc] /= volsum;
18185f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexRestoreTransitiveClosure(dm, v, PETSC_FALSE, &starSize, &star));
18195f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecSetClosure(dmc, NULL, locC, v, valsum, INSERT_VALUES));
18205f0b18bfSMatthew G. Knepley   }
18215f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree6(valsum, interpolant, coords, fegeom.detJ, fegeom.J, fegeom.invJ));
18225f0b18bfSMatthew G. Knepley   PetscFunctionReturn(0);
18235f0b18bfSMatthew G. Knepley }
18245f0b18bfSMatthew G. Knepley 
18255f0b18bfSMatthew G. Knepley /*@
18261555c271SMatthew G. Knepley   DMPlexComputeGradientClementInterpolant - This function computes the L2 projection of the cellwise gradient of a function u onto P1, and stores it in a Vec.
18271555c271SMatthew G. Knepley 
1828d083f849SBarry Smith   Collective on dm
1829c0f8e1fdSMatthew G. Knepley 
18301555c271SMatthew G. Knepley   Input Parameters:
18311555c271SMatthew G. Knepley + dm - The DM
18325f0b18bfSMatthew G. Knepley - locX  - The coefficient vector u_h
18331555c271SMatthew G. Knepley 
18341555c271SMatthew G. Knepley   Output Parameter:
18351555c271SMatthew G. Knepley . locC - A Vec which holds the Clement interpolant of the gradient
18361555c271SMatthew G. Knepley 
183795452b02SPatrick Sanan   Notes:
18381555c271SMatthew G. Knepley   \nabla u_h(v_i) = \sum_{T_i \in support(v_i)} |T_i| \nabla u_h(T_i) / \sum_{T_i \in support(v_i)} |T_i| where |T_i| is the cell volume
18391555c271SMatthew G. Knepley 
18401555c271SMatthew G. Knepley   Level: developer
18411555c271SMatthew G. Knepley 
18421555c271SMatthew G. Knepley .seealso: DMProjectFunction(), DMComputeL2Diff(), DMPlexComputeL2FieldDiff(), DMComputeL2GradientDiff()
18431555c271SMatthew G. Knepley @*/
18441555c271SMatthew G. Knepley PetscErrorCode DMPlexComputeGradientClementInterpolant(DM dm, Vec locX, Vec locC)
18451555c271SMatthew G. Knepley {
1846db1066baSMatthew G. Knepley   DM_Plex         *mesh  = (DM_Plex *) dm->data;
1847db1066baSMatthew G. Knepley   PetscInt         debug = mesh->printFEM;
18481555c271SMatthew G. Knepley   DM               dmC;
18491555c271SMatthew G. Knepley   PetscQuadrature  quad;
18501555c271SMatthew G. Knepley   PetscScalar     *interpolant, *gradsum;
18514bee2e38SMatthew G. Knepley   PetscFEGeom      fegeom;
18524bee2e38SMatthew G. Knepley   PetscReal       *coords;
18531555c271SMatthew G. Knepley   const PetscReal *quadPoints, *quadWeights;
1854485ad865SMatthew G. Knepley   PetscInt         dim, coordDim, numFields, numComponents = 0, qNc, Nq, cStart, cEnd, vStart, vEnd, v, field, fieldOffset;
18551555c271SMatthew G. Knepley 
18561555c271SMatthew G. Knepley   PetscFunctionBegin;
18575f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscCitationsRegister(ClementCitation, &Clementcite));
18585f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetDM(locC, &dmC));
18595f80ce2aSJacob Faibussowitsch   CHKERRQ(VecSet(locC, 0.0));
18605f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dm, &dim));
18615f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateDim(dm, &coordDim));
18624bee2e38SMatthew G. Knepley   fegeom.dimEmbed = coordDim;
18635f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetNumFields(dm, &numFields));
18645f80ce2aSJacob Faibussowitsch   PetscCheck(numFields,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of fields is zero!");
18651555c271SMatthew G. Knepley   for (field = 0; field < numFields; ++field) {
18661555c271SMatthew G. Knepley     PetscObject  obj;
18671555c271SMatthew G. Knepley     PetscClassId id;
18681555c271SMatthew G. Knepley     PetscInt     Nc;
18691555c271SMatthew G. Knepley 
18705f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetField(dm, field, NULL, &obj));
18715f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
18721555c271SMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
18731555c271SMatthew G. Knepley       PetscFE fe = (PetscFE) obj;
18741555c271SMatthew G. Knepley 
18755f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetQuadrature(fe, &quad));
18765f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetNumComponents(fe, &Nc));
18771555c271SMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
18781555c271SMatthew G. Knepley       PetscFV fv = (PetscFV) obj;
18791555c271SMatthew G. Knepley 
18805f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetQuadrature(fv, &quad));
18815f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetNumComponents(fv, &Nc));
188298921bdaSJacob Faibussowitsch     } else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", field);
18831555c271SMatthew G. Knepley     numComponents += Nc;
18841555c271SMatthew G. Knepley   }
18855f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscQuadratureGetData(quad, NULL, &qNc, &Nq, &quadPoints, &quadWeights));
18862c71b3e2SJacob Faibussowitsch   PetscCheckFalse((qNc != 1) && (qNc != numComponents),PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_SIZ, "Quadrature components %D != %D field components", qNc, numComponents);
18875f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc6(coordDim*numComponents*2,&gradsum,coordDim*numComponents,&interpolant,coordDim*Nq,&coords,Nq,&fegeom.detJ,coordDim*coordDim*Nq,&fegeom.J,coordDim*coordDim*Nq,&fegeom.invJ));
18885f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetDepthStratum(dm, 0, &vStart, &vEnd));
18895f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetSimplexOrBoxCells(dm, 0, &cStart, &cEnd));
18901555c271SMatthew G. Knepley   for (v = vStart; v < vEnd; ++v) {
18911555c271SMatthew G. Knepley     PetscScalar volsum = 0.0;
18921555c271SMatthew G. Knepley     PetscInt   *star   = NULL;
18931555c271SMatthew G. Knepley     PetscInt    starSize, st, d, fc;
18941555c271SMatthew G. Knepley 
18955f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscArrayzero(gradsum, coordDim*numComponents));
18965f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexGetTransitiveClosure(dm, v, PETSC_FALSE, &starSize, &star));
18971555c271SMatthew G. Knepley     for (st = 0; st < starSize*2; st += 2) {
18981555c271SMatthew G. Knepley       const PetscInt cell = star[st];
18991555c271SMatthew G. Knepley       PetscScalar   *grad = &gradsum[coordDim*numComponents];
19001555c271SMatthew G. Knepley       PetscScalar   *x    = NULL;
19011555c271SMatthew G. Knepley       PetscReal      vol  = 0.0;
19021555c271SMatthew G. Knepley 
19031555c271SMatthew G. Knepley       if ((cell < cStart) || (cell >= cEnd)) continue;
19045f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexComputeCellGeometryFEM(dm, cell, quad, coords, fegeom.J, fegeom.invJ, fegeom.detJ));
19055f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecGetClosure(dm, NULL, locX, cell, NULL, &x));
19061555c271SMatthew G. Knepley       for (field = 0, fieldOffset = 0; field < numFields; ++field) {
19071555c271SMatthew G. Knepley         PetscObject  obj;
19081555c271SMatthew G. Knepley         PetscClassId id;
19091555c271SMatthew G. Knepley         PetscInt     Nb, Nc, q, qc = 0;
19101555c271SMatthew G. Knepley 
19115f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscArrayzero(grad, coordDim*numComponents));
19125f80ce2aSJacob Faibussowitsch         CHKERRQ(DMGetField(dm, field, NULL, &obj));
19135f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscObjectGetClassId(obj, &id));
19145f80ce2aSJacob Faibussowitsch         if (id == PETSCFE_CLASSID)      {CHKERRQ(PetscFEGetNumComponents((PetscFE) obj, &Nc));CHKERRQ(PetscFEGetDimension((PetscFE) obj, &Nb));}
19155f80ce2aSJacob Faibussowitsch         else if (id == PETSCFV_CLASSID) {CHKERRQ(PetscFVGetNumComponents((PetscFV) obj, &Nc));Nb = 1;}
191698921bdaSJacob Faibussowitsch         else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", field);
19171555c271SMatthew G. Knepley         for (q = 0; q < Nq; ++q) {
19182a4e142eSMatthew G. Knepley           PetscFEGeom qgeom;
19192a4e142eSMatthew G. Knepley 
19202a4e142eSMatthew G. Knepley           qgeom.dimEmbed = fegeom.dimEmbed;
19212a4e142eSMatthew G. Knepley           qgeom.J        = &fegeom.J[q*coordDim*coordDim];
19222a4e142eSMatthew G. Knepley           qgeom.invJ     = &fegeom.invJ[q*coordDim*coordDim];
19232a4e142eSMatthew G. Knepley           qgeom.detJ     = &fegeom.detJ[q];
19245f80ce2aSJacob Faibussowitsch           PetscCheck(fegeom.detJ[q] > 0.0,PETSC_COMM_SELF, PETSC_ERR_ARG_OUTOFRANGE, "Invalid determinant %g for element %D, quadrature points %D", (double)fegeom.detJ[q], cell, q);
19255f80ce2aSJacob Faibussowitsch           if (id == PETSCFE_CLASSID)      CHKERRQ(PetscFEInterpolateGradient_Static((PetscFE) obj, 1, &x[fieldOffset], &qgeom, q, interpolant));
192698921bdaSJacob Faibussowitsch           else SETERRQ(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", field);
19271555c271SMatthew G. Knepley           for (fc = 0; fc < Nc; ++fc) {
192853d2db2dSJoe Wallwork             const PetscReal wt = quadWeights[q*qNc+qc];
19291555c271SMatthew G. Knepley 
19304bee2e38SMatthew G. Knepley             for (d = 0; d < coordDim; ++d) grad[fc*coordDim+d] += interpolant[fc*dim+d]*wt*fegeom.detJ[q];
19311555c271SMatthew G. Knepley           }
19324bee2e38SMatthew G. Knepley           vol += quadWeights[q*qNc]*fegeom.detJ[q];
19331555c271SMatthew G. Knepley         }
19341555c271SMatthew G. Knepley         fieldOffset += Nb;
19351555c271SMatthew G. Knepley         qc          += Nc;
19361555c271SMatthew G. Knepley       }
19375f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecRestoreClosure(dm, NULL, locX, cell, NULL, &x));
1938f8527842SMatthew G. Knepley       for (fc = 0; fc < numComponents; ++fc) {
1939f8527842SMatthew G. Knepley         for (d = 0; d < coordDim; ++d) {
1940f8527842SMatthew G. Knepley           gradsum[fc*coordDim+d] += grad[fc*coordDim+d];
1941f8527842SMatthew G. Knepley         }
1942f8527842SMatthew G. Knepley       }
1943f8527842SMatthew G. Knepley       volsum += vol;
1944db1066baSMatthew G. Knepley       if (debug) {
19455f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscPrintf(PETSC_COMM_SELF, "Vertex %" PetscInt_FMT " Cell %" PetscInt_FMT " gradient: [", v, cell));
19461555c271SMatthew G. Knepley         for (fc = 0; fc < numComponents; ++fc) {
19471555c271SMatthew G. Knepley           for (d = 0; d < coordDim; ++d) {
19485f80ce2aSJacob Faibussowitsch             if (fc || d > 0) CHKERRQ(PetscPrintf(PETSC_COMM_SELF, ", "));
19495f80ce2aSJacob Faibussowitsch             CHKERRQ(PetscPrintf(PETSC_COMM_SELF, "%g", (double)PetscRealPart(grad[fc*coordDim+d])));
19501555c271SMatthew G. Knepley           }
19511555c271SMatthew G. Knepley         }
19525f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscPrintf(PETSC_COMM_SELF, "]\n"));
1953db1066baSMatthew G. Knepley       }
19541555c271SMatthew G. Knepley     }
19551555c271SMatthew G. Knepley     for (fc = 0; fc < numComponents; ++fc) {
19561555c271SMatthew G. Knepley       for (d = 0; d < coordDim; ++d) gradsum[fc*coordDim+d] /= volsum;
19571555c271SMatthew G. Knepley     }
19585f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexRestoreTransitiveClosure(dm, v, PETSC_FALSE, &starSize, &star));
19595f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecSetClosure(dmC, NULL, locC, v, gradsum, INSERT_VALUES));
19601555c271SMatthew G. Knepley   }
19615f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree6(gradsum,interpolant,coords,fegeom.detJ,fegeom.J,fegeom.invJ));
19621555c271SMatthew G. Knepley   PetscFunctionReturn(0);
19631555c271SMatthew G. Knepley }
19641555c271SMatthew G. Knepley 
1965338f77d5SMatthew G. Knepley static PetscErrorCode DMPlexComputeIntegral_Internal(DM dm, Vec X, PetscInt cStart, PetscInt cEnd, PetscScalar *cintegral, void *user)
196673d901b8SMatthew G. Knepley {
1967338f77d5SMatthew G. Knepley   DM                 dmAux = NULL;
196861aaff12SToby Isaac   PetscDS            prob,    probAux = NULL;
196973d901b8SMatthew G. Knepley   PetscSection       section, sectionAux;
1970338f77d5SMatthew G. Knepley   Vec                locX,    locA;
1971c330f8ffSToby Isaac   PetscInt           dim, numCells = cEnd - cStart, c, f;
1972c330f8ffSToby Isaac   PetscBool          useFVM = PETSC_FALSE;
1973338f77d5SMatthew G. Knepley   /* DS */
1974338f77d5SMatthew G. Knepley   PetscInt           Nf,    totDim,    *uOff, *uOff_x, numConstants;
1975338f77d5SMatthew G. Knepley   PetscInt           NfAux, totDimAux, *aOff;
1976338f77d5SMatthew G. Knepley   PetscScalar       *u, *a;
1977338f77d5SMatthew G. Knepley   const PetscScalar *constants;
1978338f77d5SMatthew G. Knepley   /* Geometry */
1979c330f8ffSToby Isaac   PetscFEGeom       *cgeomFEM;
1980338f77d5SMatthew G. Knepley   DM                 dmGrad;
1981c330f8ffSToby Isaac   PetscQuadrature    affineQuad = NULL;
1982338f77d5SMatthew G. Knepley   Vec                cellGeometryFVM = NULL, faceGeometryFVM = NULL, locGrad = NULL;
1983b5a3613cSMatthew G. Knepley   PetscFVCellGeom   *cgeomFVM;
1984338f77d5SMatthew G. Knepley   const PetscScalar *lgrad;
1985b7260050SToby Isaac   PetscInt           maxDegree;
1986c330f8ffSToby Isaac   DMField            coordField;
1987c330f8ffSToby Isaac   IS                 cellIS;
198873d901b8SMatthew G. Knepley 
198973d901b8SMatthew G. Knepley   PetscFunctionBegin;
19905f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDS(dm, &prob));
19915f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dm, &dim));
19925f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &section));
19935f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetNumFields(dm, &Nf));
1994338f77d5SMatthew G. Knepley   /* Determine which discretizations we have */
1995b5a3613cSMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
1996b5a3613cSMatthew G. Knepley     PetscObject  obj;
1997b5a3613cSMatthew G. Knepley     PetscClassId id;
1998b5a3613cSMatthew G. Knepley 
19995f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, f, &obj));
20005f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
2001338f77d5SMatthew G. Knepley     if (id == PETSCFV_CLASSID) useFVM = PETSC_TRUE;
2002338f77d5SMatthew G. Knepley   }
2003338f77d5SMatthew G. Knepley   /* Get local solution with boundary values */
20045f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalVector(dm, &locX));
20055f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexInsertBoundaryValues(dm, PETSC_TRUE, locX, 0.0, NULL, NULL, NULL));
20065f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGlobalToLocalBegin(dm, X, INSERT_VALUES, locX));
20075f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGlobalToLocalEnd(dm, X, INSERT_VALUES, locX));
2008338f77d5SMatthew G. Knepley   /* Read DS information */
20095f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetTotalDimension(prob, &totDim));
20105f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetComponentOffsets(prob, &uOff));
20115f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetComponentDerivativeOffsets(prob, &uOff_x));
20125f80ce2aSJacob Faibussowitsch   CHKERRQ(ISCreateStride(PETSC_COMM_SELF,numCells,cStart,1,&cellIS));
20135f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetConstants(prob, &numConstants, &constants));
2014338f77d5SMatthew G. Knepley   /* Read Auxiliary DS information */
20155f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetAuxiliaryVec(dm, NULL, 0, 0, &locA));
20169a2a23afSMatthew G. Knepley   if (locA) {
20175f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetDM(locA, &dmAux));
20185f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetDS(dmAux, &probAux));
20195f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetNumFields(probAux, &NfAux));
20205f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetLocalSection(dmAux, &sectionAux));
20215f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetTotalDimension(probAux, &totDimAux));
20225f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetComponentOffsets(probAux, &aOff));
2023338f77d5SMatthew G. Knepley   }
2024338f77d5SMatthew G. Knepley   /* Allocate data  arrays */
20255f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscCalloc1(numCells*totDim, &u));
20265f80ce2aSJacob Faibussowitsch   if (dmAux) CHKERRQ(PetscMalloc1(numCells*totDimAux, &a));
2027338f77d5SMatthew G. Knepley   /* Read out geometry */
20285f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateField(dm,&coordField));
20295f80ce2aSJacob Faibussowitsch   CHKERRQ(DMFieldGetDegree(coordField,cellIS,NULL,&maxDegree));
2030b7260050SToby Isaac   if (maxDegree <= 1) {
20315f80ce2aSJacob Faibussowitsch     CHKERRQ(DMFieldCreateDefaultQuadrature(coordField,cellIS,&affineQuad));
2032c330f8ffSToby Isaac     if (affineQuad) {
20335f80ce2aSJacob Faibussowitsch       CHKERRQ(DMFieldCreateFEGeom(coordField,cellIS,affineQuad,PETSC_FALSE,&cgeomFEM));
2034338f77d5SMatthew G. Knepley     }
2035b5a3613cSMatthew G. Knepley   }
2036b5a3613cSMatthew G. Knepley   if (useFVM) {
2037338f77d5SMatthew G. Knepley     PetscFV   fv = NULL;
2038b5a3613cSMatthew G. Knepley     Vec       grad;
2039b5a3613cSMatthew G. Knepley     PetscInt  fStart, fEnd;
2040b5a3613cSMatthew G. Knepley     PetscBool compGrad;
2041b5a3613cSMatthew G. Knepley 
2042338f77d5SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
2043338f77d5SMatthew G. Knepley       PetscObject  obj;
2044338f77d5SMatthew G. Knepley       PetscClassId id;
2045338f77d5SMatthew G. Knepley 
20465f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetDiscretization(prob, f, &obj));
20475f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscObjectGetClassId(obj, &id));
2048338f77d5SMatthew G. Knepley       if (id == PETSCFV_CLASSID) {fv = (PetscFV) obj; break;}
2049338f77d5SMatthew G. Knepley     }
20505f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFVGetComputeGradients(fv, &compGrad));
20515f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFVSetComputeGradients(fv, PETSC_TRUE));
20525f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexComputeGeometryFVM(dm, &cellGeometryFVM, &faceGeometryFVM));
20535f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexComputeGradientFVM(dm, fv, faceGeometryFVM, cellGeometryFVM, &dmGrad));
20545f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFVSetComputeGradients(fv, compGrad));
20555f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetArrayRead(cellGeometryFVM, (const PetscScalar **) &cgeomFVM));
2056b5a3613cSMatthew G. Knepley     /* Reconstruct and limit cell gradients */
20575f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexGetHeightStratum(dm, 1, &fStart, &fEnd));
20585f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetGlobalVector(dmGrad, &grad));
20595f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexReconstructGradients_Internal(dm, fv, fStart, fEnd, faceGeometryFVM, cellGeometryFVM, locX, grad));
2060b5a3613cSMatthew G. Knepley     /* Communicate gradient values */
20615f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetLocalVector(dmGrad, &locGrad));
20625f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGlobalToLocalBegin(dmGrad, grad, INSERT_VALUES, locGrad));
20635f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGlobalToLocalEnd(dmGrad, grad, INSERT_VALUES, locGrad));
20645f80ce2aSJacob Faibussowitsch     CHKERRQ(DMRestoreGlobalVector(dmGrad, &grad));
2065b5a3613cSMatthew G. Knepley     /* Handle non-essential (e.g. outflow) boundary values */
20665f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexInsertBoundaryValues(dm, PETSC_FALSE, locX, 0.0, faceGeometryFVM, cellGeometryFVM, locGrad));
20675f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetArrayRead(locGrad, &lgrad));
2068b5a3613cSMatthew G. Knepley   }
2069338f77d5SMatthew G. Knepley   /* Read out data from inputs */
207073d901b8SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
207173d901b8SMatthew G. Knepley     PetscScalar *x = NULL;
207273d901b8SMatthew G. Knepley     PetscInt     i;
207373d901b8SMatthew G. Knepley 
20745f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecGetClosure(dm, section, locX, c, NULL, &x));
20750f2d7e86SMatthew G. Knepley     for (i = 0; i < totDim; ++i) u[c*totDim+i] = x[i];
20765f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecRestoreClosure(dm, section, locX, c, NULL, &x));
207773d901b8SMatthew G. Knepley     if (dmAux) {
20785f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecGetClosure(dmAux, sectionAux, locA, c, NULL, &x));
20790f2d7e86SMatthew G. Knepley       for (i = 0; i < totDimAux; ++i) a[c*totDimAux+i] = x[i];
20805f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecRestoreClosure(dmAux, sectionAux, locA, c, NULL, &x));
208173d901b8SMatthew G. Knepley     }
208273d901b8SMatthew G. Knepley   }
2083338f77d5SMatthew G. Knepley   /* Do integration for each field */
208473d901b8SMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
2085c1f031eeSMatthew G. Knepley     PetscObject  obj;
2086c1f031eeSMatthew G. Knepley     PetscClassId id;
2087c1f031eeSMatthew G. Knepley     PetscInt     numChunks, numBatches, batchSize, numBlocks, blockSize, Ne, Nr, offset;
208873d901b8SMatthew G. Knepley 
20895f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, f, &obj));
20905f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
2091c1f031eeSMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
2092c1f031eeSMatthew G. Knepley       PetscFE         fe = (PetscFE) obj;
2093c1f031eeSMatthew G. Knepley       PetscQuadrature q;
2094c330f8ffSToby Isaac       PetscFEGeom     *chunkGeom = NULL;
2095c1f031eeSMatthew G. Knepley       PetscInt        Nq, Nb;
2096c1f031eeSMatthew G. Knepley 
20975f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
20985f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetQuadrature(fe, &q));
20995f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscQuadratureGetData(q, NULL, NULL, &Nq, NULL, NULL));
21005f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetDimension(fe, &Nb));
2101c1f031eeSMatthew G. Knepley       blockSize = Nb*Nq;
210273d901b8SMatthew G. Knepley       batchSize = numBlocks * blockSize;
21035f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
210473d901b8SMatthew G. Knepley       numChunks = numCells / (numBatches*batchSize);
210573d901b8SMatthew G. Knepley       Ne        = numChunks*numBatches*batchSize;
210673d901b8SMatthew G. Knepley       Nr        = numCells % (numBatches*batchSize);
210773d901b8SMatthew G. Knepley       offset    = numCells - Nr;
2108c330f8ffSToby Isaac       if (!affineQuad) {
21095f80ce2aSJacob Faibussowitsch         CHKERRQ(DMFieldCreateFEGeom(coordField,cellIS,q,PETSC_FALSE,&cgeomFEM));
2110c330f8ffSToby Isaac       }
21115f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomGetChunk(cgeomFEM,0,offset,&chunkGeom));
21125f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEIntegrate(prob, f, Ne, chunkGeom, u, probAux, a, cintegral));
21135f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomGetChunk(cgeomFEM,offset,numCells,&chunkGeom));
21145f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEIntegrate(prob, f, Nr, chunkGeom, &u[offset*totDim], probAux, &a[offset*totDimAux], &cintegral[offset*Nf]));
21155f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomRestoreChunk(cgeomFEM,offset,numCells,&chunkGeom));
2116c330f8ffSToby Isaac       if (!affineQuad) {
21175f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGeomDestroy(&cgeomFEM));
2118c330f8ffSToby Isaac       }
2119c1f031eeSMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
2120c1f031eeSMatthew G. Knepley       PetscInt       foff;
2121420e96edSMatthew G. Knepley       PetscPointFunc obj_func;
2122b69edc29SMatthew G. Knepley       PetscScalar    lint;
2123c1f031eeSMatthew G. Knepley 
21245f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetObjective(prob, f, &obj_func));
21255f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetFieldOffset(prob, f, &foff));
2126c1f031eeSMatthew G. Knepley       if (obj_func) {
2127c1f031eeSMatthew G. Knepley         for (c = 0; c < numCells; ++c) {
2128b5a3613cSMatthew G. Knepley           PetscScalar *u_x;
2129b5a3613cSMatthew G. Knepley 
21305f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexPointLocalRead(dmGrad, c, lgrad, &u_x));
2131338f77d5SMatthew G. Knepley           obj_func(dim, Nf, NfAux, uOff, uOff_x, &u[totDim*c+foff], NULL, u_x, aOff, NULL, &a[totDimAux*c], NULL, NULL, 0.0, cgeomFVM[c].centroid, numConstants, constants, &lint);
2132338f77d5SMatthew G. Knepley           cintegral[c*Nf+f] += PetscRealPart(lint)*cgeomFVM[c].volume;
213373d901b8SMatthew G. Knepley         }
2134c1f031eeSMatthew G. Knepley       }
213598921bdaSJacob Faibussowitsch     } else SETERRQ(PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", f);
2136c1f031eeSMatthew G. Knepley   }
2137338f77d5SMatthew G. Knepley   /* Cleanup data arrays */
2138b5a3613cSMatthew G. Knepley   if (useFVM) {
21395f80ce2aSJacob Faibussowitsch     CHKERRQ(VecRestoreArrayRead(locGrad, &lgrad));
21405f80ce2aSJacob Faibussowitsch     CHKERRQ(VecRestoreArrayRead(cellGeometryFVM, (const PetscScalar **) &cgeomFVM));
21415f80ce2aSJacob Faibussowitsch     CHKERRQ(DMRestoreLocalVector(dmGrad, &locGrad));
21425f80ce2aSJacob Faibussowitsch     CHKERRQ(VecDestroy(&faceGeometryFVM));
21435f80ce2aSJacob Faibussowitsch     CHKERRQ(VecDestroy(&cellGeometryFVM));
21445f80ce2aSJacob Faibussowitsch     CHKERRQ(DMDestroy(&dmGrad));
2145b5a3613cSMatthew G. Knepley   }
21465f80ce2aSJacob Faibussowitsch   if (dmAux) CHKERRQ(PetscFree(a));
21475f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree(u));
2148338f77d5SMatthew G. Knepley   /* Cleanup */
2149f99c8401SToby Isaac   if (affineQuad) {
21505f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGeomDestroy(&cgeomFEM));
2151f99c8401SToby Isaac   }
21525f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscQuadratureDestroy(&affineQuad));
21535f80ce2aSJacob Faibussowitsch   CHKERRQ(ISDestroy(&cellIS));
21545f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreLocalVector(dm, &locX));
2155338f77d5SMatthew G. Knepley   PetscFunctionReturn(0);
2156338f77d5SMatthew G. Knepley }
2157338f77d5SMatthew G. Knepley 
2158338f77d5SMatthew G. Knepley /*@
2159338f77d5SMatthew G. Knepley   DMPlexComputeIntegralFEM - Form the integral over the domain from the global input X using pointwise functions specified by the user
2160338f77d5SMatthew G. Knepley 
2161338f77d5SMatthew G. Knepley   Input Parameters:
2162338f77d5SMatthew G. Knepley + dm - The mesh
2163338f77d5SMatthew G. Knepley . X  - Global input vector
2164338f77d5SMatthew G. Knepley - user - The user context
2165338f77d5SMatthew G. Knepley 
2166338f77d5SMatthew G. Knepley   Output Parameter:
2167338f77d5SMatthew G. Knepley . integral - Integral for each field
2168338f77d5SMatthew G. Knepley 
2169338f77d5SMatthew G. Knepley   Level: developer
2170338f77d5SMatthew G. Knepley 
2171446c23c1SPierre Jolivet .seealso: DMPlexSNESComputeResidualFEM()
2172338f77d5SMatthew G. Knepley @*/
2173b8feb594SMatthew G. Knepley PetscErrorCode DMPlexComputeIntegralFEM(DM dm, Vec X, PetscScalar *integral, void *user)
2174338f77d5SMatthew G. Knepley {
2175338f77d5SMatthew G. Knepley   DM_Plex       *mesh = (DM_Plex *) dm->data;
2176b8feb594SMatthew G. Knepley   PetscScalar   *cintegral, *lintegral;
2177412e9a14SMatthew G. Knepley   PetscInt       Nf, f, cellHeight, cStart, cEnd, cell;
2178338f77d5SMatthew G. Knepley 
2179338f77d5SMatthew G. Knepley   PetscFunctionBegin;
2180338f77d5SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
2181338f77d5SMatthew G. Knepley   PetscValidHeaderSpecific(X, VEC_CLASSID, 2);
2182*dadcf809SJacob Faibussowitsch   PetscValidScalarPointer(integral, 3);
21835f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventBegin(DMPLEX_IntegralFEM,dm,0,0,0));
21845f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetNumFields(dm, &Nf));
21855f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetVTKCellHeight(dm, &cellHeight));
21865f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetSimplexOrBoxCells(dm, cellHeight, &cStart, &cEnd));
2187338f77d5SMatthew G. Knepley   /* TODO Introduce a loop over large chunks (right now this is a single chunk) */
21885f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscCalloc2(Nf, &lintegral, (cEnd-cStart)*Nf, &cintegral));
21895f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexComputeIntegral_Internal(dm, X, cStart, cEnd, cintegral, user));
2190338f77d5SMatthew G. Knepley   /* Sum up values */
2191338f77d5SMatthew G. Knepley   for (cell = cStart; cell < cEnd; ++cell) {
2192338f77d5SMatthew G. Knepley     const PetscInt c = cell - cStart;
2193338f77d5SMatthew G. Knepley 
21945f80ce2aSJacob Faibussowitsch     if (mesh->printFEM > 1) CHKERRQ(DMPrintCellVector(cell, "Cell Integral", Nf, &cintegral[c*Nf]));
2195b8feb594SMatthew G. Knepley     for (f = 0; f < Nf; ++f) lintegral[f] += cintegral[c*Nf+f];
2196338f77d5SMatthew G. Knepley   }
21975f80ce2aSJacob Faibussowitsch   CHKERRMPI(MPIU_Allreduce(lintegral, integral, Nf, MPIU_SCALAR, MPIU_SUM, PetscObjectComm((PetscObject) dm)));
219873d901b8SMatthew G. Knepley   if (mesh->printFEM) {
21995f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscPrintf(PetscObjectComm((PetscObject) dm), "Integral:"));
22005f80ce2aSJacob Faibussowitsch     for (f = 0; f < Nf; ++f) CHKERRQ(PetscPrintf(PetscObjectComm((PetscObject) dm), " %g", (double) PetscRealPart(integral[f])));
22015f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscPrintf(PetscObjectComm((PetscObject) dm), "\n"));
220273d901b8SMatthew G. Knepley   }
22035f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree2(lintegral, cintegral));
22045f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventEnd(DMPLEX_IntegralFEM,dm,0,0,0));
2205338f77d5SMatthew G. Knepley   PetscFunctionReturn(0);
2206338f77d5SMatthew G. Knepley }
2207338f77d5SMatthew G. Knepley 
2208338f77d5SMatthew G. Knepley /*@
2209338f77d5SMatthew G. Knepley   DMPlexComputeCellwiseIntegralFEM - Form the vector of cellwise integrals F from the global input X using pointwise functions specified by the user
2210338f77d5SMatthew G. Knepley 
2211338f77d5SMatthew G. Knepley   Input Parameters:
2212338f77d5SMatthew G. Knepley + dm - The mesh
2213338f77d5SMatthew G. Knepley . X  - Global input vector
2214338f77d5SMatthew G. Knepley - user - The user context
2215338f77d5SMatthew G. Knepley 
2216338f77d5SMatthew G. Knepley   Output Parameter:
2217338f77d5SMatthew G. Knepley . integral - Cellwise integrals for each field
2218338f77d5SMatthew G. Knepley 
2219338f77d5SMatthew G. Knepley   Level: developer
2220338f77d5SMatthew G. Knepley 
2221446c23c1SPierre Jolivet .seealso: DMPlexSNESComputeResidualFEM()
2222338f77d5SMatthew G. Knepley @*/
2223338f77d5SMatthew G. Knepley PetscErrorCode DMPlexComputeCellwiseIntegralFEM(DM dm, Vec X, Vec F, void *user)
2224338f77d5SMatthew G. Knepley {
2225338f77d5SMatthew G. Knepley   DM_Plex       *mesh = (DM_Plex *) dm->data;
2226338f77d5SMatthew G. Knepley   DM             dmF;
2227338f77d5SMatthew G. Knepley   PetscSection   sectionF;
2228338f77d5SMatthew G. Knepley   PetscScalar   *cintegral, *af;
2229412e9a14SMatthew G. Knepley   PetscInt       Nf, f, cellHeight, cStart, cEnd, cell;
2230338f77d5SMatthew G. Knepley 
2231338f77d5SMatthew G. Knepley   PetscFunctionBegin;
2232338f77d5SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
2233338f77d5SMatthew G. Knepley   PetscValidHeaderSpecific(X, VEC_CLASSID, 2);
2234338f77d5SMatthew G. Knepley   PetscValidHeaderSpecific(F, VEC_CLASSID, 3);
22355f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventBegin(DMPLEX_IntegralFEM,dm,0,0,0));
22365f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetNumFields(dm, &Nf));
22375f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetVTKCellHeight(dm, &cellHeight));
22385f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetSimplexOrBoxCells(dm, cellHeight, &cStart, &cEnd));
2239338f77d5SMatthew G. Knepley   /* TODO Introduce a loop over large chunks (right now this is a single chunk) */
22405f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscCalloc1((cEnd-cStart)*Nf, &cintegral));
22415f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexComputeIntegral_Internal(dm, X, cStart, cEnd, cintegral, user));
2242338f77d5SMatthew G. Knepley   /* Put values in F*/
22435f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetDM(F, &dmF));
22445f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dmF, &sectionF));
22455f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetArray(F, &af));
2246338f77d5SMatthew G. Knepley   for (cell = cStart; cell < cEnd; ++cell) {
2247338f77d5SMatthew G. Knepley     const PetscInt c = cell - cStart;
2248338f77d5SMatthew G. Knepley     PetscInt       dof, off;
2249338f77d5SMatthew G. Knepley 
22505f80ce2aSJacob Faibussowitsch     if (mesh->printFEM > 1) CHKERRQ(DMPrintCellVector(cell, "Cell Integral", Nf, &cintegral[c*Nf]));
22515f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscSectionGetDof(sectionF, cell, &dof));
22525f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscSectionGetOffset(sectionF, cell, &off));
22535f80ce2aSJacob Faibussowitsch     PetscCheck(dof == Nf,PETSC_COMM_SELF, PETSC_ERR_ARG_SIZ, "The number of cell dofs %D != %D", dof, Nf);
2254338f77d5SMatthew G. Knepley     for (f = 0; f < Nf; ++f) af[off+f] = cintegral[c*Nf+f];
2255338f77d5SMatthew G. Knepley   }
22565f80ce2aSJacob Faibussowitsch   CHKERRQ(VecRestoreArray(F, &af));
22575f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree(cintegral));
22585f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventEnd(DMPLEX_IntegralFEM,dm,0,0,0));
225973d901b8SMatthew G. Knepley   PetscFunctionReturn(0);
226073d901b8SMatthew G. Knepley }
226173d901b8SMatthew G. Knepley 
22629b6f715bSMatthew G. Knepley static PetscErrorCode DMPlexComputeBdIntegral_Internal(DM dm, Vec locX, IS pointIS,
22639b6f715bSMatthew G. Knepley                                                        void (*func)(PetscInt, PetscInt, PetscInt,
226464c72086SMatthew G. Knepley                                                                     const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
226564c72086SMatthew G. Knepley                                                                     const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
226664c72086SMatthew G. Knepley                                                                     PetscReal, const PetscReal[], const PetscReal[], PetscInt, const PetscScalar[], PetscScalar[]),
226764c72086SMatthew G. Knepley                                                        PetscScalar *fintegral, void *user)
226864c72086SMatthew G. Knepley {
22699b6f715bSMatthew G. Knepley   DM                 plex = NULL, plexA = NULL;
2270a6e0b375SMatthew G. Knepley   DMEnclosureType    encAux;
22719b6f715bSMatthew G. Knepley   PetscDS            prob, probAux = NULL;
22729b6f715bSMatthew G. Knepley   PetscSection       section, sectionAux = NULL;
22739b6f715bSMatthew G. Knepley   Vec                locA = NULL;
22749b6f715bSMatthew G. Knepley   DMField            coordField;
22759b6f715bSMatthew G. Knepley   PetscInt           Nf,        totDim,        *uOff, *uOff_x;
22769b6f715bSMatthew G. Knepley   PetscInt           NfAux = 0, totDimAux = 0, *aOff = NULL;
22779b6f715bSMatthew G. Knepley   PetscScalar       *u, *a = NULL;
227864c72086SMatthew G. Knepley   const PetscScalar *constants;
22799b6f715bSMatthew G. Knepley   PetscInt           numConstants, f;
228064c72086SMatthew G. Knepley 
228164c72086SMatthew G. Knepley   PetscFunctionBegin;
22825f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateField(dm, &coordField));
22835f80ce2aSJacob Faibussowitsch   CHKERRQ(DMConvert(dm, DMPLEX, &plex));
22845f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDS(dm, &prob));
22855f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &section));
22865f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetNumFields(section, &Nf));
228764c72086SMatthew G. Knepley   /* Determine which discretizations we have */
22889b6f715bSMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
228964c72086SMatthew G. Knepley     PetscObject  obj;
229064c72086SMatthew G. Knepley     PetscClassId id;
229164c72086SMatthew G. Knepley 
22925f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, f, &obj));
22935f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
22945f80ce2aSJacob Faibussowitsch     PetscCheck(id != PETSCFV_CLASSID,PetscObjectComm((PetscObject) dm), PETSC_ERR_SUP, "Not supported for FVM (field %D)", f);
229564c72086SMatthew G. Knepley   }
229664c72086SMatthew G. Knepley   /* Read DS information */
22975f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetTotalDimension(prob, &totDim));
22985f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetComponentOffsets(prob, &uOff));
22995f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetComponentDerivativeOffsets(prob, &uOff_x));
23005f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetConstants(prob, &numConstants, &constants));
230164c72086SMatthew G. Knepley   /* Read Auxiliary DS information */
23025f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetAuxiliaryVec(dm, NULL, 0, 0, &locA));
23039b6f715bSMatthew G. Knepley   if (locA) {
23049b6f715bSMatthew G. Knepley     DM dmAux;
23059b6f715bSMatthew G. Knepley 
23065f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetDM(locA, &dmAux));
23075f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetEnclosureRelation(dmAux, dm, &encAux));
23085f80ce2aSJacob Faibussowitsch     CHKERRQ(DMConvert(dmAux, DMPLEX, &plexA));
23095f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetDS(dmAux, &probAux));
23105f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetNumFields(probAux, &NfAux));
23115f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetLocalSection(dmAux, &sectionAux));
23125f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetTotalDimension(probAux, &totDimAux));
23135f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetComponentOffsets(probAux, &aOff));
231464c72086SMatthew G. Knepley   }
23159b6f715bSMatthew G. Knepley   /* Integrate over points */
23169b6f715bSMatthew G. Knepley   {
23179b6f715bSMatthew G. Knepley     PetscFEGeom    *fgeom, *chunkGeom = NULL;
2318b7260050SToby Isaac     PetscInt        maxDegree;
23199b6f715bSMatthew G. Knepley     PetscQuadrature qGeom = NULL;
23209b6f715bSMatthew G. Knepley     const PetscInt *points;
23219b6f715bSMatthew G. Knepley     PetscInt        numFaces, face, Nq, field;
23229b6f715bSMatthew G. Knepley     PetscInt        numChunks, chunkSize, chunk, Nr, offset;
232364c72086SMatthew G. Knepley 
23245f80ce2aSJacob Faibussowitsch     CHKERRQ(ISGetLocalSize(pointIS, &numFaces));
23255f80ce2aSJacob Faibussowitsch     CHKERRQ(ISGetIndices(pointIS, &points));
23265f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscCalloc2(numFaces*totDim, &u, locA ? numFaces*totDimAux : 0, &a));
23275f80ce2aSJacob Faibussowitsch     CHKERRQ(DMFieldGetDegree(coordField, pointIS, NULL, &maxDegree));
232864c72086SMatthew G. Knepley     for (field = 0; field < Nf; ++field) {
232964c72086SMatthew G. Knepley       PetscFE fe;
233064c72086SMatthew G. Knepley 
23315f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetDiscretization(prob, field, (PetscObject *) &fe));
23325f80ce2aSJacob Faibussowitsch       if (maxDegree <= 1) CHKERRQ(DMFieldCreateDefaultQuadrature(coordField, pointIS, &qGeom));
23339b6f715bSMatthew G. Knepley       if (!qGeom) {
23345f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGetFaceQuadrature(fe, &qGeom));
23355f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscObjectReference((PetscObject) qGeom));
23369b6f715bSMatthew G. Knepley       }
23375f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscQuadratureGetData(qGeom, NULL, NULL, &Nq, NULL, NULL));
23385f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetFEGeom(coordField, pointIS, qGeom, PETSC_TRUE, &fgeom));
23399b6f715bSMatthew G. Knepley       for (face = 0; face < numFaces; ++face) {
2340f15274beSMatthew Knepley         const PetscInt point = points[face], *support;
23419b6f715bSMatthew G. Knepley         PetscScalar    *x    = NULL;
2342f15274beSMatthew Knepley         PetscInt       i;
23439b6f715bSMatthew G. Knepley 
23445f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexGetSupport(dm, point, &support));
23455f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecGetClosure(plex, section, locX, support[0], NULL, &x));
23469b6f715bSMatthew G. Knepley         for (i = 0; i < totDim; ++i) u[face*totDim+i] = x[i];
23475f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecRestoreClosure(plex, section, locX, support[0], NULL, &x));
23489b6f715bSMatthew G. Knepley         if (locA) {
23499b6f715bSMatthew G. Knepley           PetscInt subp;
23505f80ce2aSJacob Faibussowitsch           CHKERRQ(DMGetEnclosurePoint(plexA, dm, encAux, support[0], &subp));
23515f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexVecGetClosure(plexA, sectionAux, locA, subp, NULL, &x));
23529b6f715bSMatthew G. Knepley           for (i = 0; i < totDimAux; ++i) a[f*totDimAux+i] = x[i];
23535f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexVecRestoreClosure(plexA, sectionAux, locA, subp, NULL, &x));
23549b6f715bSMatthew G. Knepley         }
23559b6f715bSMatthew G. Knepley       }
23569b6f715bSMatthew G. Knepley       /* Get blocking */
23579b6f715bSMatthew G. Knepley       {
23589b6f715bSMatthew G. Knepley         PetscQuadrature q;
23599b6f715bSMatthew G. Knepley         PetscInt        numBatches, batchSize, numBlocks, blockSize;
23609b6f715bSMatthew G. Knepley         PetscInt        Nq, Nb;
23619b6f715bSMatthew G. Knepley 
23625f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
23635f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGetQuadrature(fe, &q));
23645f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscQuadratureGetData(q, NULL, NULL, &Nq, NULL, NULL));
23655f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGetDimension(fe, &Nb));
236664c72086SMatthew G. Knepley         blockSize = Nb*Nq;
236764c72086SMatthew G. Knepley         batchSize = numBlocks * blockSize;
23689b6f715bSMatthew G. Knepley         chunkSize = numBatches*batchSize;
23695f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
23709b6f715bSMatthew G. Knepley         numChunks = numFaces / chunkSize;
23719b6f715bSMatthew G. Knepley         Nr        = numFaces % chunkSize;
237264c72086SMatthew G. Knepley         offset    = numFaces - Nr;
237364c72086SMatthew G. Knepley       }
23749b6f715bSMatthew G. Knepley       /* Do integration for each field */
23759b6f715bSMatthew G. Knepley       for (chunk = 0; chunk < numChunks; ++chunk) {
23765f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGeomGetChunk(fgeom, chunk*chunkSize, (chunk+1)*chunkSize, &chunkGeom));
23775f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEIntegrateBd(prob, field, func, chunkSize, chunkGeom, u, probAux, a, fintegral));
23785f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGeomRestoreChunk(fgeom, 0, offset, &chunkGeom));
237964c72086SMatthew G. Knepley       }
23805f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomGetChunk(fgeom, offset, numFaces, &chunkGeom));
23815f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEIntegrateBd(prob, field, func, Nr, chunkGeom, &u[offset*totDim], probAux, a ? &a[offset*totDimAux] : NULL, &fintegral[offset*Nf]));
23825f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomRestoreChunk(fgeom, offset, numFaces, &chunkGeom));
238364c72086SMatthew G. Knepley       /* Cleanup data arrays */
23845f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexRestoreFEGeom(coordField, pointIS, qGeom, PETSC_TRUE, &fgeom));
23855f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscQuadratureDestroy(&qGeom));
23865f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFree2(u, a));
23875f80ce2aSJacob Faibussowitsch       CHKERRQ(ISRestoreIndices(pointIS, &points));
238864c72086SMatthew G. Knepley     }
238964c72086SMatthew G. Knepley   }
23905f80ce2aSJacob Faibussowitsch   if (plex)  CHKERRQ(DMDestroy(&plex));
23915f80ce2aSJacob Faibussowitsch   if (plexA) CHKERRQ(DMDestroy(&plexA));
23929b6f715bSMatthew G. Knepley   PetscFunctionReturn(0);
23939b6f715bSMatthew G. Knepley }
23949b6f715bSMatthew G. Knepley 
23959b6f715bSMatthew G. Knepley /*@
23969b6f715bSMatthew G. Knepley   DMPlexComputeBdIntegral - Form the integral over the specified boundary from the global input X using pointwise functions specified by the user
23979b6f715bSMatthew G. Knepley 
23989b6f715bSMatthew G. Knepley   Input Parameters:
23999b6f715bSMatthew G. Knepley + dm      - The mesh
24009b6f715bSMatthew G. Knepley . X       - Global input vector
24019b6f715bSMatthew G. Knepley . label   - The boundary DMLabel
24029b6f715bSMatthew G. Knepley . numVals - The number of label values to use, or PETSC_DETERMINE for all values
24039b6f715bSMatthew G. Knepley . vals    - The label values to use, or PETSC_NULL for all values
240467b8a455SSatish Balay . func    - The function to integrate along the boundary
24059b6f715bSMatthew G. Knepley - user    - The user context
24069b6f715bSMatthew G. Knepley 
24079b6f715bSMatthew G. Knepley   Output Parameter:
24089b6f715bSMatthew G. Knepley . integral - Integral for each field
24099b6f715bSMatthew G. Knepley 
24109b6f715bSMatthew G. Knepley   Level: developer
24119b6f715bSMatthew G. Knepley 
24129b6f715bSMatthew G. Knepley .seealso: DMPlexComputeIntegralFEM(), DMPlexComputeBdResidualFEM()
24139b6f715bSMatthew G. Knepley @*/
24149b6f715bSMatthew G. Knepley PetscErrorCode DMPlexComputeBdIntegral(DM dm, Vec X, DMLabel label, PetscInt numVals, const PetscInt vals[],
24159b6f715bSMatthew G. Knepley                                        void (*func)(PetscInt, PetscInt, PetscInt,
24169b6f715bSMatthew G. Knepley                                                     const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
24179b6f715bSMatthew G. Knepley                                                     const PetscInt[], const PetscInt[], const PetscScalar[], const PetscScalar[], const PetscScalar[],
24189b6f715bSMatthew G. Knepley                                                     PetscReal, const PetscReal[], const PetscReal[], PetscInt, const PetscScalar[], PetscScalar[]),
24199b6f715bSMatthew G. Knepley                                        PetscScalar *integral, void *user)
24209b6f715bSMatthew G. Knepley {
24219b6f715bSMatthew G. Knepley   Vec            locX;
24229b6f715bSMatthew G. Knepley   PetscSection   section;
24239b6f715bSMatthew G. Knepley   DMLabel        depthLabel;
24249b6f715bSMatthew G. Knepley   IS             facetIS;
24259b6f715bSMatthew G. Knepley   PetscInt       dim, Nf, f, v;
24269b6f715bSMatthew G. Knepley 
24279b6f715bSMatthew G. Knepley   PetscFunctionBegin;
24289b6f715bSMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
24299b6f715bSMatthew G. Knepley   PetscValidHeaderSpecific(X, VEC_CLASSID, 2);
24309b6f715bSMatthew G. Knepley   PetscValidPointer(label, 3);
2431*dadcf809SJacob Faibussowitsch   if (vals) PetscValidIntPointer(vals, 5);
2432*dadcf809SJacob Faibussowitsch   PetscValidScalarPointer(integral, 7);
24335f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventBegin(DMPLEX_IntegralFEM,dm,0,0,0));
24345f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetDepthLabel(dm, &depthLabel));
24355f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dm, &dim));
24365f80ce2aSJacob Faibussowitsch   CHKERRQ(DMLabelGetStratumIS(depthLabel, dim-1, &facetIS));
24375f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &section));
24385f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetNumFields(section, &Nf));
24399b6f715bSMatthew G. Knepley   /* Get local solution with boundary values */
24405f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalVector(dm, &locX));
24415f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexInsertBoundaryValues(dm, PETSC_TRUE, locX, 0.0, NULL, NULL, NULL));
24425f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGlobalToLocalBegin(dm, X, INSERT_VALUES, locX));
24435f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGlobalToLocalEnd(dm, X, INSERT_VALUES, locX));
24449b6f715bSMatthew G. Knepley   /* Loop over label values */
24455f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscArrayzero(integral, Nf));
24469b6f715bSMatthew G. Knepley   for (v = 0; v < numVals; ++v) {
24479b6f715bSMatthew G. Knepley     IS           pointIS;
24489b6f715bSMatthew G. Knepley     PetscInt     numFaces, face;
24499b6f715bSMatthew G. Knepley     PetscScalar *fintegral;
24509b6f715bSMatthew G. Knepley 
24515f80ce2aSJacob Faibussowitsch     CHKERRQ(DMLabelGetStratumIS(label, vals[v], &pointIS));
24529b6f715bSMatthew G. Knepley     if (!pointIS) continue; /* No points with that id on this process */
24539b6f715bSMatthew G. Knepley     {
24549b6f715bSMatthew G. Knepley       IS isectIS;
24559b6f715bSMatthew G. Knepley 
24569b6f715bSMatthew G. Knepley       /* TODO: Special cases of ISIntersect where it is quick to check a priori if one is a superset of the other */
24575f80ce2aSJacob Faibussowitsch       CHKERRQ(ISIntersect_Caching_Internal(facetIS, pointIS, &isectIS));
24585f80ce2aSJacob Faibussowitsch       CHKERRQ(ISDestroy(&pointIS));
24599b6f715bSMatthew G. Knepley       pointIS = isectIS;
24609b6f715bSMatthew G. Knepley     }
24615f80ce2aSJacob Faibussowitsch     CHKERRQ(ISGetLocalSize(pointIS, &numFaces));
24625f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscCalloc1(numFaces*Nf, &fintegral));
24635f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexComputeBdIntegral_Internal(dm, locX, pointIS, func, fintegral, user));
24649b6f715bSMatthew G. Knepley     /* Sum point contributions into integral */
24659b6f715bSMatthew G. Knepley     for (f = 0; f < Nf; ++f) for (face = 0; face < numFaces; ++face) integral[f] += fintegral[face*Nf+f];
24665f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFree(fintegral));
24675f80ce2aSJacob Faibussowitsch     CHKERRQ(ISDestroy(&pointIS));
24689b6f715bSMatthew G. Knepley   }
24695f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreLocalVector(dm, &locX));
24705f80ce2aSJacob Faibussowitsch   CHKERRQ(ISDestroy(&facetIS));
24715f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventEnd(DMPLEX_IntegralFEM,dm,0,0,0));
247264c72086SMatthew G. Knepley   PetscFunctionReturn(0);
247364c72086SMatthew G. Knepley }
247464c72086SMatthew G. Knepley 
2475d69c5d34SMatthew G. Knepley /*@
2476cf51de39SMatthew G. Knepley   DMPlexComputeInterpolatorNested - Form the local portion of the interpolation matrix I from the coarse DM to a uniformly refined DM.
2477d69c5d34SMatthew G. Knepley 
2478d69c5d34SMatthew G. Knepley   Input Parameters:
2479cf51de39SMatthew G. Knepley + dmc  - The coarse mesh
2480cf51de39SMatthew G. Knepley . dmf  - The fine mesh
2481cf51de39SMatthew G. Knepley . isRefined - Flag indicating regular refinement, rather than the same topology
2482d69c5d34SMatthew G. Knepley - user - The user context
2483d69c5d34SMatthew G. Knepley 
2484d69c5d34SMatthew G. Knepley   Output Parameter:
2485934789fcSMatthew G. Knepley . In  - The interpolation matrix
2486d69c5d34SMatthew G. Knepley 
2487d69c5d34SMatthew G. Knepley   Level: developer
2488d69c5d34SMatthew G. Knepley 
248968132eb9SMatthew G. Knepley .seealso: DMPlexComputeInterpolatorGeneral(), DMPlexComputeJacobianFEM()
2490d69c5d34SMatthew G. Knepley @*/
2491cf51de39SMatthew G. Knepley PetscErrorCode DMPlexComputeInterpolatorNested(DM dmc, DM dmf, PetscBool isRefined, Mat In, void *user)
2492d69c5d34SMatthew G. Knepley {
2493d69c5d34SMatthew G. Knepley   DM_Plex          *mesh  = (DM_Plex *) dmc->data;
2494d69c5d34SMatthew G. Knepley   const char       *name  = "Interpolator";
2495d69c5d34SMatthew G. Knepley   PetscFE          *feRef;
249697c42addSMatthew G. Knepley   PetscFV          *fvRef;
2497d69c5d34SMatthew G. Knepley   PetscSection      fsection, fglobalSection;
2498d69c5d34SMatthew G. Knepley   PetscSection      csection, cglobalSection;
2499d69c5d34SMatthew G. Knepley   PetscScalar      *elemMat;
2500485ad865SMatthew G. Knepley   PetscInt          dim, Nf, f, fieldI, fieldJ, offsetI, offsetJ, cStart, cEnd, c;
25012ea9c922SToby Isaac   PetscInt          cTotDim=0, rTotDim = 0;
2502d69c5d34SMatthew G. Knepley 
2503d69c5d34SMatthew G. Knepley   PetscFunctionBegin;
25045f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventBegin(DMPLEX_InterpolatorFEM,dmc,dmf,0,0));
25055f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dmf, &dim));
25065f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dmf, &fsection));
25075f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetGlobalSection(dmf, &fglobalSection));
25085f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dmc, &csection));
25095f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetGlobalSection(dmc, &cglobalSection));
25105f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetNumFields(fsection, &Nf));
25115f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetSimplexOrBoxCells(dmc, 0, &cStart, &cEnd));
25125f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscCalloc2(Nf, &feRef, Nf, &fvRef));
2513d69c5d34SMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
25142ea9c922SToby Isaac     PetscObject  obj, objc;
25152ea9c922SToby Isaac     PetscClassId id, idc;
25162ea9c922SToby Isaac     PetscInt     rNb = 0, Nc = 0, cNb = 0;
2517d69c5d34SMatthew G. Knepley 
25185f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetField(dmf, f, NULL, &obj));
25195f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
252097c42addSMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
252197c42addSMatthew G. Knepley       PetscFE fe = (PetscFE) obj;
252297c42addSMatthew G. Knepley 
2523cf51de39SMatthew G. Knepley       if (isRefined) {
25245f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFERefine(fe, &feRef[f]));
2525cf51de39SMatthew G. Knepley       } else {
25265f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscObjectReference((PetscObject) fe));
2527cf51de39SMatthew G. Knepley         feRef[f] = fe;
2528cf51de39SMatthew G. Knepley       }
25295f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetDimension(feRef[f], &rNb));
25305f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetNumComponents(fe, &Nc));
253197c42addSMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
253297c42addSMatthew G. Knepley       PetscFV        fv = (PetscFV) obj;
253397c42addSMatthew G. Knepley       PetscDualSpace Q;
253497c42addSMatthew G. Knepley 
2535cf51de39SMatthew G. Knepley       if (isRefined) {
25365f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFVRefine(fv, &fvRef[f]));
2537cf51de39SMatthew G. Knepley       } else {
25385f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscObjectReference((PetscObject) fv));
2539cf51de39SMatthew G. Knepley         fvRef[f] = fv;
2540cf51de39SMatthew G. Knepley       }
25415f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetDualSpace(fvRef[f], &Q));
25425f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDualSpaceGetDimension(Q, &rNb));
25435f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetDualSpace(fv, &Q));
25445f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetNumComponents(fv, &Nc));
254597c42addSMatthew G. Knepley     }
25465f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetField(dmc, f, NULL, &objc));
25475f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(objc, &idc));
25482ea9c922SToby Isaac     if (idc == PETSCFE_CLASSID) {
25492ea9c922SToby Isaac       PetscFE fe = (PetscFE) objc;
25502ea9c922SToby Isaac 
25515f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetDimension(fe, &cNb));
25522ea9c922SToby Isaac     } else if (id == PETSCFV_CLASSID) {
25532ea9c922SToby Isaac       PetscFV        fv = (PetscFV) obj;
25542ea9c922SToby Isaac       PetscDualSpace Q;
25552ea9c922SToby Isaac 
25565f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetDualSpace(fv, &Q));
25575f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDualSpaceGetDimension(Q, &cNb));
2558d69c5d34SMatthew G. Knepley     }
25592ea9c922SToby Isaac     rTotDim += rNb;
25602ea9c922SToby Isaac     cTotDim += cNb;
25612ea9c922SToby Isaac   }
25625f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc1(rTotDim*cTotDim,&elemMat));
25635f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscArrayzero(elemMat, rTotDim*cTotDim));
2564d69c5d34SMatthew G. Knepley   for (fieldI = 0, offsetI = 0; fieldI < Nf; ++fieldI) {
2565d69c5d34SMatthew G. Knepley     PetscDualSpace   Qref;
2566d69c5d34SMatthew G. Knepley     PetscQuadrature  f;
2567d69c5d34SMatthew G. Knepley     const PetscReal *qpoints, *qweights;
2568d69c5d34SMatthew G. Knepley     PetscReal       *points;
2569d69c5d34SMatthew G. Knepley     PetscInt         npoints = 0, Nc, Np, fpdim, i, k, p, d;
2570d69c5d34SMatthew G. Knepley 
2571d69c5d34SMatthew G. Knepley     /* Compose points from all dual basis functionals */
257297c42addSMatthew G. Knepley     if (feRef[fieldI]) {
25735f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetDualSpace(feRef[fieldI], &Qref));
25745f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetNumComponents(feRef[fieldI], &Nc));
257597c42addSMatthew G. Knepley     } else {
25765f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetDualSpace(fvRef[fieldI], &Qref));
25775f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetNumComponents(fvRef[fieldI], &Nc));
257897c42addSMatthew G. Knepley     }
25795f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDualSpaceGetDimension(Qref, &fpdim));
2580d69c5d34SMatthew G. Knepley     for (i = 0; i < fpdim; ++i) {
25815f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDualSpaceGetFunctional(Qref, i, &f));
25825f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscQuadratureGetData(f, NULL, NULL, &Np, NULL, NULL));
2583d69c5d34SMatthew G. Knepley       npoints += Np;
2584d69c5d34SMatthew G. Knepley     }
25855f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscMalloc1(npoints*dim,&points));
2586d69c5d34SMatthew G. Knepley     for (i = 0, k = 0; i < fpdim; ++i) {
25875f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDualSpaceGetFunctional(Qref, i, &f));
25885f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscQuadratureGetData(f, NULL, NULL, &Np, &qpoints, NULL));
2589d69c5d34SMatthew G. Knepley       for (p = 0; p < Np; ++p, ++k) for (d = 0; d < dim; ++d) points[k*dim+d] = qpoints[p*dim+d];
2590d69c5d34SMatthew G. Knepley     }
2591d69c5d34SMatthew G. Knepley 
2592d69c5d34SMatthew G. Knepley     for (fieldJ = 0, offsetJ = 0; fieldJ < Nf; ++fieldJ) {
259397c42addSMatthew G. Knepley       PetscObject  obj;
259497c42addSMatthew G. Knepley       PetscClassId id;
25959c3cf19fSMatthew G. Knepley       PetscInt     NcJ = 0, cpdim = 0, j, qNc;
2596d69c5d34SMatthew G. Knepley 
25975f80ce2aSJacob Faibussowitsch       CHKERRQ(DMGetField(dmc, fieldJ, NULL, &obj));
25985f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscObjectGetClassId(obj, &id));
259997c42addSMatthew G. Knepley       if (id == PETSCFE_CLASSID) {
260097c42addSMatthew G. Knepley         PetscFE           fe = (PetscFE) obj;
2601ef0bb6c7SMatthew G. Knepley         PetscTabulation T  = NULL;
2602d69c5d34SMatthew G. Knepley 
2603d69c5d34SMatthew G. Knepley         /* Evaluate basis at points */
26045f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGetNumComponents(fe, &NcJ));
26055f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGetDimension(fe, &cpdim));
2606ffe73a53SMatthew G. Knepley         /* For now, fields only interpolate themselves */
2607ffe73a53SMatthew G. Knepley         if (fieldI == fieldJ) {
26085f80ce2aSJacob Faibussowitsch           PetscCheck(Nc == NcJ,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of components in fine space field %D does not match coarse field %D", Nc, NcJ);
26095f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFECreateTabulation(fe, 1, npoints, points, 0, &T));
2610d69c5d34SMatthew G. Knepley           for (i = 0, k = 0; i < fpdim; ++i) {
26115f80ce2aSJacob Faibussowitsch             CHKERRQ(PetscDualSpaceGetFunctional(Qref, i, &f));
26125f80ce2aSJacob Faibussowitsch             CHKERRQ(PetscQuadratureGetData(f, NULL, &qNc, &Np, NULL, &qweights));
26135f80ce2aSJacob Faibussowitsch             PetscCheck(qNc == NcJ,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of components in quadrature %D does not match coarse field %D", qNc, NcJ);
2614d69c5d34SMatthew G. Knepley             for (p = 0; p < Np; ++p, ++k) {
261536a6d9c0SMatthew G. Knepley               for (j = 0; j < cpdim; ++j) {
2616d172c84bSMatthew G. Knepley                 /*
2617d172c84bSMatthew G. Knepley                    cTotDim:            Total columns in element interpolation matrix, sum of number of dual basis functionals in each field
2618d172c84bSMatthew G. Knepley                    offsetI, offsetJ:   Offsets into the larger element interpolation matrix for different fields
2619d172c84bSMatthew G. Knepley                    fpdim, i, cpdim, j: Dofs for fine and coarse grids, correspond to dual space basis functionals
2620d172c84bSMatthew G. Knepley                    qNC, Nc, Ncj, c:    Number of components in this field
2621d172c84bSMatthew G. Knepley                    Np, p:              Number of quad points in the fine grid functional i
2622d172c84bSMatthew G. Knepley                    k:                  i*Np + p, overall point number for the interpolation
2623d172c84bSMatthew G. Knepley                 */
2624ef0bb6c7SMatthew G. Knepley                 for (c = 0; c < Nc; ++c) elemMat[(offsetI + i)*cTotDim + offsetJ + j] += T->T[0][k*cpdim*NcJ+j*Nc+c]*qweights[p*qNc+c];
262536a6d9c0SMatthew G. Knepley               }
2626d69c5d34SMatthew G. Knepley             }
2627d69c5d34SMatthew G. Knepley           }
26285f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscTabulationDestroy(&T));
2629ffe73a53SMatthew G. Knepley         }
263097c42addSMatthew G. Knepley       } else if (id == PETSCFV_CLASSID) {
263197c42addSMatthew G. Knepley         PetscFV        fv = (PetscFV) obj;
263297c42addSMatthew G. Knepley 
263397c42addSMatthew G. Knepley         /* Evaluate constant function at points */
26345f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFVGetNumComponents(fv, &NcJ));
263597c42addSMatthew G. Knepley         cpdim = 1;
263697c42addSMatthew G. Knepley         /* For now, fields only interpolate themselves */
263797c42addSMatthew G. Knepley         if (fieldI == fieldJ) {
26385f80ce2aSJacob Faibussowitsch           PetscCheck(Nc == NcJ,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of components in fine space field %D does not match coarse field %D", Nc, NcJ);
263997c42addSMatthew G. Knepley           for (i = 0, k = 0; i < fpdim; ++i) {
26405f80ce2aSJacob Faibussowitsch             CHKERRQ(PetscDualSpaceGetFunctional(Qref, i, &f));
26415f80ce2aSJacob Faibussowitsch             CHKERRQ(PetscQuadratureGetData(f, NULL, &qNc, &Np, NULL, &qweights));
26425f80ce2aSJacob Faibussowitsch             PetscCheck(qNc == NcJ,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of components in quadrature %D does not match coarse field %D", qNc, NcJ);
264397c42addSMatthew G. Knepley             for (p = 0; p < Np; ++p, ++k) {
264497c42addSMatthew G. Knepley               for (j = 0; j < cpdim; ++j) {
2645458eb97cSMatthew G. Knepley                 for (c = 0; c < Nc; ++c) elemMat[(offsetI + i)*cTotDim + offsetJ + j] += 1.0*qweights[p*qNc+c];
264697c42addSMatthew G. Knepley               }
264797c42addSMatthew G. Knepley             }
264897c42addSMatthew G. Knepley           }
264997c42addSMatthew G. Knepley         }
265097c42addSMatthew G. Knepley       }
2651d172c84bSMatthew G. Knepley       offsetJ += cpdim;
2652d69c5d34SMatthew G. Knepley     }
2653d172c84bSMatthew G. Knepley     offsetI += fpdim;
26545f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFree(points));
2655d69c5d34SMatthew G. Knepley   }
26565f80ce2aSJacob Faibussowitsch   if (mesh->printFEM > 1) CHKERRQ(DMPrintCellMatrix(0, name, rTotDim, cTotDim, elemMat));
26577f5b169aSMatthew G. Knepley   /* Preallocate matrix */
26587f5b169aSMatthew G. Knepley   {
2659c094ef40SMatthew G. Knepley     Mat          preallocator;
2660c094ef40SMatthew G. Knepley     PetscScalar *vals;
2661c094ef40SMatthew G. Knepley     PetscInt    *cellCIndices, *cellFIndices;
2662c094ef40SMatthew G. Knepley     PetscInt     locRows, locCols, cell;
26637f5b169aSMatthew G. Knepley 
26645f80ce2aSJacob Faibussowitsch     CHKERRQ(MatGetLocalSize(In, &locRows, &locCols));
26655f80ce2aSJacob Faibussowitsch     CHKERRQ(MatCreate(PetscObjectComm((PetscObject) In), &preallocator));
26665f80ce2aSJacob Faibussowitsch     CHKERRQ(MatSetType(preallocator, MATPREALLOCATOR));
26675f80ce2aSJacob Faibussowitsch     CHKERRQ(MatSetSizes(preallocator, locRows, locCols, PETSC_DETERMINE, PETSC_DETERMINE));
26685f80ce2aSJacob Faibussowitsch     CHKERRQ(MatSetUp(preallocator));
26695f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscCalloc3(rTotDim*cTotDim, &vals,cTotDim,&cellCIndices,rTotDim,&cellFIndices));
26707f5b169aSMatthew G. Knepley     for (cell = cStart; cell < cEnd; ++cell) {
2671cf51de39SMatthew G. Knepley       if (isRefined) {
26725f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexMatGetClosureIndicesRefined(dmf, fsection, fglobalSection, dmc, csection, cglobalSection, cell, cellCIndices, cellFIndices));
26735f80ce2aSJacob Faibussowitsch         CHKERRQ(MatSetValues(preallocator, rTotDim, cellFIndices, cTotDim, cellCIndices, vals, INSERT_VALUES));
2674cf51de39SMatthew G. Knepley       } else {
26755f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexMatSetClosureGeneral(dmf, fsection, fglobalSection, dmc, csection, cglobalSection, preallocator, cell, vals, INSERT_VALUES));
2676cf51de39SMatthew G. Knepley       }
26777f5b169aSMatthew G. Knepley     }
26785f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFree3(vals,cellCIndices,cellFIndices));
26795f80ce2aSJacob Faibussowitsch     CHKERRQ(MatAssemblyBegin(preallocator, MAT_FINAL_ASSEMBLY));
26805f80ce2aSJacob Faibussowitsch     CHKERRQ(MatAssemblyEnd(preallocator, MAT_FINAL_ASSEMBLY));
26815f80ce2aSJacob Faibussowitsch     CHKERRQ(MatPreallocatorPreallocate(preallocator, PETSC_TRUE, In));
26825f80ce2aSJacob Faibussowitsch     CHKERRQ(MatDestroy(&preallocator));
26837f5b169aSMatthew G. Knepley   }
26847f5b169aSMatthew G. Knepley   /* Fill matrix */
26855f80ce2aSJacob Faibussowitsch   CHKERRQ(MatZeroEntries(In));
2686d69c5d34SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
2687cf51de39SMatthew G. Knepley     if (isRefined) {
26885f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexMatSetClosureRefined(dmf, fsection, fglobalSection, dmc, csection, cglobalSection, In, c, elemMat, INSERT_VALUES));
2689cf51de39SMatthew G. Knepley     } else {
26905f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexMatSetClosureGeneral(dmf, fsection, fglobalSection, dmc, csection, cglobalSection, In, c, elemMat, INSERT_VALUES));
2691cf51de39SMatthew G. Knepley     }
2692d69c5d34SMatthew G. Knepley   }
26935f80ce2aSJacob Faibussowitsch   for (f = 0; f < Nf; ++f) CHKERRQ(PetscFEDestroy(&feRef[f]));
26945f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree2(feRef,fvRef));
26955f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree(elemMat));
26965f80ce2aSJacob Faibussowitsch   CHKERRQ(MatAssemblyBegin(In, MAT_FINAL_ASSEMBLY));
26975f80ce2aSJacob Faibussowitsch   CHKERRQ(MatAssemblyEnd(In, MAT_FINAL_ASSEMBLY));
26989318fe57SMatthew G. Knepley   if (mesh->printFEM > 1) {
26995f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscPrintf(PetscObjectComm((PetscObject)In), "%s:\n", name));
27005f80ce2aSJacob Faibussowitsch     CHKERRQ(MatChop(In, 1.0e-10));
27015f80ce2aSJacob Faibussowitsch     CHKERRQ(MatView(In, NULL));
2702d69c5d34SMatthew G. Knepley   }
27035f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventEnd(DMPLEX_InterpolatorFEM,dmc,dmf,0,0));
2704d69c5d34SMatthew G. Knepley   PetscFunctionReturn(0);
2705d69c5d34SMatthew G. Knepley }
27066c73c22cSMatthew G. Knepley 
2707bd041c0cSMatthew G. Knepley PetscErrorCode DMPlexComputeMassMatrixNested(DM dmc, DM dmf, Mat mass, void *user)
2708bd041c0cSMatthew G. Knepley {
2709bd041c0cSMatthew G. Knepley   SETERRQ(PetscObjectComm((PetscObject) dmc), PETSC_ERR_SUP, "Laziness");
2710bd041c0cSMatthew G. Knepley }
2711bd041c0cSMatthew G. Knepley 
271268132eb9SMatthew G. Knepley /*@
271368132eb9SMatthew G. Knepley   DMPlexComputeInterpolatorGeneral - Form the local portion of the interpolation matrix I from the coarse DM to a non-nested fine DM.
271468132eb9SMatthew G. Knepley 
271568132eb9SMatthew G. Knepley   Input Parameters:
271668132eb9SMatthew G. Knepley + dmf  - The fine mesh
271768132eb9SMatthew G. Knepley . dmc  - The coarse mesh
271868132eb9SMatthew G. Knepley - user - The user context
271968132eb9SMatthew G. Knepley 
272068132eb9SMatthew G. Knepley   Output Parameter:
272168132eb9SMatthew G. Knepley . In  - The interpolation matrix
272268132eb9SMatthew G. Knepley 
272368132eb9SMatthew G. Knepley   Level: developer
272468132eb9SMatthew G. Knepley 
272568132eb9SMatthew G. Knepley .seealso: DMPlexComputeInterpolatorNested(), DMPlexComputeJacobianFEM()
272668132eb9SMatthew G. Knepley @*/
272768132eb9SMatthew G. Knepley PetscErrorCode DMPlexComputeInterpolatorGeneral(DM dmc, DM dmf, Mat In, void *user)
27284ef9d792SMatthew G. Knepley {
272964e98e1dSMatthew G. Knepley   DM_Plex       *mesh = (DM_Plex *) dmf->data;
273064e98e1dSMatthew G. Knepley   const char    *name = "Interpolator";
27314ef9d792SMatthew G. Knepley   PetscDS        prob;
27324ef9d792SMatthew G. Knepley   PetscSection   fsection, csection, globalFSection, globalCSection;
2733e8f14785SLisandro Dalcin   PetscHSetIJ    ht;
27344ef9d792SMatthew G. Knepley   PetscLayout    rLayout;
27354ef9d792SMatthew G. Knepley   PetscInt      *dnz, *onz;
27364ef9d792SMatthew G. Knepley   PetscInt       locRows, rStart, rEnd;
27374ef9d792SMatthew G. Knepley   PetscReal     *x, *v0, *J, *invJ, detJ;
27384ef9d792SMatthew G. Knepley   PetscReal     *v0c, *Jc, *invJc, detJc;
27394ef9d792SMatthew G. Knepley   PetscScalar   *elemMat;
27404ef9d792SMatthew G. Knepley   PetscInt       dim, Nf, field, totDim, cStart, cEnd, cell, ccell;
27414ef9d792SMatthew G. Knepley 
27424ef9d792SMatthew G. Knepley   PetscFunctionBegin;
27435f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventBegin(DMPLEX_InterpolatorFEM,dmc,dmf,0,0));
27445f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateDim(dmc, &dim));
27455f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDS(dmc, &prob));
27465f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetWorkspace(prob, &x, NULL, NULL, NULL, NULL));
27475f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetNumFields(prob, &Nf));
27485f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc3(dim,&v0,dim*dim,&J,dim*dim,&invJ));
27495f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc3(dim,&v0c,dim*dim,&Jc,dim*dim,&invJc));
27505f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dmf, &fsection));
27515f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetGlobalSection(dmf, &globalFSection));
27525f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dmc, &csection));
27535f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetGlobalSection(dmc, &globalCSection));
27545f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetHeightStratum(dmf, 0, &cStart, &cEnd));
27555f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetTotalDimension(prob, &totDim));
27565f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc1(totDim, &elemMat));
27574ef9d792SMatthew G. Knepley 
27585f80ce2aSJacob Faibussowitsch   CHKERRQ(MatGetLocalSize(In, &locRows, NULL));
27595f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLayoutCreate(PetscObjectComm((PetscObject) In), &rLayout));
27605f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLayoutSetLocalSize(rLayout, locRows));
27615f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLayoutSetBlockSize(rLayout, 1));
27625f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLayoutSetUp(rLayout));
27635f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLayoutGetRange(rLayout, &rStart, &rEnd));
27645f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLayoutDestroy(&rLayout));
27655f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscCalloc2(locRows,&dnz,locRows,&onz));
27665f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscHSetIJCreate(&ht));
27674ef9d792SMatthew G. Knepley   for (field = 0; field < Nf; ++field) {
27684ef9d792SMatthew G. Knepley     PetscObject      obj;
27694ef9d792SMatthew G. Knepley     PetscClassId     id;
2770c0d7054bSMatthew G. Knepley     PetscDualSpace   Q = NULL;
27714ef9d792SMatthew G. Knepley     PetscQuadrature  f;
277217f047d8SMatthew G. Knepley     const PetscReal *qpoints;
277317f047d8SMatthew G. Knepley     PetscInt         Nc, Np, fpdim, i, d;
27744ef9d792SMatthew G. Knepley 
27755f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, field, &obj));
27765f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
27774ef9d792SMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
27784ef9d792SMatthew G. Knepley       PetscFE fe = (PetscFE) obj;
27794ef9d792SMatthew G. Knepley 
27805f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetDualSpace(fe, &Q));
27815f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetNumComponents(fe, &Nc));
27824ef9d792SMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
27834ef9d792SMatthew G. Knepley       PetscFV fv = (PetscFV) obj;
27844ef9d792SMatthew G. Knepley 
27855f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetDualSpace(fv, &Q));
27864ef9d792SMatthew G. Knepley       Nc   = 1;
27874ef9d792SMatthew G. Knepley     }
27885f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDualSpaceGetDimension(Q, &fpdim));
27894ef9d792SMatthew G. Knepley     /* For each fine grid cell */
27904ef9d792SMatthew G. Knepley     for (cell = cStart; cell < cEnd; ++cell) {
27914ef9d792SMatthew G. Knepley       PetscInt *findices,   *cindices;
27924ef9d792SMatthew G. Knepley       PetscInt  numFIndices, numCIndices;
27934ef9d792SMatthew G. Knepley 
27945f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
27955f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexComputeCellGeometryFEM(dmf, cell, NULL, v0, J, invJ, &detJ));
27965f80ce2aSJacob Faibussowitsch       PetscCheck(numFIndices == fpdim,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of fine indices %D != %D dual basis vecs", numFIndices, fpdim);
27974ef9d792SMatthew G. Knepley       for (i = 0; i < fpdim; ++i) {
27984ef9d792SMatthew G. Knepley         Vec             pointVec;
27994ef9d792SMatthew G. Knepley         PetscScalar    *pV;
28003a93e3b7SToby Isaac         PetscSF         coarseCellSF = NULL;
28013a93e3b7SToby Isaac         const PetscSFNode *coarseCells;
28029c3cf19fSMatthew G. Knepley         PetscInt        numCoarseCells, q, c;
28034ef9d792SMatthew G. Knepley 
28044ef9d792SMatthew G. Knepley         /* Get points from the dual basis functional quadrature */
28055f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDualSpaceGetFunctional(Q, i, &f));
28065f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscQuadratureGetData(f, NULL, NULL, &Np, &qpoints, NULL));
28075f80ce2aSJacob Faibussowitsch         CHKERRQ(VecCreateSeq(PETSC_COMM_SELF, Np*dim, &pointVec));
28085f80ce2aSJacob Faibussowitsch         CHKERRQ(VecSetBlockSize(pointVec, dim));
28095f80ce2aSJacob Faibussowitsch         CHKERRQ(VecGetArray(pointVec, &pV));
28104ef9d792SMatthew G. Knepley         for (q = 0; q < Np; ++q) {
2811c330f8ffSToby Isaac           const PetscReal xi0[3] = {-1., -1., -1.};
2812c330f8ffSToby Isaac 
28134ef9d792SMatthew G. Knepley           /* Transform point to real space */
2814c330f8ffSToby Isaac           CoordinatesRefToReal(dim, dim, xi0, v0, J, &qpoints[q*dim], x);
28154ef9d792SMatthew G. Knepley           for (d = 0; d < dim; ++d) pV[q*dim+d] = x[d];
28164ef9d792SMatthew G. Knepley         }
28175f80ce2aSJacob Faibussowitsch         CHKERRQ(VecRestoreArray(pointVec, &pV));
28184ef9d792SMatthew G. Knepley         /* Get set of coarse cells that overlap points (would like to group points by coarse cell) */
28191555c271SMatthew G. Knepley         /* OPT: Pack all quad points from fine cell */
28205f80ce2aSJacob Faibussowitsch         CHKERRQ(DMLocatePoints(dmc, pointVec, DM_POINTLOCATION_NEAREST, &coarseCellSF));
28215f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscSFViewFromOptions(coarseCellSF, NULL, "-interp_sf_view"));
28224ef9d792SMatthew G. Knepley         /* Update preallocation info */
28235f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscSFGetGraph(coarseCellSF, NULL, &numCoarseCells, NULL, &coarseCells));
28245f80ce2aSJacob Faibussowitsch         PetscCheck(numCoarseCells == Np,PETSC_COMM_SELF,PETSC_ERR_PLIB,"Not all closure points located");
28259c3cf19fSMatthew G. Knepley         {
2826e8f14785SLisandro Dalcin           PetscHashIJKey key;
2827e8f14785SLisandro Dalcin           PetscBool      missing;
28284ef9d792SMatthew G. Knepley 
2829e8f14785SLisandro Dalcin           key.i = findices[i];
2830e8f14785SLisandro Dalcin           if (key.i >= 0) {
28314ef9d792SMatthew G. Knepley             /* Get indices for coarse elements */
28324ef9d792SMatthew G. Knepley             for (ccell = 0; ccell < numCoarseCells; ++ccell) {
28335f80ce2aSJacob Faibussowitsch               CHKERRQ(DMPlexGetClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
28344ef9d792SMatthew G. Knepley               for (c = 0; c < numCIndices; ++c) {
2835e8f14785SLisandro Dalcin                 key.j = cindices[c];
2836e8f14785SLisandro Dalcin                 if (key.j < 0) continue;
28375f80ce2aSJacob Faibussowitsch                 CHKERRQ(PetscHSetIJQueryAdd(ht, key, &missing));
28384ef9d792SMatthew G. Knepley                 if (missing) {
2839e8f14785SLisandro Dalcin                   if ((key.j >= rStart) && (key.j < rEnd)) ++dnz[key.i-rStart];
2840e8f14785SLisandro Dalcin                   else                                     ++onz[key.i-rStart];
28414ef9d792SMatthew G. Knepley                 }
28424ef9d792SMatthew G. Knepley               }
28435f80ce2aSJacob Faibussowitsch               CHKERRQ(DMPlexRestoreClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
28444ef9d792SMatthew G. Knepley             }
28454ef9d792SMatthew G. Knepley           }
28468c543595SMatthew G. Knepley         }
28475f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscSFDestroy(&coarseCellSF));
28485f80ce2aSJacob Faibussowitsch         CHKERRQ(VecDestroy(&pointVec));
28494ef9d792SMatthew G. Knepley       }
28505f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexRestoreClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
28514ef9d792SMatthew G. Knepley     }
28524ef9d792SMatthew G. Knepley   }
28535f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscHSetIJDestroy(&ht));
28545f80ce2aSJacob Faibussowitsch   CHKERRQ(MatXAIJSetPreallocation(In, 1, dnz, onz, NULL, NULL));
28555f80ce2aSJacob Faibussowitsch   CHKERRQ(MatSetOption(In, MAT_NEW_NONZERO_ALLOCATION_ERR,PETSC_TRUE));
28565f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree2(dnz,onz));
28574ef9d792SMatthew G. Knepley   for (field = 0; field < Nf; ++field) {
28584ef9d792SMatthew G. Knepley     PetscObject       obj;
28594ef9d792SMatthew G. Knepley     PetscClassId      id;
2860c0d7054bSMatthew G. Knepley     PetscDualSpace    Q = NULL;
2861ef0bb6c7SMatthew G. Knepley     PetscTabulation T = NULL;
28624ef9d792SMatthew G. Knepley     PetscQuadrature   f;
28634ef9d792SMatthew G. Knepley     const PetscReal  *qpoints, *qweights;
28649c3cf19fSMatthew G. Knepley     PetscInt          Nc, qNc, Np, fpdim, i, d;
28654ef9d792SMatthew G. Knepley 
28665f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, field, &obj));
28675f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
28684ef9d792SMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
28694ef9d792SMatthew G. Knepley       PetscFE fe = (PetscFE) obj;
28704ef9d792SMatthew G. Knepley 
28715f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetDualSpace(fe, &Q));
28725f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetNumComponents(fe, &Nc));
28735f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFECreateTabulation(fe, 1, 1, x, 0, &T));
28744ef9d792SMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
28754ef9d792SMatthew G. Knepley       PetscFV fv = (PetscFV) obj;
28764ef9d792SMatthew G. Knepley 
28775f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetDualSpace(fv, &Q));
28784ef9d792SMatthew G. Knepley       Nc   = 1;
287998921bdaSJacob Faibussowitsch     } else SETERRQ(PetscObjectComm((PetscObject)dmc),PETSC_ERR_ARG_WRONG,"Unknown discretization type for field %D",field);
28805f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDualSpaceGetDimension(Q, &fpdim));
28814ef9d792SMatthew G. Knepley     /* For each fine grid cell */
28824ef9d792SMatthew G. Knepley     for (cell = cStart; cell < cEnd; ++cell) {
28834ef9d792SMatthew G. Knepley       PetscInt *findices,   *cindices;
28844ef9d792SMatthew G. Knepley       PetscInt  numFIndices, numCIndices;
28854ef9d792SMatthew G. Knepley 
28865f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
28875f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexComputeCellGeometryFEM(dmf, cell, NULL, v0, J, invJ, &detJ));
28885f80ce2aSJacob Faibussowitsch       PetscCheck(numFIndices == fpdim,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of fine indices %D != %D dual basis vecs", numFIndices, fpdim);
28894ef9d792SMatthew G. Knepley       for (i = 0; i < fpdim; ++i) {
28904ef9d792SMatthew G. Knepley         Vec             pointVec;
28914ef9d792SMatthew G. Knepley         PetscScalar    *pV;
289212111d7cSToby Isaac         PetscSF         coarseCellSF = NULL;
28933a93e3b7SToby Isaac         const PetscSFNode *coarseCells;
289417f047d8SMatthew G. Knepley         PetscInt        numCoarseCells, cpdim, q, c, j;
28954ef9d792SMatthew G. Knepley 
28964ef9d792SMatthew G. Knepley         /* Get points from the dual basis functional quadrature */
28975f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDualSpaceGetFunctional(Q, i, &f));
28985f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscQuadratureGetData(f, NULL, &qNc, &Np, &qpoints, &qweights));
28995f80ce2aSJacob Faibussowitsch         PetscCheck(qNc == Nc,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of components in quadrature %D does not match coarse field %D", qNc, Nc);
29005f80ce2aSJacob Faibussowitsch         CHKERRQ(VecCreateSeq(PETSC_COMM_SELF, Np*dim, &pointVec));
29015f80ce2aSJacob Faibussowitsch         CHKERRQ(VecSetBlockSize(pointVec, dim));
29025f80ce2aSJacob Faibussowitsch         CHKERRQ(VecGetArray(pointVec, &pV));
29034ef9d792SMatthew G. Knepley         for (q = 0; q < Np; ++q) {
2904c330f8ffSToby Isaac           const PetscReal xi0[3] = {-1., -1., -1.};
2905c330f8ffSToby Isaac 
29064ef9d792SMatthew G. Knepley           /* Transform point to real space */
2907c330f8ffSToby Isaac           CoordinatesRefToReal(dim, dim, xi0, v0, J, &qpoints[q*dim], x);
29084ef9d792SMatthew G. Knepley           for (d = 0; d < dim; ++d) pV[q*dim+d] = x[d];
29094ef9d792SMatthew G. Knepley         }
29105f80ce2aSJacob Faibussowitsch         CHKERRQ(VecRestoreArray(pointVec, &pV));
29114ef9d792SMatthew G. Knepley         /* Get set of coarse cells that overlap points (would like to group points by coarse cell) */
29121555c271SMatthew G. Knepley         /* OPT: Read this out from preallocation information */
29135f80ce2aSJacob Faibussowitsch         CHKERRQ(DMLocatePoints(dmc, pointVec, DM_POINTLOCATION_NEAREST, &coarseCellSF));
29144ef9d792SMatthew G. Knepley         /* Update preallocation info */
29155f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscSFGetGraph(coarseCellSF, NULL, &numCoarseCells, NULL, &coarseCells));
29165f80ce2aSJacob Faibussowitsch         PetscCheck(numCoarseCells == Np,PETSC_COMM_SELF,PETSC_ERR_PLIB,"Not all closure points located");
29175f80ce2aSJacob Faibussowitsch         CHKERRQ(VecGetArray(pointVec, &pV));
29184ef9d792SMatthew G. Knepley         for (ccell = 0; ccell < numCoarseCells; ++ccell) {
2919826eb36dSMatthew G. Knepley           PetscReal pVReal[3];
2920c330f8ffSToby Isaac           const PetscReal xi0[3] = {-1., -1., -1.};
2921826eb36dSMatthew G. Knepley 
29225f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexGetClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
29234ef9d792SMatthew G. Knepley           /* Transform points from real space to coarse reference space */
29245f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexComputeCellGeometryFEM(dmc, coarseCells[ccell].index, NULL, v0c, Jc, invJc, &detJc));
2925e2d86523SMatthew G. Knepley           for (d = 0; d < dim; ++d) pVReal[d] = PetscRealPart(pV[ccell*dim+d]);
2926c330f8ffSToby Isaac           CoordinatesRealToRef(dim, dim, xi0, v0c, invJc, pVReal, x);
29274ef9d792SMatthew G. Knepley 
29284ef9d792SMatthew G. Knepley           if (id == PETSCFE_CLASSID) {
29294ef9d792SMatthew G. Knepley             PetscFE fe = (PetscFE) obj;
29304ef9d792SMatthew G. Knepley 
29314ef9d792SMatthew G. Knepley             /* Evaluate coarse basis on contained point */
29325f80ce2aSJacob Faibussowitsch             CHKERRQ(PetscFEGetDimension(fe, &cpdim));
29335f80ce2aSJacob Faibussowitsch             CHKERRQ(PetscFEComputeTabulation(fe, 1, x, 0, T));
29345f80ce2aSJacob Faibussowitsch             CHKERRQ(PetscArrayzero(elemMat, cpdim));
29354ef9d792SMatthew G. Knepley             /* Get elemMat entries by multiplying by weight */
29364ef9d792SMatthew G. Knepley             for (j = 0; j < cpdim; ++j) {
2937ef0bb6c7SMatthew G. Knepley               for (c = 0; c < Nc; ++c) elemMat[j] += T->T[0][j*Nc + c]*qweights[ccell*qNc + c];
29384ef9d792SMatthew G. Knepley             }
29394ef9d792SMatthew G. Knepley           } else {
29404ef9d792SMatthew G. Knepley             cpdim = 1;
29414ef9d792SMatthew G. Knepley             for (j = 0; j < cpdim; ++j) {
29429c3cf19fSMatthew G. Knepley               for (c = 0; c < Nc; ++c) elemMat[j] += 1.0*qweights[ccell*qNc + c];
29434ef9d792SMatthew G. Knepley             }
29444ef9d792SMatthew G. Knepley           }
29454ef9d792SMatthew G. Knepley           /* Update interpolator */
29465f80ce2aSJacob Faibussowitsch           if (mesh->printFEM > 1) CHKERRQ(DMPrintCellMatrix(cell, name, 1, numCIndices, elemMat));
29475f80ce2aSJacob Faibussowitsch           PetscCheck(numCIndices == cpdim,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Number of element matrix columns %D != %D", numCIndices, cpdim);
29485f80ce2aSJacob Faibussowitsch           CHKERRQ(MatSetValues(In, 1, &findices[i], numCIndices, cindices, elemMat, INSERT_VALUES));
29495f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexRestoreClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
29504ef9d792SMatthew G. Knepley         }
29515f80ce2aSJacob Faibussowitsch         CHKERRQ(VecRestoreArray(pointVec, &pV));
29525f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscSFDestroy(&coarseCellSF));
29535f80ce2aSJacob Faibussowitsch         CHKERRQ(VecDestroy(&pointVec));
29544ef9d792SMatthew G. Knepley       }
29555f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexRestoreClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
29564ef9d792SMatthew G. Knepley     }
29575f80ce2aSJacob Faibussowitsch     if (id == PETSCFE_CLASSID) CHKERRQ(PetscTabulationDestroy(&T));
29584ef9d792SMatthew G. Knepley   }
29595f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree3(v0,J,invJ));
29605f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree3(v0c,Jc,invJc));
29615f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree(elemMat));
29625f80ce2aSJacob Faibussowitsch   CHKERRQ(MatAssemblyBegin(In, MAT_FINAL_ASSEMBLY));
29635f80ce2aSJacob Faibussowitsch   CHKERRQ(MatAssemblyEnd(In, MAT_FINAL_ASSEMBLY));
29645f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventEnd(DMPLEX_InterpolatorFEM,dmc,dmf,0,0));
29654ef9d792SMatthew G. Knepley   PetscFunctionReturn(0);
29664ef9d792SMatthew G. Knepley }
29674ef9d792SMatthew G. Knepley 
296846fa42a0SMatthew G. Knepley /*@
2969bd041c0cSMatthew G. Knepley   DMPlexComputeMassMatrixGeneral - Form the local portion of the mass matrix M from the coarse DM to a non-nested fine DM.
2970bd041c0cSMatthew G. Knepley 
2971bd041c0cSMatthew G. Knepley   Input Parameters:
2972bd041c0cSMatthew G. Knepley + dmf  - The fine mesh
2973bd041c0cSMatthew G. Knepley . dmc  - The coarse mesh
2974bd041c0cSMatthew G. Knepley - user - The user context
2975bd041c0cSMatthew G. Knepley 
2976bd041c0cSMatthew G. Knepley   Output Parameter:
2977bd041c0cSMatthew G. Knepley . mass  - The mass matrix
2978bd041c0cSMatthew G. Knepley 
2979bd041c0cSMatthew G. Knepley   Level: developer
2980bd041c0cSMatthew G. Knepley 
2981bd041c0cSMatthew G. Knepley .seealso: DMPlexComputeMassMatrixNested(), DMPlexComputeInterpolatorNested(), DMPlexComputeInterpolatorGeneral(), DMPlexComputeJacobianFEM()
2982bd041c0cSMatthew G. Knepley @*/
2983bd041c0cSMatthew G. Knepley PetscErrorCode DMPlexComputeMassMatrixGeneral(DM dmc, DM dmf, Mat mass, void *user)
2984bd041c0cSMatthew G. Knepley {
2985bd041c0cSMatthew G. Knepley   DM_Plex       *mesh = (DM_Plex *) dmf->data;
2986bd041c0cSMatthew G. Knepley   const char    *name = "Mass Matrix";
2987bd041c0cSMatthew G. Knepley   PetscDS        prob;
2988bd041c0cSMatthew G. Knepley   PetscSection   fsection, csection, globalFSection, globalCSection;
2989e8f14785SLisandro Dalcin   PetscHSetIJ    ht;
2990bd041c0cSMatthew G. Knepley   PetscLayout    rLayout;
2991bd041c0cSMatthew G. Knepley   PetscInt      *dnz, *onz;
2992bd041c0cSMatthew G. Knepley   PetscInt       locRows, rStart, rEnd;
2993bd041c0cSMatthew G. Knepley   PetscReal     *x, *v0, *J, *invJ, detJ;
2994bd041c0cSMatthew G. Knepley   PetscReal     *v0c, *Jc, *invJc, detJc;
2995bd041c0cSMatthew G. Knepley   PetscScalar   *elemMat;
2996bd041c0cSMatthew G. Knepley   PetscInt       dim, Nf, field, totDim, cStart, cEnd, cell, ccell;
2997bd041c0cSMatthew G. Knepley 
2998bd041c0cSMatthew G. Knepley   PetscFunctionBegin;
29995f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateDim(dmc, &dim));
30005f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDS(dmc, &prob));
30015f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetWorkspace(prob, &x, NULL, NULL, NULL, NULL));
30025f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetNumFields(prob, &Nf));
30035f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc3(dim,&v0,dim*dim,&J,dim*dim,&invJ));
30045f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc3(dim,&v0c,dim*dim,&Jc,dim*dim,&invJc));
30055f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dmf, &fsection));
30065f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetGlobalSection(dmf, &globalFSection));
30075f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dmc, &csection));
30085f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetGlobalSection(dmc, &globalCSection));
30095f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetHeightStratum(dmf, 0, &cStart, &cEnd));
30105f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetTotalDimension(prob, &totDim));
30115f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc1(totDim, &elemMat));
3012bd041c0cSMatthew G. Knepley 
30135f80ce2aSJacob Faibussowitsch   CHKERRQ(MatGetLocalSize(mass, &locRows, NULL));
30145f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLayoutCreate(PetscObjectComm((PetscObject) mass), &rLayout));
30155f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLayoutSetLocalSize(rLayout, locRows));
30165f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLayoutSetBlockSize(rLayout, 1));
30175f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLayoutSetUp(rLayout));
30185f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLayoutGetRange(rLayout, &rStart, &rEnd));
30195f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLayoutDestroy(&rLayout));
30205f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscCalloc2(locRows,&dnz,locRows,&onz));
30215f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscHSetIJCreate(&ht));
3022bd041c0cSMatthew G. Knepley   for (field = 0; field < Nf; ++field) {
3023bd041c0cSMatthew G. Knepley     PetscObject      obj;
3024bd041c0cSMatthew G. Knepley     PetscClassId     id;
3025bd041c0cSMatthew G. Knepley     PetscQuadrature  quad;
3026bd041c0cSMatthew G. Knepley     const PetscReal *qpoints;
3027bd041c0cSMatthew G. Knepley     PetscInt         Nq, Nc, i, d;
3028bd041c0cSMatthew G. Knepley 
30295f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, field, &obj));
30305f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
30315f80ce2aSJacob Faibussowitsch     if (id == PETSCFE_CLASSID) CHKERRQ(PetscFEGetQuadrature((PetscFE) obj, &quad));
30325f80ce2aSJacob Faibussowitsch     else                       CHKERRQ(PetscFVGetQuadrature((PetscFV) obj, &quad));
30335f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscQuadratureGetData(quad, NULL, &Nc, &Nq, &qpoints, NULL));
3034bd041c0cSMatthew G. Knepley     /* For each fine grid cell */
3035bd041c0cSMatthew G. Knepley     for (cell = cStart; cell < cEnd; ++cell) {
3036bd041c0cSMatthew G. Knepley       Vec                pointVec;
3037bd041c0cSMatthew G. Knepley       PetscScalar       *pV;
3038bd041c0cSMatthew G. Knepley       PetscSF            coarseCellSF = NULL;
3039bd041c0cSMatthew G. Knepley       const PetscSFNode *coarseCells;
3040bd041c0cSMatthew G. Knepley       PetscInt           numCoarseCells, q, c;
3041bd041c0cSMatthew G. Knepley       PetscInt          *findices,   *cindices;
3042bd041c0cSMatthew G. Knepley       PetscInt           numFIndices, numCIndices;
3043bd041c0cSMatthew G. Knepley 
30445f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
30455f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexComputeCellGeometryFEM(dmf, cell, NULL, v0, J, invJ, &detJ));
3046bd041c0cSMatthew G. Knepley       /* Get points from the quadrature */
30475f80ce2aSJacob Faibussowitsch       CHKERRQ(VecCreateSeq(PETSC_COMM_SELF, Nq*dim, &pointVec));
30485f80ce2aSJacob Faibussowitsch       CHKERRQ(VecSetBlockSize(pointVec, dim));
30495f80ce2aSJacob Faibussowitsch       CHKERRQ(VecGetArray(pointVec, &pV));
3050bd041c0cSMatthew G. Knepley       for (q = 0; q < Nq; ++q) {
3051c330f8ffSToby Isaac         const PetscReal xi0[3] = {-1., -1., -1.};
3052c330f8ffSToby Isaac 
3053bd041c0cSMatthew G. Knepley         /* Transform point to real space */
3054c330f8ffSToby Isaac         CoordinatesRefToReal(dim, dim, xi0, v0, J, &qpoints[q*dim], x);
3055bd041c0cSMatthew G. Knepley         for (d = 0; d < dim; ++d) pV[q*dim+d] = x[d];
3056bd041c0cSMatthew G. Knepley       }
30575f80ce2aSJacob Faibussowitsch       CHKERRQ(VecRestoreArray(pointVec, &pV));
3058bd041c0cSMatthew G. Knepley       /* Get set of coarse cells that overlap points (would like to group points by coarse cell) */
30595f80ce2aSJacob Faibussowitsch       CHKERRQ(DMLocatePoints(dmc, pointVec, DM_POINTLOCATION_NEAREST, &coarseCellSF));
30605f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscSFViewFromOptions(coarseCellSF, NULL, "-interp_sf_view"));
3061bd041c0cSMatthew G. Knepley       /* Update preallocation info */
30625f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscSFGetGraph(coarseCellSF, NULL, &numCoarseCells, NULL, &coarseCells));
30635f80ce2aSJacob Faibussowitsch       PetscCheck(numCoarseCells == Nq,PETSC_COMM_SELF,PETSC_ERR_PLIB,"Not all closure points located");
3064bd041c0cSMatthew G. Knepley       {
3065e8f14785SLisandro Dalcin         PetscHashIJKey key;
3066e8f14785SLisandro Dalcin         PetscBool      missing;
3067bd041c0cSMatthew G. Knepley 
3068bd041c0cSMatthew G. Knepley         for (i = 0; i < numFIndices; ++i) {
3069e8f14785SLisandro Dalcin           key.i = findices[i];
3070e8f14785SLisandro Dalcin           if (key.i >= 0) {
3071bd041c0cSMatthew G. Knepley             /* Get indices for coarse elements */
3072bd041c0cSMatthew G. Knepley             for (ccell = 0; ccell < numCoarseCells; ++ccell) {
30735f80ce2aSJacob Faibussowitsch               CHKERRQ(DMPlexGetClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
3074bd041c0cSMatthew G. Knepley               for (c = 0; c < numCIndices; ++c) {
3075e8f14785SLisandro Dalcin                 key.j = cindices[c];
3076e8f14785SLisandro Dalcin                 if (key.j < 0) continue;
30775f80ce2aSJacob Faibussowitsch                 CHKERRQ(PetscHSetIJQueryAdd(ht, key, &missing));
3078bd041c0cSMatthew G. Knepley                 if (missing) {
3079e8f14785SLisandro Dalcin                   if ((key.j >= rStart) && (key.j < rEnd)) ++dnz[key.i-rStart];
3080e8f14785SLisandro Dalcin                   else                                     ++onz[key.i-rStart];
3081bd041c0cSMatthew G. Knepley                 }
3082bd041c0cSMatthew G. Knepley               }
30835f80ce2aSJacob Faibussowitsch               CHKERRQ(DMPlexRestoreClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
3084bd041c0cSMatthew G. Knepley             }
3085bd041c0cSMatthew G. Knepley           }
3086bd041c0cSMatthew G. Knepley         }
3087bd041c0cSMatthew G. Knepley       }
30885f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscSFDestroy(&coarseCellSF));
30895f80ce2aSJacob Faibussowitsch       CHKERRQ(VecDestroy(&pointVec));
30905f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexRestoreClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
3091bd041c0cSMatthew G. Knepley     }
3092bd041c0cSMatthew G. Knepley   }
30935f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscHSetIJDestroy(&ht));
30945f80ce2aSJacob Faibussowitsch   CHKERRQ(MatXAIJSetPreallocation(mass, 1, dnz, onz, NULL, NULL));
30955f80ce2aSJacob Faibussowitsch   CHKERRQ(MatSetOption(mass, MAT_NEW_NONZERO_ALLOCATION_ERR,PETSC_TRUE));
30965f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree2(dnz,onz));
3097bd041c0cSMatthew G. Knepley   for (field = 0; field < Nf; ++field) {
3098bd041c0cSMatthew G. Knepley     PetscObject       obj;
3099bd041c0cSMatthew G. Knepley     PetscClassId      id;
3100ef0bb6c7SMatthew G. Knepley     PetscTabulation T, Tfine;
3101bd041c0cSMatthew G. Knepley     PetscQuadrature   quad;
3102bd041c0cSMatthew G. Knepley     const PetscReal  *qpoints, *qweights;
3103bd041c0cSMatthew G. Knepley     PetscInt          Nq, Nc, i, d;
3104bd041c0cSMatthew G. Knepley 
31055f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, field, &obj));
31065f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
3107ef0bb6c7SMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
31085f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetQuadrature((PetscFE) obj, &quad));
31095f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetCellTabulation((PetscFE) obj, 1, &Tfine));
31105f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFECreateTabulation((PetscFE) obj, 1, 1, x, 0, &T));
3111ef0bb6c7SMatthew G. Knepley     } else {
31125f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetQuadrature((PetscFV) obj, &quad));
3113ef0bb6c7SMatthew G. Knepley     }
31145f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscQuadratureGetData(quad, NULL, &Nc, &Nq, &qpoints, &qweights));
3115bd041c0cSMatthew G. Knepley     /* For each fine grid cell */
3116bd041c0cSMatthew G. Knepley     for (cell = cStart; cell < cEnd; ++cell) {
3117bd041c0cSMatthew G. Knepley       Vec                pointVec;
3118bd041c0cSMatthew G. Knepley       PetscScalar       *pV;
3119bd041c0cSMatthew G. Knepley       PetscSF            coarseCellSF = NULL;
3120bd041c0cSMatthew G. Knepley       const PetscSFNode *coarseCells;
3121bd041c0cSMatthew G. Knepley       PetscInt           numCoarseCells, cpdim, q, c, j;
3122bd041c0cSMatthew G. Knepley       PetscInt          *findices,   *cindices;
3123bd041c0cSMatthew G. Knepley       PetscInt           numFIndices, numCIndices;
3124bd041c0cSMatthew G. Knepley 
31255f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
31265f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexComputeCellGeometryFEM(dmf, cell, NULL, v0, J, invJ, &detJ));
3127bd041c0cSMatthew G. Knepley       /* Get points from the quadrature */
31285f80ce2aSJacob Faibussowitsch       CHKERRQ(VecCreateSeq(PETSC_COMM_SELF, Nq*dim, &pointVec));
31295f80ce2aSJacob Faibussowitsch       CHKERRQ(VecSetBlockSize(pointVec, dim));
31305f80ce2aSJacob Faibussowitsch       CHKERRQ(VecGetArray(pointVec, &pV));
3131bd041c0cSMatthew G. Knepley       for (q = 0; q < Nq; ++q) {
3132c330f8ffSToby Isaac         const PetscReal xi0[3] = {-1., -1., -1.};
3133c330f8ffSToby Isaac 
3134bd041c0cSMatthew G. Knepley         /* Transform point to real space */
3135c330f8ffSToby Isaac         CoordinatesRefToReal(dim, dim, xi0, v0, J, &qpoints[q*dim], x);
3136bd041c0cSMatthew G. Knepley         for (d = 0; d < dim; ++d) pV[q*dim+d] = x[d];
3137bd041c0cSMatthew G. Knepley       }
31385f80ce2aSJacob Faibussowitsch       CHKERRQ(VecRestoreArray(pointVec, &pV));
3139bd041c0cSMatthew G. Knepley       /* Get set of coarse cells that overlap points (would like to group points by coarse cell) */
31405f80ce2aSJacob Faibussowitsch       CHKERRQ(DMLocatePoints(dmc, pointVec, DM_POINTLOCATION_NEAREST, &coarseCellSF));
3141bd041c0cSMatthew G. Knepley       /* Update matrix */
31425f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscSFGetGraph(coarseCellSF, NULL, &numCoarseCells, NULL, &coarseCells));
31435f80ce2aSJacob Faibussowitsch       PetscCheck(numCoarseCells == Nq,PETSC_COMM_SELF,PETSC_ERR_PLIB,"Not all closure points located");
31445f80ce2aSJacob Faibussowitsch       CHKERRQ(VecGetArray(pointVec, &pV));
3145bd041c0cSMatthew G. Knepley       for (ccell = 0; ccell < numCoarseCells; ++ccell) {
3146bd041c0cSMatthew G. Knepley         PetscReal pVReal[3];
3147c330f8ffSToby Isaac         const PetscReal xi0[3] = {-1., -1., -1.};
3148c330f8ffSToby Isaac 
31495f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexGetClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
3150bd041c0cSMatthew G. Knepley         /* Transform points from real space to coarse reference space */
31515f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexComputeCellGeometryFEM(dmc, coarseCells[ccell].index, NULL, v0c, Jc, invJc, &detJc));
3152bd041c0cSMatthew G. Knepley         for (d = 0; d < dim; ++d) pVReal[d] = PetscRealPart(pV[ccell*dim+d]);
3153c330f8ffSToby Isaac         CoordinatesRealToRef(dim, dim, xi0, v0c, invJc, pVReal, x);
3154bd041c0cSMatthew G. Knepley 
3155bd041c0cSMatthew G. Knepley         if (id == PETSCFE_CLASSID) {
3156bd041c0cSMatthew G. Knepley           PetscFE fe = (PetscFE) obj;
3157bd041c0cSMatthew G. Knepley 
3158bd041c0cSMatthew G. Knepley           /* Evaluate coarse basis on contained point */
31595f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEGetDimension(fe, &cpdim));
31605f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEComputeTabulation(fe, 1, x, 0, T));
3161bd041c0cSMatthew G. Knepley           /* Get elemMat entries by multiplying by weight */
3162bd041c0cSMatthew G. Knepley           for (i = 0; i < numFIndices; ++i) {
31635f80ce2aSJacob Faibussowitsch             CHKERRQ(PetscArrayzero(elemMat, cpdim));
3164bd041c0cSMatthew G. Knepley             for (j = 0; j < cpdim; ++j) {
3165ef0bb6c7SMatthew G. Knepley               for (c = 0; c < Nc; ++c) elemMat[j] += T->T[0][j*Nc + c]*Tfine->T[0][(ccell*numFIndices + i)*Nc + c]*qweights[ccell*Nc + c]*detJ;
3166bd041c0cSMatthew G. Knepley             }
3167bd041c0cSMatthew G. Knepley             /* Update interpolator */
31685f80ce2aSJacob Faibussowitsch             if (mesh->printFEM > 1) CHKERRQ(DMPrintCellMatrix(cell, name, 1, numCIndices, elemMat));
31695f80ce2aSJacob Faibussowitsch             PetscCheck(numCIndices == cpdim,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Number of element matrix columns %D != %D", numCIndices, cpdim);
31705f80ce2aSJacob Faibussowitsch             CHKERRQ(MatSetValues(mass, 1, &findices[i], numCIndices, cindices, elemMat, ADD_VALUES));
3171bd041c0cSMatthew G. Knepley           }
3172bd041c0cSMatthew G. Knepley         } else {
3173bd041c0cSMatthew G. Knepley           cpdim = 1;
3174bd041c0cSMatthew G. Knepley           for (i = 0; i < numFIndices; ++i) {
31755f80ce2aSJacob Faibussowitsch             CHKERRQ(PetscArrayzero(elemMat, cpdim));
3176bd041c0cSMatthew G. Knepley             for (j = 0; j < cpdim; ++j) {
3177bd041c0cSMatthew G. Knepley               for (c = 0; c < Nc; ++c) elemMat[j] += 1.0*1.0*qweights[ccell*Nc + c]*detJ;
3178bd041c0cSMatthew G. Knepley             }
3179bd041c0cSMatthew G. Knepley             /* Update interpolator */
31805f80ce2aSJacob Faibussowitsch             if (mesh->printFEM > 1) CHKERRQ(DMPrintCellMatrix(cell, name, 1, numCIndices, elemMat));
31815f80ce2aSJacob Faibussowitsch             CHKERRQ(PetscPrintf(PETSC_COMM_SELF, "Nq: %D %D Nf: %D %D Nc: %D %D\n", ccell, Nq, i, numFIndices, j, numCIndices));
31825f80ce2aSJacob Faibussowitsch             PetscCheck(numCIndices == cpdim,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Number of element matrix columns %D != %D", numCIndices, cpdim);
31835f80ce2aSJacob Faibussowitsch             CHKERRQ(MatSetValues(mass, 1, &findices[i], numCIndices, cindices, elemMat, ADD_VALUES));
3184bd041c0cSMatthew G. Knepley           }
3185bd041c0cSMatthew G. Knepley         }
31865f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexRestoreClosureIndices(dmc, csection, globalCSection, coarseCells[ccell].index, PETSC_FALSE, &numCIndices, &cindices, NULL, NULL));
3187bd041c0cSMatthew G. Knepley       }
31885f80ce2aSJacob Faibussowitsch       CHKERRQ(VecRestoreArray(pointVec, &pV));
31895f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscSFDestroy(&coarseCellSF));
31905f80ce2aSJacob Faibussowitsch       CHKERRQ(VecDestroy(&pointVec));
31915f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexRestoreClosureIndices(dmf, fsection, globalFSection, cell, PETSC_FALSE, &numFIndices, &findices, NULL, NULL));
3192bd041c0cSMatthew G. Knepley     }
31935f80ce2aSJacob Faibussowitsch     if (id == PETSCFE_CLASSID) CHKERRQ(PetscTabulationDestroy(&T));
3194bd041c0cSMatthew G. Knepley   }
31955f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree3(v0,J,invJ));
31965f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree3(v0c,Jc,invJc));
31975f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree(elemMat));
31985f80ce2aSJacob Faibussowitsch   CHKERRQ(MatAssemblyBegin(mass, MAT_FINAL_ASSEMBLY));
31995f80ce2aSJacob Faibussowitsch   CHKERRQ(MatAssemblyEnd(mass, MAT_FINAL_ASSEMBLY));
3200bd041c0cSMatthew G. Knepley   PetscFunctionReturn(0);
3201bd041c0cSMatthew G. Knepley }
3202bd041c0cSMatthew G. Knepley 
3203bd041c0cSMatthew G. Knepley /*@
320446fa42a0SMatthew G. Knepley   DMPlexComputeInjectorFEM - Compute a mapping from coarse unknowns to fine unknowns
320546fa42a0SMatthew G. Knepley 
320646fa42a0SMatthew G. Knepley   Input Parameters:
320746fa42a0SMatthew G. Knepley + dmc  - The coarse mesh
320846fa42a0SMatthew G. Knepley - dmf  - The fine mesh
320946fa42a0SMatthew G. Knepley - user - The user context
321046fa42a0SMatthew G. Knepley 
321146fa42a0SMatthew G. Knepley   Output Parameter:
321246fa42a0SMatthew G. Knepley . sc   - The mapping
321346fa42a0SMatthew G. Knepley 
321446fa42a0SMatthew G. Knepley   Level: developer
321546fa42a0SMatthew G. Knepley 
321646fa42a0SMatthew G. Knepley .seealso: DMPlexComputeInterpolatorNested(), DMPlexComputeJacobianFEM()
321746fa42a0SMatthew G. Knepley @*/
32187c927364SMatthew G. Knepley PetscErrorCode DMPlexComputeInjectorFEM(DM dmc, DM dmf, VecScatter *sc, void *user)
32197c927364SMatthew G. Knepley {
3220e9d4ef1bSMatthew G. Knepley   PetscDS        prob;
32217c927364SMatthew G. Knepley   PetscFE       *feRef;
322297c42addSMatthew G. Knepley   PetscFV       *fvRef;
32237c927364SMatthew G. Knepley   Vec            fv, cv;
32247c927364SMatthew G. Knepley   IS             fis, cis;
32257c927364SMatthew G. Knepley   PetscSection   fsection, fglobalSection, csection, cglobalSection;
32267c927364SMatthew G. Knepley   PetscInt      *cmap, *cellCIndices, *cellFIndices, *cindices, *findices;
3227485ad865SMatthew G. Knepley   PetscInt       cTotDim, fTotDim = 0, Nf, f, field, cStart, cEnd, c, dim, d, startC, endC, offsetC, offsetF, m;
32286f3d3cbcSMatthew G. Knepley   PetscBool     *needAvg;
32297c927364SMatthew G. Knepley 
32307c927364SMatthew G. Knepley   PetscFunctionBegin;
32315f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventBegin(DMPLEX_InjectorFEM,dmc,dmf,0,0));
32325f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dmf, &dim));
32335f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dmf, &fsection));
32345f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetGlobalSection(dmf, &fglobalSection));
32355f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dmc, &csection));
32365f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetGlobalSection(dmc, &cglobalSection));
32375f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetNumFields(fsection, &Nf));
32385f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetSimplexOrBoxCells(dmc, 0, &cStart, &cEnd));
32395f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDS(dmc, &prob));
32405f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscCalloc3(Nf,&feRef,Nf,&fvRef,Nf,&needAvg));
32417c927364SMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
324297c42addSMatthew G. Knepley     PetscObject  obj;
324397c42addSMatthew G. Knepley     PetscClassId id;
3244aa7890ccSMatthew G. Knepley     PetscInt     fNb = 0, Nc = 0;
32457c927364SMatthew G. Knepley 
32465f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, f, &obj));
32475f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
324897c42addSMatthew G. Knepley     if (id == PETSCFE_CLASSID) {
324997c42addSMatthew G. Knepley       PetscFE    fe = (PetscFE) obj;
32506f3d3cbcSMatthew G. Knepley       PetscSpace sp;
32519b2fc754SMatthew G. Knepley       PetscInt   maxDegree;
325297c42addSMatthew G. Knepley 
32535f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFERefine(fe, &feRef[f]));
32545f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetDimension(feRef[f], &fNb));
32555f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetNumComponents(fe, &Nc));
32565f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetBasisSpace(fe, &sp));
32575f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscSpaceGetDegree(sp, NULL, &maxDegree));
32589b2fc754SMatthew G. Knepley       if (!maxDegree) needAvg[f] = PETSC_TRUE;
325997c42addSMatthew G. Knepley     } else if (id == PETSCFV_CLASSID) {
326097c42addSMatthew G. Knepley       PetscFV        fv = (PetscFV) obj;
326197c42addSMatthew G. Knepley       PetscDualSpace Q;
326297c42addSMatthew G. Knepley 
32635f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVRefine(fv, &fvRef[f]));
32645f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetDualSpace(fvRef[f], &Q));
32655f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDualSpaceGetDimension(Q, &fNb));
32665f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetNumComponents(fv, &Nc));
32676f3d3cbcSMatthew G. Knepley       needAvg[f] = PETSC_TRUE;
326897c42addSMatthew G. Knepley     }
3269d172c84bSMatthew G. Knepley     fTotDim += fNb;
32707c927364SMatthew G. Knepley   }
32715f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetTotalDimension(prob, &cTotDim));
32725f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc1(cTotDim,&cmap));
32737c927364SMatthew G. Knepley   for (field = 0, offsetC = 0, offsetF = 0; field < Nf; ++field) {
32747c927364SMatthew G. Knepley     PetscFE        feC;
327597c42addSMatthew G. Knepley     PetscFV        fvC;
32767c927364SMatthew G. Knepley     PetscDualSpace QF, QC;
3277d172c84bSMatthew G. Knepley     PetscInt       order = -1, NcF, NcC, fpdim, cpdim;
32787c927364SMatthew G. Knepley 
327997c42addSMatthew G. Knepley     if (feRef[field]) {
32805f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetDiscretization(prob, field, (PetscObject *) &feC));
32815f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetNumComponents(feC, &NcC));
32825f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetNumComponents(feRef[field], &NcF));
32835f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetDualSpace(feRef[field], &QF));
32845f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDualSpaceGetOrder(QF, &order));
32855f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDualSpaceGetDimension(QF, &fpdim));
32865f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetDualSpace(feC, &QC));
32875f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDualSpaceGetDimension(QC, &cpdim));
328897c42addSMatthew G. Knepley     } else {
32895f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetDiscretization(prob, field, (PetscObject *) &fvC));
32905f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetNumComponents(fvC, &NcC));
32915f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetNumComponents(fvRef[field], &NcF));
32925f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetDualSpace(fvRef[field], &QF));
32935f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDualSpaceGetDimension(QF, &fpdim));
32945f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetDualSpace(fvC, &QC));
32955f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDualSpaceGetDimension(QC, &cpdim));
329697c42addSMatthew G. Knepley     }
32975f80ce2aSJacob Faibussowitsch     PetscCheck(NcF == NcC,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of components in fine space field %D does not match coarse field %D", NcF, NcC);
32987c927364SMatthew G. Knepley     for (c = 0; c < cpdim; ++c) {
32997c927364SMatthew G. Knepley       PetscQuadrature  cfunc;
3300d172c84bSMatthew G. Knepley       const PetscReal *cqpoints, *cqweights;
3301d172c84bSMatthew G. Knepley       PetscInt         NqcC, NpC;
330297c42addSMatthew G. Knepley       PetscBool        found = PETSC_FALSE;
33037c927364SMatthew G. Knepley 
33045f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDualSpaceGetFunctional(QC, c, &cfunc));
33055f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscQuadratureGetData(cfunc, NULL, &NqcC, &NpC, &cqpoints, &cqweights));
33065f80ce2aSJacob Faibussowitsch       PetscCheck(NqcC == NcC,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of quadrature components %D must match number of field components %D", NqcC, NcC);
33072c71b3e2SJacob Faibussowitsch       PetscCheckFalse(NpC != 1 && feRef[field],PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Do not know how to do injection for moments");
33087c927364SMatthew G. Knepley       for (f = 0; f < fpdim; ++f) {
33097c927364SMatthew G. Knepley         PetscQuadrature  ffunc;
3310d172c84bSMatthew G. Knepley         const PetscReal *fqpoints, *fqweights;
33117c927364SMatthew G. Knepley         PetscReal        sum = 0.0;
3312d172c84bSMatthew G. Knepley         PetscInt         NqcF, NpF;
33137c927364SMatthew G. Knepley 
33145f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDualSpaceGetFunctional(QF, f, &ffunc));
33155f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscQuadratureGetData(ffunc, NULL, &NqcF, &NpF, &fqpoints, &fqweights));
33165f80ce2aSJacob Faibussowitsch         PetscCheck(NqcF == NcF,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of quadrature components %D must match number of field components %D", NqcF, NcF);
33177c927364SMatthew G. Knepley         if (NpC != NpF) continue;
33187c927364SMatthew G. Knepley         for (d = 0; d < dim; ++d) sum += PetscAbsReal(cqpoints[d] - fqpoints[d]);
33197c927364SMatthew G. Knepley         if (sum > 1.0e-9) continue;
3320d172c84bSMatthew G. Knepley         for (d = 0; d < NcC; ++d) sum += PetscAbsReal(cqweights[d]*fqweights[d]);
3321d172c84bSMatthew G. Knepley         if (sum < 1.0e-9) continue;
3322d172c84bSMatthew G. Knepley         cmap[offsetC+c] = offsetF+f;
332397c42addSMatthew G. Knepley         found = PETSC_TRUE;
33247c927364SMatthew G. Knepley         break;
33257c927364SMatthew G. Knepley       }
332697c42addSMatthew G. Knepley       if (!found) {
332797c42addSMatthew G. Knepley         /* TODO We really want the average here, but some asshole put VecScatter in the interface */
3328d172c84bSMatthew G. Knepley         if (fvRef[field] || (feRef[field] && order == 0)) {
3329d172c84bSMatthew G. Knepley           cmap[offsetC+c] = offsetF+0;
333097c42addSMatthew G. Knepley         } else SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Could not locate matching functional for injection");
333197c42addSMatthew G. Knepley       }
33327c927364SMatthew G. Knepley     }
3333d172c84bSMatthew G. Knepley     offsetC += cpdim;
3334d172c84bSMatthew G. Knepley     offsetF += fpdim;
33357c927364SMatthew G. Knepley   }
33365f80ce2aSJacob Faibussowitsch   for (f = 0; f < Nf; ++f) {CHKERRQ(PetscFEDestroy(&feRef[f]));CHKERRQ(PetscFVDestroy(&fvRef[f]));}
33375f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree3(feRef,fvRef,needAvg));
33387c927364SMatthew G. Knepley 
33395f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetGlobalVector(dmf, &fv));
33405f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetGlobalVector(dmc, &cv));
33415f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetOwnershipRange(cv, &startC, &endC));
33425f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSectionGetConstrainedStorageSize(cglobalSection, &m));
33435f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc2(cTotDim,&cellCIndices,fTotDim,&cellFIndices));
33445f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc1(m,&cindices));
33455f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc1(m,&findices));
33467c927364SMatthew G. Knepley   for (d = 0; d < m; ++d) cindices[d] = findices[d] = -1;
33477c927364SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
33485f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexMatGetClosureIndicesRefined(dmf, fsection, fglobalSection, dmc, csection, cglobalSection, c, cellCIndices, cellFIndices));
33497c927364SMatthew G. Knepley     for (d = 0; d < cTotDim; ++d) {
33500bd915a7SMatthew G. Knepley       if ((cellCIndices[d] < startC) || (cellCIndices[d] >= endC)) continue;
33512c71b3e2SJacob Faibussowitsch       PetscCheckFalse((findices[cellCIndices[d]-startC] >= 0) && (findices[cellCIndices[d]-startC] != cellFIndices[cmap[d]]),PETSC_COMM_SELF, PETSC_ERR_PLIB, "Coarse dof %D maps to both %D and %D", cindices[cellCIndices[d]-startC], findices[cellCIndices[d]-startC], cellFIndices[cmap[d]]);
33527c927364SMatthew G. Knepley       cindices[cellCIndices[d]-startC] = cellCIndices[d];
33537c927364SMatthew G. Knepley       findices[cellCIndices[d]-startC] = cellFIndices[cmap[d]];
33547c927364SMatthew G. Knepley     }
33557c927364SMatthew G. Knepley   }
33565f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree(cmap));
33575f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree2(cellCIndices,cellFIndices));
33587c927364SMatthew G. Knepley 
33595f80ce2aSJacob Faibussowitsch   CHKERRQ(ISCreateGeneral(PETSC_COMM_SELF, m, cindices, PETSC_OWN_POINTER, &cis));
33605f80ce2aSJacob Faibussowitsch   CHKERRQ(ISCreateGeneral(PETSC_COMM_SELF, m, findices, PETSC_OWN_POINTER, &fis));
33615f80ce2aSJacob Faibussowitsch   CHKERRQ(VecScatterCreate(cv, cis, fv, fis, sc));
33625f80ce2aSJacob Faibussowitsch   CHKERRQ(ISDestroy(&cis));
33635f80ce2aSJacob Faibussowitsch   CHKERRQ(ISDestroy(&fis));
33645f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreGlobalVector(dmf, &fv));
33655f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreGlobalVector(dmc, &cv));
33665f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventEnd(DMPLEX_InjectorFEM,dmc,dmf,0,0));
3367cb1e1211SMatthew G Knepley   PetscFunctionReturn(0);
3368cb1e1211SMatthew G Knepley }
3369a1cf66bbSMatthew G. Knepley 
33702f856554SMatthew G. Knepley /*@C
33712f856554SMatthew G. Knepley   DMPlexGetCellFields - Retrieve the field values values for a chunk of cells
33722f856554SMatthew G. Knepley 
33732f856554SMatthew G. Knepley   Input Parameters:
33742f856554SMatthew G. Knepley + dm     - The DM
33752f856554SMatthew G. Knepley . cellIS - The cells to include
33762f856554SMatthew G. Knepley . locX   - A local vector with the solution fields
33772f856554SMatthew G. Knepley . locX_t - A local vector with solution field time derivatives, or NULL
33782f856554SMatthew G. Knepley - locA   - A local vector with auxiliary fields, or NULL
33792f856554SMatthew G. Knepley 
33802f856554SMatthew G. Knepley   Output Parameters:
33812f856554SMatthew G. Knepley + u   - The field coefficients
33822f856554SMatthew G. Knepley . u_t - The fields derivative coefficients
33832f856554SMatthew G. Knepley - a   - The auxiliary field coefficients
33842f856554SMatthew G. Knepley 
33852f856554SMatthew G. Knepley   Level: developer
33862f856554SMatthew G. Knepley 
33872f856554SMatthew G. Knepley .seealso: DMPlexGetFaceFields()
33882f856554SMatthew G. Knepley @*/
33892f856554SMatthew G. Knepley PetscErrorCode DMPlexGetCellFields(DM dm, IS cellIS, Vec locX, Vec locX_t, Vec locA, PetscScalar **u, PetscScalar **u_t, PetscScalar **a)
33902f856554SMatthew G. Knepley {
33912f856554SMatthew G. Knepley   DM              plex, plexA = NULL;
3392a6e0b375SMatthew G. Knepley   DMEnclosureType encAux;
33932f856554SMatthew G. Knepley   PetscSection    section, sectionAux;
33942f856554SMatthew G. Knepley   PetscDS         prob;
33952f856554SMatthew G. Knepley   const PetscInt *cells;
33962f856554SMatthew G. Knepley   PetscInt        cStart, cEnd, numCells, totDim, totDimAux, c;
33972f856554SMatthew G. Knepley 
33982f856554SMatthew G. Knepley   PetscFunctionBegin;
33992f856554SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
3400064a246eSJacob Faibussowitsch   PetscValidHeaderSpecific(locX, VEC_CLASSID, 3);
3401064a246eSJacob Faibussowitsch   if (locX_t) {PetscValidHeaderSpecific(locX_t, VEC_CLASSID, 4);}
3402064a246eSJacob Faibussowitsch   if (locA)   {PetscValidHeaderSpecific(locA, VEC_CLASSID, 5);}
3403064a246eSJacob Faibussowitsch   PetscValidPointer(u, 6);
3404064a246eSJacob Faibussowitsch   PetscValidPointer(u_t, 7);
3405064a246eSJacob Faibussowitsch   PetscValidPointer(a, 8);
34065f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexConvertPlex(dm, &plex, PETSC_FALSE));
34075f80ce2aSJacob Faibussowitsch   CHKERRQ(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
34085f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &section));
34095f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCellDS(dm, cells ? cells[cStart] : cStart, &prob));
34105f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetTotalDimension(prob, &totDim));
34112f856554SMatthew G. Knepley   if (locA) {
34122f856554SMatthew G. Knepley     DM      dmAux;
34132f856554SMatthew G. Knepley     PetscDS probAux;
34142f856554SMatthew G. Knepley 
34155f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetDM(locA, &dmAux));
34165f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetEnclosureRelation(dmAux, dm, &encAux));
34175f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexConvertPlex(dmAux, &plexA, PETSC_FALSE));
34185f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetLocalSection(dmAux, &sectionAux));
34195f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetDS(dmAux, &probAux));
34205f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetTotalDimension(probAux, &totDimAux));
34212f856554SMatthew G. Knepley   }
34222f856554SMatthew G. Knepley   numCells = cEnd - cStart;
34235f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetWorkArray(dm, numCells*totDim, MPIU_SCALAR, u));
34245f80ce2aSJacob Faibussowitsch   if (locX_t) CHKERRQ(DMGetWorkArray(dm, numCells*totDim, MPIU_SCALAR, u_t)); else {*u_t = NULL;}
34255f80ce2aSJacob Faibussowitsch   if (locA)   CHKERRQ(DMGetWorkArray(dm, numCells*totDimAux, MPIU_SCALAR, a)); else {*a = NULL;}
34262f856554SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
34272f856554SMatthew G. Knepley     const PetscInt cell = cells ? cells[c] : c;
34282f856554SMatthew G. Knepley     const PetscInt cind = c - cStart;
34292f856554SMatthew G. Knepley     PetscScalar   *x = NULL, *x_t = NULL, *ul = *u, *ul_t = *u_t, *al = *a;
34302f856554SMatthew G. Knepley     PetscInt       i;
34312f856554SMatthew G. Knepley 
34325f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecGetClosure(plex, section, locX, cell, NULL, &x));
34332f856554SMatthew G. Knepley     for (i = 0; i < totDim; ++i) ul[cind*totDim+i] = x[i];
34345f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecRestoreClosure(plex, section, locX, cell, NULL, &x));
34352f856554SMatthew G. Knepley     if (locX_t) {
34365f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecGetClosure(plex, section, locX_t, cell, NULL, &x_t));
34372f856554SMatthew G. Knepley       for (i = 0; i < totDim; ++i) ul_t[cind*totDim+i] = x_t[i];
34385f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecRestoreClosure(plex, section, locX_t, cell, NULL, &x_t));
34392f856554SMatthew G. Knepley     }
34402f856554SMatthew G. Knepley     if (locA) {
34412f856554SMatthew G. Knepley       PetscInt subcell;
34425f80ce2aSJacob Faibussowitsch       CHKERRQ(DMGetEnclosurePoint(plexA, dm, encAux, cell, &subcell));
34435f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecGetClosure(plexA, sectionAux, locA, subcell, NULL, &x));
34442f856554SMatthew G. Knepley       for (i = 0; i < totDimAux; ++i) al[cind*totDimAux+i] = x[i];
34455f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecRestoreClosure(plexA, sectionAux, locA, subcell, NULL, &x));
34462f856554SMatthew G. Knepley     }
34472f856554SMatthew G. Knepley   }
34485f80ce2aSJacob Faibussowitsch   CHKERRQ(DMDestroy(&plex));
34495f80ce2aSJacob Faibussowitsch   if (locA) CHKERRQ(DMDestroy(&plexA));
34505f80ce2aSJacob Faibussowitsch   CHKERRQ(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
34512f856554SMatthew G. Knepley   PetscFunctionReturn(0);
34522f856554SMatthew G. Knepley }
34532f856554SMatthew G. Knepley 
34542f856554SMatthew G. Knepley /*@C
34552f856554SMatthew G. Knepley   DMPlexRestoreCellFields - Restore the field values values for a chunk of cells
34562f856554SMatthew G. Knepley 
34572f856554SMatthew G. Knepley   Input Parameters:
34582f856554SMatthew G. Knepley + dm     - The DM
34592f856554SMatthew G. Knepley . cellIS - The cells to include
34602f856554SMatthew G. Knepley . locX   - A local vector with the solution fields
34612f856554SMatthew G. Knepley . locX_t - A local vector with solution field time derivatives, or NULL
34622f856554SMatthew G. Knepley - locA   - A local vector with auxiliary fields, or NULL
34632f856554SMatthew G. Knepley 
34642f856554SMatthew G. Knepley   Output Parameters:
34652f856554SMatthew G. Knepley + u   - The field coefficients
34662f856554SMatthew G. Knepley . u_t - The fields derivative coefficients
34672f856554SMatthew G. Knepley - a   - The auxiliary field coefficients
34682f856554SMatthew G. Knepley 
34692f856554SMatthew G. Knepley   Level: developer
34702f856554SMatthew G. Knepley 
34712f856554SMatthew G. Knepley .seealso: DMPlexGetFaceFields()
34722f856554SMatthew G. Knepley @*/
34732f856554SMatthew G. Knepley PetscErrorCode DMPlexRestoreCellFields(DM dm, IS cellIS, Vec locX, Vec locX_t, Vec locA, PetscScalar **u, PetscScalar **u_t, PetscScalar **a)
34742f856554SMatthew G. Knepley {
34752f856554SMatthew G. Knepley   PetscFunctionBegin;
34765f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreWorkArray(dm, 0, MPIU_SCALAR, u));
34775f80ce2aSJacob Faibussowitsch   if (locX_t) CHKERRQ(DMRestoreWorkArray(dm, 0, MPIU_SCALAR, u_t));
34785f80ce2aSJacob Faibussowitsch   if (locA)   CHKERRQ(DMRestoreWorkArray(dm, 0, MPIU_SCALAR, a));
34792f856554SMatthew G. Knepley   PetscFunctionReturn(0);
34802f856554SMatthew G. Knepley }
34812f856554SMatthew G. Knepley 
3482faff4f7fSMatthew G. Knepley /*
3483faff4f7fSMatthew G. Knepley   Get the auxiliary field vectors for the negative side (s = 0) and positive side (s = 1) of the interfaace
3484faff4f7fSMatthew G. Knepley */
3485148442b3SMatthew G. Knepley static PetscErrorCode DMPlexGetHybridAuxFields(DM dm, DM dmAux[], PetscDS dsAux[], IS cellIS, Vec locA[], PetscScalar *a[])
34866528b96dSMatthew G. Knepley {
348704c51a94SMatthew G. Knepley   DM              plexA[2];
3488148442b3SMatthew G. Knepley   DMEnclosureType encAux[2];
348904c51a94SMatthew G. Knepley   PetscSection    sectionAux[2];
34906528b96dSMatthew G. Knepley   const PetscInt *cells;
3491148442b3SMatthew G. Knepley   PetscInt        cStart, cEnd, numCells, c, s, totDimAux[2];
34926528b96dSMatthew G. Knepley 
34936528b96dSMatthew G. Knepley   PetscFunctionBegin;
3494148442b3SMatthew G. Knepley   PetscValidPointer(locA, 5);
349504c51a94SMatthew G. Knepley   if (!locA[0] || !locA[1]) PetscFunctionReturn(0);
3496148442b3SMatthew G. Knepley   PetscValidPointer(dmAux, 2);
3497148442b3SMatthew G. Knepley   PetscValidPointer(dsAux, 3);
3498148442b3SMatthew G. Knepley   PetscValidPointer(a, 6);
34995f80ce2aSJacob Faibussowitsch   CHKERRQ(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
35006528b96dSMatthew G. Knepley   numCells = cEnd - cStart;
3501148442b3SMatthew G. Knepley   for (s = 0; s < 2; ++s) {
3502148442b3SMatthew G. Knepley     PetscValidHeaderSpecific(dmAux[s], DM_CLASSID, 2);
3503148442b3SMatthew G. Knepley     PetscValidHeaderSpecific(dsAux[s], PETSCDS_CLASSID, 3);
3504148442b3SMatthew G. Knepley     PetscValidHeaderSpecific(locA[s], VEC_CLASSID, 5);
35055f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexConvertPlex(dmAux[s], &plexA[s], PETSC_FALSE));
35065f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetEnclosureRelation(dmAux[s], dm, &encAux[s]));
35075f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetLocalSection(dmAux[s], &sectionAux[s]));
35085f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetTotalDimension(dsAux[s], &totDimAux[s]));
35095f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetWorkArray(dmAux[s], numCells*totDimAux[s], MPIU_SCALAR, &a[s]));
351004c51a94SMatthew G. Knepley   }
3511148442b3SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
35126528b96dSMatthew G. Knepley     const PetscInt  cell = cells ? cells[c] : c;
35136528b96dSMatthew G. Knepley     const PetscInt  cind = c - cStart;
35146528b96dSMatthew G. Knepley     const PetscInt *cone, *ornt;
35156528b96dSMatthew G. Knepley 
35165f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexGetCone(dm, cell, &cone));
35175f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexGetConeOrientation(dm, cell, &ornt));
35182c71b3e2SJacob Faibussowitsch     PetscCheckFalse(ornt[0],PETSC_COMM_SELF, PETSC_ERR_SUP, "Face %D in hybrid cell %D has orientation %D != 0", cone[0], cell, ornt[0]);
3519148442b3SMatthew G. Knepley     for (s = 0; s < 2; ++s) {
35205fedec97SMatthew G. Knepley       const PetscInt *support;
3521148442b3SMatthew G. Knepley       PetscScalar    *x = NULL, *al = a[s];
3522148442b3SMatthew G. Knepley       const PetscInt  tdA = totDimAux[s];
35235fedec97SMatthew G. Knepley       PetscInt        ssize, scell;
3524148442b3SMatthew G. Knepley       PetscInt        subface, Na, i;
35256528b96dSMatthew G. Knepley 
35265f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetSupport(dm, cone[s], &support));
35275f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetSupportSize(dm, cone[s], &ssize));
35282c71b3e2SJacob Faibussowitsch       PetscCheckFalse(ssize != 2,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Face %D from cell %D has support size %D != 2", cone[s], cell, ssize);
35295fedec97SMatthew G. Knepley       if      (support[0] == cell) scell = support[1];
35305fedec97SMatthew G. Knepley       else if (support[1] == cell) scell = support[0];
353198921bdaSJacob Faibussowitsch       else SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Face %D does not have cell %D in its support", cone[s], cell);
35325fedec97SMatthew G. Knepley 
35335f80ce2aSJacob Faibussowitsch       CHKERRQ(DMGetEnclosurePoint(plexA[s], dm, encAux[s], scell, &subface));
35345f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecGetClosure(plexA[s], sectionAux[s], locA[s], subface, &Na, &x));
35356528b96dSMatthew G. Knepley       for (i = 0; i < Na; ++i) al[cind*tdA+i] = x[i];
35365f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecRestoreClosure(plexA[s], sectionAux[s], locA[s], subface, &Na, &x));
35376528b96dSMatthew G. Knepley     }
35386528b96dSMatthew G. Knepley   }
35395f80ce2aSJacob Faibussowitsch   for (s = 0; s < 2; ++s) CHKERRQ(DMDestroy(&plexA[s]));
35405f80ce2aSJacob Faibussowitsch   CHKERRQ(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
35416528b96dSMatthew G. Knepley   PetscFunctionReturn(0);
35426528b96dSMatthew G. Knepley }
35436528b96dSMatthew G. Knepley 
354404c51a94SMatthew G. Knepley static PetscErrorCode DMPlexRestoreHybridAuxFields(DM dmAux[], PetscDS dsAux[], IS cellIS, Vec locA[], PetscScalar *a[])
35456528b96dSMatthew G. Knepley {
35466528b96dSMatthew G. Knepley   PetscFunctionBegin;
354704c51a94SMatthew G. Knepley   if (!locA[0] || !locA[1]) PetscFunctionReturn(0);
35485f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreWorkArray(dmAux[0], 0, MPIU_SCALAR, &a[0]));
35495f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreWorkArray(dmAux[1], 0, MPIU_SCALAR, &a[1]));
35506528b96dSMatthew G. Knepley   PetscFunctionReturn(0);
35516528b96dSMatthew G. Knepley }
35526528b96dSMatthew G. Knepley 
35532f856554SMatthew G. Knepley /*@C
35542f856554SMatthew G. Knepley   DMPlexGetFaceFields - Retrieve the field values values for a chunk of faces
35552f856554SMatthew G. Knepley 
35562f856554SMatthew G. Knepley   Input Parameters:
35572f856554SMatthew G. Knepley + dm     - The DM
35582f856554SMatthew G. Knepley . fStart - The first face to include
35592f856554SMatthew G. Knepley . fEnd   - The first face to exclude
35602f856554SMatthew G. Knepley . locX   - A local vector with the solution fields
35612f856554SMatthew G. Knepley . locX_t - A local vector with solution field time derivatives, or NULL
35622f856554SMatthew G. Knepley . faceGeometry - A local vector with face geometry
35632f856554SMatthew G. Knepley . cellGeometry - A local vector with cell geometry
35642f856554SMatthew G. Knepley - locaGrad - A local vector with field gradients, or NULL
35652f856554SMatthew G. Knepley 
35662f856554SMatthew G. Knepley   Output Parameters:
35672f856554SMatthew G. Knepley + Nface - The number of faces with field values
35682f856554SMatthew G. Knepley . uL - The field values at the left side of the face
35692f856554SMatthew G. Knepley - uR - The field values at the right side of the face
35702f856554SMatthew G. Knepley 
35712f856554SMatthew G. Knepley   Level: developer
35722f856554SMatthew G. Knepley 
35732f856554SMatthew G. Knepley .seealso: DMPlexGetCellFields()
35742f856554SMatthew G. Knepley @*/
35752f856554SMatthew G. Knepley PetscErrorCode DMPlexGetFaceFields(DM dm, PetscInt fStart, PetscInt fEnd, Vec locX, Vec locX_t, Vec faceGeometry, Vec cellGeometry, Vec locGrad, PetscInt *Nface, PetscScalar **uL, PetscScalar **uR)
35762f856554SMatthew G. Knepley {
35772f856554SMatthew G. Knepley   DM                 dmFace, dmCell, dmGrad = NULL;
35782f856554SMatthew G. Knepley   PetscSection       section;
35792f856554SMatthew G. Knepley   PetscDS            prob;
35802f856554SMatthew G. Knepley   DMLabel            ghostLabel;
35812f856554SMatthew G. Knepley   const PetscScalar *facegeom, *cellgeom, *x, *lgrad;
35822f856554SMatthew G. Knepley   PetscBool         *isFE;
35832f856554SMatthew G. Knepley   PetscInt           dim, Nf, f, Nc, numFaces = fEnd - fStart, iface, face;
35842f856554SMatthew G. Knepley 
35852f856554SMatthew G. Knepley   PetscFunctionBegin;
35862f856554SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
35872f856554SMatthew G. Knepley   PetscValidHeaderSpecific(locX, VEC_CLASSID, 4);
35882f856554SMatthew G. Knepley   if (locX_t) {PetscValidHeaderSpecific(locX_t, VEC_CLASSID, 5);}
35892f856554SMatthew G. Knepley   PetscValidHeaderSpecific(faceGeometry, VEC_CLASSID, 6);
35902f856554SMatthew G. Knepley   PetscValidHeaderSpecific(cellGeometry, VEC_CLASSID, 7);
35912f856554SMatthew G. Knepley   if (locGrad) {PetscValidHeaderSpecific(locGrad, VEC_CLASSID, 8);}
3592064a246eSJacob Faibussowitsch   PetscValidPointer(uL, 10);
3593064a246eSJacob Faibussowitsch   PetscValidPointer(uR, 11);
35945f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dm, &dim));
35955f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDS(dm, &prob));
35965f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &section));
35975f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetNumFields(prob, &Nf));
35985f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetTotalComponents(prob, &Nc));
35995f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc1(Nf, &isFE));
36002f856554SMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
36012f856554SMatthew G. Knepley     PetscObject  obj;
36022f856554SMatthew G. Knepley     PetscClassId id;
36032f856554SMatthew G. Knepley 
36045f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, f, &obj));
36055f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
36062f856554SMatthew G. Knepley     if (id == PETSCFE_CLASSID)      {isFE[f] = PETSC_TRUE;}
36072f856554SMatthew G. Knepley     else if (id == PETSCFV_CLASSID) {isFE[f] = PETSC_FALSE;}
36082f856554SMatthew G. Knepley     else                            {isFE[f] = PETSC_FALSE;}
36092f856554SMatthew G. Knepley   }
36105f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLabel(dm, "ghost", &ghostLabel));
36115f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetArrayRead(locX, &x));
36125f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetDM(faceGeometry, &dmFace));
36135f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetArrayRead(faceGeometry, &facegeom));
36145f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetDM(cellGeometry, &dmCell));
36155f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetArrayRead(cellGeometry, &cellgeom));
36162f856554SMatthew G. Knepley   if (locGrad) {
36175f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetDM(locGrad, &dmGrad));
36185f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetArrayRead(locGrad, &lgrad));
36192f856554SMatthew G. Knepley   }
36205f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetWorkArray(dm, numFaces*Nc, MPIU_SCALAR, uL));
36215f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetWorkArray(dm, numFaces*Nc, MPIU_SCALAR, uR));
36222f856554SMatthew G. Knepley   /* Right now just eat the extra work for FE (could make a cell loop) */
36232f856554SMatthew G. Knepley   for (face = fStart, iface = 0; face < fEnd; ++face) {
36242f856554SMatthew G. Knepley     const PetscInt        *cells;
36252f856554SMatthew G. Knepley     PetscFVFaceGeom       *fg;
36262f856554SMatthew G. Knepley     PetscFVCellGeom       *cgL, *cgR;
36272f856554SMatthew G. Knepley     PetscScalar           *xL, *xR, *gL, *gR;
36282f856554SMatthew G. Knepley     PetscScalar           *uLl = *uL, *uRl = *uR;
36292f856554SMatthew G. Knepley     PetscInt               ghost, nsupp, nchild;
36302f856554SMatthew G. Knepley 
36315f80ce2aSJacob Faibussowitsch     CHKERRQ(DMLabelGetValue(ghostLabel, face, &ghost));
36325f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexGetSupportSize(dm, face, &nsupp));
36335f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexGetTreeChildren(dm, face, &nchild, NULL));
36342f856554SMatthew G. Knepley     if (ghost >= 0 || nsupp > 2 || nchild > 0) continue;
36355f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexPointLocalRead(dmFace, face, facegeom, &fg));
36365f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexGetSupport(dm, face, &cells));
36375f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexPointLocalRead(dmCell, cells[0], cellgeom, &cgL));
36385f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexPointLocalRead(dmCell, cells[1], cellgeom, &cgR));
36392f856554SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
36402f856554SMatthew G. Knepley       PetscInt off;
36412f856554SMatthew G. Knepley 
36425f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetComponentOffset(prob, f, &off));
36432f856554SMatthew G. Knepley       if (isFE[f]) {
36442f856554SMatthew G. Knepley         const PetscInt *cone;
36452f856554SMatthew G. Knepley         PetscInt        comp, coneSizeL, coneSizeR, faceLocL, faceLocR, ldof, rdof, d;
36462f856554SMatthew G. Knepley 
36472f856554SMatthew G. Knepley         xL = xR = NULL;
36485f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscSectionGetFieldComponents(section, f, &comp));
36495f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecGetClosure(dm, section, locX, cells[0], &ldof, (PetscScalar **) &xL));
36505f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecGetClosure(dm, section, locX, cells[1], &rdof, (PetscScalar **) &xR));
36515f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexGetCone(dm, cells[0], &cone));
36525f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexGetConeSize(dm, cells[0], &coneSizeL));
36532f856554SMatthew G. Knepley         for (faceLocL = 0; faceLocL < coneSizeL; ++faceLocL) if (cone[faceLocL] == face) break;
36545f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexGetCone(dm, cells[1], &cone));
36555f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexGetConeSize(dm, cells[1], &coneSizeR));
36562f856554SMatthew G. Knepley         for (faceLocR = 0; faceLocR < coneSizeR; ++faceLocR) if (cone[faceLocR] == face) break;
36572c71b3e2SJacob Faibussowitsch         PetscCheckFalse(faceLocL == coneSizeL && faceLocR == coneSizeR,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Could not find face %D in cone of cell %D or cell %D", face, cells[0], cells[1]);
36582f856554SMatthew G. Knepley         /* Check that FEM field has values in the right cell (sometimes its an FV ghost cell) */
36592f856554SMatthew G. Knepley         /* TODO: this is a hack that might not be right for nonconforming */
36602f856554SMatthew G. Knepley         if (faceLocL < coneSizeL) {
36615f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEEvaluateFaceFields_Internal(prob, f, faceLocL, xL, &uLl[iface*Nc+off]));
36625f80ce2aSJacob Faibussowitsch           if (rdof == ldof && faceLocR < coneSizeR) CHKERRQ(PetscFEEvaluateFaceFields_Internal(prob, f, faceLocR, xR, &uRl[iface*Nc+off]));
36632f856554SMatthew G. Knepley           else              {for (d = 0; d < comp; ++d) uRl[iface*Nc+off+d] = uLl[iface*Nc+off+d];}
36642f856554SMatthew G. Knepley         }
36652f856554SMatthew G. Knepley         else {
36665f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEEvaluateFaceFields_Internal(prob, f, faceLocR, xR, &uRl[iface*Nc+off]));
36675f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscSectionGetFieldComponents(section, f, &comp));
36682f856554SMatthew G. Knepley           for (d = 0; d < comp; ++d) uLl[iface*Nc+off+d] = uRl[iface*Nc+off+d];
36692f856554SMatthew G. Knepley         }
36705f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecRestoreClosure(dm, section, locX, cells[0], &ldof, (PetscScalar **) &xL));
36715f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecRestoreClosure(dm, section, locX, cells[1], &rdof, (PetscScalar **) &xR));
36722f856554SMatthew G. Knepley       } else {
36732f856554SMatthew G. Knepley         PetscFV  fv;
36742f856554SMatthew G. Knepley         PetscInt numComp, c;
36752f856554SMatthew G. Knepley 
36765f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDSGetDiscretization(prob, f, (PetscObject *) &fv));
36775f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFVGetNumComponents(fv, &numComp));
36785f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexPointLocalFieldRead(dm, cells[0], f, x, &xL));
36795f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexPointLocalFieldRead(dm, cells[1], f, x, &xR));
36802f856554SMatthew G. Knepley         if (dmGrad) {
36812f856554SMatthew G. Knepley           PetscReal dxL[3], dxR[3];
36822f856554SMatthew G. Knepley 
36835f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexPointLocalRead(dmGrad, cells[0], lgrad, &gL));
36845f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexPointLocalRead(dmGrad, cells[1], lgrad, &gR));
36852f856554SMatthew G. Knepley           DMPlex_WaxpyD_Internal(dim, -1, cgL->centroid, fg->centroid, dxL);
36862f856554SMatthew G. Knepley           DMPlex_WaxpyD_Internal(dim, -1, cgR->centroid, fg->centroid, dxR);
36872f856554SMatthew G. Knepley           for (c = 0; c < numComp; ++c) {
36882f856554SMatthew G. Knepley             uLl[iface*Nc+off+c] = xL[c] + DMPlex_DotD_Internal(dim, &gL[c*dim], dxL);
36892f856554SMatthew G. Knepley             uRl[iface*Nc+off+c] = xR[c] + DMPlex_DotD_Internal(dim, &gR[c*dim], dxR);
36902f856554SMatthew G. Knepley           }
36912f856554SMatthew G. Knepley         } else {
36922f856554SMatthew G. Knepley           for (c = 0; c < numComp; ++c) {
36932f856554SMatthew G. Knepley             uLl[iface*Nc+off+c] = xL[c];
36942f856554SMatthew G. Knepley             uRl[iface*Nc+off+c] = xR[c];
36952f856554SMatthew G. Knepley           }
36962f856554SMatthew G. Knepley         }
36972f856554SMatthew G. Knepley       }
36982f856554SMatthew G. Knepley     }
36992f856554SMatthew G. Knepley     ++iface;
37002f856554SMatthew G. Knepley   }
37012f856554SMatthew G. Knepley   *Nface = iface;
37025f80ce2aSJacob Faibussowitsch   CHKERRQ(VecRestoreArrayRead(locX, &x));
37035f80ce2aSJacob Faibussowitsch   CHKERRQ(VecRestoreArrayRead(faceGeometry, &facegeom));
37045f80ce2aSJacob Faibussowitsch   CHKERRQ(VecRestoreArrayRead(cellGeometry, &cellgeom));
37052f856554SMatthew G. Knepley   if (locGrad) {
37065f80ce2aSJacob Faibussowitsch     CHKERRQ(VecRestoreArrayRead(locGrad, &lgrad));
37072f856554SMatthew G. Knepley   }
37085f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree(isFE));
37092f856554SMatthew G. Knepley   PetscFunctionReturn(0);
37102f856554SMatthew G. Knepley }
37112f856554SMatthew G. Knepley 
37122f856554SMatthew G. Knepley /*@C
37132f856554SMatthew G. Knepley   DMPlexRestoreFaceFields - Restore the field values values for a chunk of faces
37142f856554SMatthew G. Knepley 
37152f856554SMatthew G. Knepley   Input Parameters:
37162f856554SMatthew G. Knepley + dm     - The DM
37172f856554SMatthew G. Knepley . fStart - The first face to include
37182f856554SMatthew G. Knepley . fEnd   - The first face to exclude
37192f856554SMatthew G. Knepley . locX   - A local vector with the solution fields
37202f856554SMatthew G. Knepley . locX_t - A local vector with solution field time derivatives, or NULL
37212f856554SMatthew G. Knepley . faceGeometry - A local vector with face geometry
37222f856554SMatthew G. Knepley . cellGeometry - A local vector with cell geometry
37232f856554SMatthew G. Knepley - locaGrad - A local vector with field gradients, or NULL
37242f856554SMatthew G. Knepley 
37252f856554SMatthew G. Knepley   Output Parameters:
37262f856554SMatthew G. Knepley + Nface - The number of faces with field values
37272f856554SMatthew G. Knepley . uL - The field values at the left side of the face
37282f856554SMatthew G. Knepley - uR - The field values at the right side of the face
37292f856554SMatthew G. Knepley 
37302f856554SMatthew G. Knepley   Level: developer
37312f856554SMatthew G. Knepley 
37322f856554SMatthew G. Knepley .seealso: DMPlexGetFaceFields()
37332f856554SMatthew G. Knepley @*/
37342f856554SMatthew G. Knepley PetscErrorCode DMPlexRestoreFaceFields(DM dm, PetscInt fStart, PetscInt fEnd, Vec locX, Vec locX_t, Vec faceGeometry, Vec cellGeometry, Vec locGrad, PetscInt *Nface, PetscScalar **uL, PetscScalar **uR)
37352f856554SMatthew G. Knepley {
37362f856554SMatthew G. Knepley   PetscFunctionBegin;
37375f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreWorkArray(dm, 0, MPIU_SCALAR, uL));
37385f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreWorkArray(dm, 0, MPIU_SCALAR, uR));
37392f856554SMatthew G. Knepley   PetscFunctionReturn(0);
37402f856554SMatthew G. Knepley }
37412f856554SMatthew G. Knepley 
37422f856554SMatthew G. Knepley /*@C
37432f856554SMatthew G. Knepley   DMPlexGetFaceGeometry - Retrieve the geometric values for a chunk of faces
37442f856554SMatthew G. Knepley 
37452f856554SMatthew G. Knepley   Input Parameters:
37462f856554SMatthew G. Knepley + dm     - The DM
37472f856554SMatthew G. Knepley . fStart - The first face to include
37482f856554SMatthew G. Knepley . fEnd   - The first face to exclude
37492f856554SMatthew G. Knepley . faceGeometry - A local vector with face geometry
37502f856554SMatthew G. Knepley - cellGeometry - A local vector with cell geometry
37512f856554SMatthew G. Knepley 
37522f856554SMatthew G. Knepley   Output Parameters:
37532f856554SMatthew G. Knepley + Nface - The number of faces with field values
37542f856554SMatthew G. Knepley . fgeom - The extract the face centroid and normal
37552f856554SMatthew G. Knepley - vol   - The cell volume
37562f856554SMatthew G. Knepley 
37572f856554SMatthew G. Knepley   Level: developer
37582f856554SMatthew G. Knepley 
37592f856554SMatthew G. Knepley .seealso: DMPlexGetCellFields()
37602f856554SMatthew G. Knepley @*/
37612f856554SMatthew G. Knepley PetscErrorCode DMPlexGetFaceGeometry(DM dm, PetscInt fStart, PetscInt fEnd, Vec faceGeometry, Vec cellGeometry, PetscInt *Nface, PetscFVFaceGeom **fgeom, PetscReal **vol)
37622f856554SMatthew G. Knepley {
37632f856554SMatthew G. Knepley   DM                 dmFace, dmCell;
37642f856554SMatthew G. Knepley   DMLabel            ghostLabel;
37652f856554SMatthew G. Knepley   const PetscScalar *facegeom, *cellgeom;
37662f856554SMatthew G. Knepley   PetscInt           dim, numFaces = fEnd - fStart, iface, face;
37672f856554SMatthew G. Knepley 
37682f856554SMatthew G. Knepley   PetscFunctionBegin;
37692f856554SMatthew G. Knepley   PetscValidHeaderSpecific(dm, DM_CLASSID, 1);
37702f856554SMatthew G. Knepley   PetscValidHeaderSpecific(faceGeometry, VEC_CLASSID, 4);
37712f856554SMatthew G. Knepley   PetscValidHeaderSpecific(cellGeometry, VEC_CLASSID, 5);
3772064a246eSJacob Faibussowitsch   PetscValidPointer(fgeom, 7);
3773064a246eSJacob Faibussowitsch   PetscValidPointer(vol, 8);
37745f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dm, &dim));
37755f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLabel(dm, "ghost", &ghostLabel));
37765f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetDM(faceGeometry, &dmFace));
37775f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetArrayRead(faceGeometry, &facegeom));
37785f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetDM(cellGeometry, &dmCell));
37795f80ce2aSJacob Faibussowitsch   CHKERRQ(VecGetArrayRead(cellGeometry, &cellgeom));
37805f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc1(numFaces, fgeom));
37815f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetWorkArray(dm, numFaces*2, MPIU_SCALAR, vol));
37822f856554SMatthew G. Knepley   for (face = fStart, iface = 0; face < fEnd; ++face) {
37832f856554SMatthew G. Knepley     const PetscInt        *cells;
37842f856554SMatthew G. Knepley     PetscFVFaceGeom       *fg;
37852f856554SMatthew G. Knepley     PetscFVCellGeom       *cgL, *cgR;
37862f856554SMatthew G. Knepley     PetscFVFaceGeom       *fgeoml = *fgeom;
37872f856554SMatthew G. Knepley     PetscReal             *voll   = *vol;
37882f856554SMatthew G. Knepley     PetscInt               ghost, d, nchild, nsupp;
37892f856554SMatthew G. Knepley 
37905f80ce2aSJacob Faibussowitsch     CHKERRQ(DMLabelGetValue(ghostLabel, face, &ghost));
37915f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexGetSupportSize(dm, face, &nsupp));
37925f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexGetTreeChildren(dm, face, &nchild, NULL));
37932f856554SMatthew G. Knepley     if (ghost >= 0 || nsupp > 2 || nchild > 0) continue;
37945f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexPointLocalRead(dmFace, face, facegeom, &fg));
37955f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexGetSupport(dm, face, &cells));
37965f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexPointLocalRead(dmCell, cells[0], cellgeom, &cgL));
37975f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexPointLocalRead(dmCell, cells[1], cellgeom, &cgR));
37982f856554SMatthew G. Knepley     for (d = 0; d < dim; ++d) {
37992f856554SMatthew G. Knepley       fgeoml[iface].centroid[d] = fg->centroid[d];
38002f856554SMatthew G. Knepley       fgeoml[iface].normal[d]   = fg->normal[d];
38012f856554SMatthew G. Knepley     }
38022f856554SMatthew G. Knepley     voll[iface*2+0] = cgL->volume;
38032f856554SMatthew G. Knepley     voll[iface*2+1] = cgR->volume;
38042f856554SMatthew G. Knepley     ++iface;
38052f856554SMatthew G. Knepley   }
38062f856554SMatthew G. Knepley   *Nface = iface;
38075f80ce2aSJacob Faibussowitsch   CHKERRQ(VecRestoreArrayRead(faceGeometry, &facegeom));
38085f80ce2aSJacob Faibussowitsch   CHKERRQ(VecRestoreArrayRead(cellGeometry, &cellgeom));
38092f856554SMatthew G. Knepley   PetscFunctionReturn(0);
38102f856554SMatthew G. Knepley }
38112f856554SMatthew G. Knepley 
38122f856554SMatthew G. Knepley /*@C
38132f856554SMatthew G. Knepley   DMPlexRestoreFaceGeometry - Restore the field values values for a chunk of faces
38142f856554SMatthew G. Knepley 
38152f856554SMatthew G. Knepley   Input Parameters:
38162f856554SMatthew G. Knepley + dm     - The DM
38172f856554SMatthew G. Knepley . fStart - The first face to include
38182f856554SMatthew G. Knepley . fEnd   - The first face to exclude
38192f856554SMatthew G. Knepley . faceGeometry - A local vector with face geometry
38202f856554SMatthew G. Knepley - cellGeometry - A local vector with cell geometry
38212f856554SMatthew G. Knepley 
38222f856554SMatthew G. Knepley   Output Parameters:
38232f856554SMatthew G. Knepley + Nface - The number of faces with field values
38242f856554SMatthew G. Knepley . fgeom - The extract the face centroid and normal
38252f856554SMatthew G. Knepley - vol   - The cell volume
38262f856554SMatthew G. Knepley 
38272f856554SMatthew G. Knepley   Level: developer
38282f856554SMatthew G. Knepley 
38292f856554SMatthew G. Knepley .seealso: DMPlexGetFaceFields()
38302f856554SMatthew G. Knepley @*/
38312f856554SMatthew G. Knepley PetscErrorCode DMPlexRestoreFaceGeometry(DM dm, PetscInt fStart, PetscInt fEnd, Vec faceGeometry, Vec cellGeometry, PetscInt *Nface, PetscFVFaceGeom **fgeom, PetscReal **vol)
38322f856554SMatthew G. Knepley {
38332f856554SMatthew G. Knepley   PetscFunctionBegin;
38345f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree(*fgeom));
38355f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreWorkArray(dm, 0, MPIU_REAL, vol));
38362f856554SMatthew G. Knepley   PetscFunctionReturn(0);
38372f856554SMatthew G. Knepley }
38382f856554SMatthew G. Knepley 
3839a1cf66bbSMatthew G. Knepley PetscErrorCode DMSNESGetFEGeom(DMField coordField, IS pointIS, PetscQuadrature quad, PetscBool faceData, PetscFEGeom **geom)
3840a1cf66bbSMatthew G. Knepley {
3841a1cf66bbSMatthew G. Knepley   char            composeStr[33] = {0};
3842a1cf66bbSMatthew G. Knepley   PetscObjectId   id;
3843a1cf66bbSMatthew G. Knepley   PetscContainer  container;
3844a1cf66bbSMatthew G. Knepley 
3845a1cf66bbSMatthew G. Knepley   PetscFunctionBegin;
38465f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscObjectGetId((PetscObject)quad,&id));
38475f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscSNPrintf(composeStr, 32, "DMSNESGetFEGeom_%x\n", id));
38485f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscObjectQuery((PetscObject) pointIS, composeStr, (PetscObject *) &container));
3849a1cf66bbSMatthew G. Knepley   if (container) {
38505f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscContainerGetPointer(container, (void **) geom));
3851a1cf66bbSMatthew G. Knepley   } else {
38525f80ce2aSJacob Faibussowitsch     CHKERRQ(DMFieldCreateFEGeom(coordField, pointIS, quad, faceData, geom));
38535f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscContainerCreate(PETSC_COMM_SELF,&container));
38545f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscContainerSetPointer(container, (void *) *geom));
38555f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscContainerSetUserDestroy(container, PetscContainerUserDestroy_PetscFEGeom));
38565f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectCompose((PetscObject) pointIS, composeStr, (PetscObject) container));
38575f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscContainerDestroy(&container));
3858a1cf66bbSMatthew G. Knepley   }
3859a1cf66bbSMatthew G. Knepley   PetscFunctionReturn(0);
3860a1cf66bbSMatthew G. Knepley }
3861a1cf66bbSMatthew G. Knepley 
3862a1cf66bbSMatthew G. Knepley PetscErrorCode DMSNESRestoreFEGeom(DMField coordField, IS pointIS, PetscQuadrature quad, PetscBool faceData, PetscFEGeom **geom)
3863a1cf66bbSMatthew G. Knepley {
3864a1cf66bbSMatthew G. Knepley   PetscFunctionBegin;
3865a1cf66bbSMatthew G. Knepley   *geom = NULL;
3866a1cf66bbSMatthew G. Knepley   PetscFunctionReturn(0);
3867a1cf66bbSMatthew G. Knepley }
3868a1cf66bbSMatthew G. Knepley 
386992d50984SMatthew G. Knepley PetscErrorCode DMPlexComputeResidual_Patch_Internal(DM dm, PetscSection section, IS cellIS, PetscReal t, Vec locX, Vec locX_t, Vec locF, void *user)
387092d50984SMatthew G. Knepley {
387192d50984SMatthew G. Knepley   DM_Plex         *mesh       = (DM_Plex *) dm->data;
387292d50984SMatthew G. Knepley   const char      *name       = "Residual";
387392d50984SMatthew G. Knepley   DM               dmAux      = NULL;
387492d50984SMatthew G. Knepley   DMLabel          ghostLabel = NULL;
387592d50984SMatthew G. Knepley   PetscDS          prob       = NULL;
387692d50984SMatthew G. Knepley   PetscDS          probAux    = NULL;
387792d50984SMatthew G. Knepley   PetscBool        useFEM     = PETSC_FALSE;
387892d50984SMatthew G. Knepley   PetscBool        isImplicit = (locX_t || t == PETSC_MIN_REAL) ? PETSC_TRUE : PETSC_FALSE;
387992d50984SMatthew G. Knepley   DMField          coordField = NULL;
3880c0006e53SPatrick Farrell   Vec              locA;
3881c0006e53SPatrick Farrell   PetscScalar     *u = NULL, *u_t, *a, *uL = NULL, *uR = NULL;
388292d50984SMatthew G. Knepley   IS               chunkIS;
388392d50984SMatthew G. Knepley   const PetscInt  *cells;
388492d50984SMatthew G. Knepley   PetscInt         cStart, cEnd, numCells;
3885364207b6SKarl Rupp   PetscInt         Nf, f, totDim, totDimAux, numChunks, cellChunkSize, chunk, fStart, fEnd;
388692d50984SMatthew G. Knepley   PetscInt         maxDegree = PETSC_MAX_INT;
388706ad1575SMatthew G. Knepley   PetscFormKey key;
388892d50984SMatthew G. Knepley   PetscQuadrature  affineQuad = NULL, *quads = NULL;
388992d50984SMatthew G. Knepley   PetscFEGeom     *affineGeom = NULL, **geoms = NULL;
389092d50984SMatthew G. Knepley 
389192d50984SMatthew G. Knepley   PetscFunctionBegin;
38925f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventBegin(DMPLEX_ResidualFEM,dm,0,0,0));
389392d50984SMatthew G. Knepley   /* FEM+FVM */
389492d50984SMatthew G. Knepley   /* 1: Get sizes from dm and dmAux */
38955f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLabel(dm, "ghost", &ghostLabel));
38965f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDS(dm, &prob));
38975f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetNumFields(prob, &Nf));
38985f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetTotalDimension(prob, &totDim));
38995f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetAuxiliaryVec(dm, NULL, 0, 0, &locA));
390092d50984SMatthew G. Knepley   if (locA) {
39015f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetDM(locA, &dmAux));
39025f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetDS(dmAux, &probAux));
39035f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetTotalDimension(probAux, &totDimAux));
390492d50984SMatthew G. Knepley   }
390592d50984SMatthew G. Knepley   /* 2: Get geometric data */
390692d50984SMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
390792d50984SMatthew G. Knepley     PetscObject  obj;
390892d50984SMatthew G. Knepley     PetscClassId id;
390992d50984SMatthew G. Knepley     PetscBool    fimp;
391092d50984SMatthew G. Knepley 
39115f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetImplicit(prob, f, &fimp));
391292d50984SMatthew G. Knepley     if (isImplicit != fimp) continue;
39135f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, f, &obj));
39145f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
391592d50984SMatthew G. Knepley     if (id == PETSCFE_CLASSID) {useFEM = PETSC_TRUE;}
39165f80ce2aSJacob Faibussowitsch     PetscCheck(id != PETSCFV_CLASSID,PETSC_COMM_SELF,PETSC_ERR_ARG_WRONG,"Use of FVM with PCPATCH not yet implemented");
391792d50984SMatthew G. Knepley   }
391892d50984SMatthew G. Knepley   if (useFEM) {
39195f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetCoordinateField(dm, &coordField));
39205f80ce2aSJacob Faibussowitsch     CHKERRQ(DMFieldGetDegree(coordField,cellIS,NULL,&maxDegree));
392192d50984SMatthew G. Knepley     if (maxDegree <= 1) {
39225f80ce2aSJacob Faibussowitsch       CHKERRQ(DMFieldCreateDefaultQuadrature(coordField,cellIS,&affineQuad));
392392d50984SMatthew G. Knepley       if (affineQuad) {
39245f80ce2aSJacob Faibussowitsch         CHKERRQ(DMSNESGetFEGeom(coordField,cellIS,affineQuad,PETSC_FALSE,&affineGeom));
392592d50984SMatthew G. Knepley       }
392692d50984SMatthew G. Knepley     } else {
39275f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscCalloc2(Nf,&quads,Nf,&geoms));
392892d50984SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
392992d50984SMatthew G. Knepley         PetscObject  obj;
393092d50984SMatthew G. Knepley         PetscClassId id;
393192d50984SMatthew G. Knepley         PetscBool    fimp;
393292d50984SMatthew G. Knepley 
39335f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDSGetImplicit(prob, f, &fimp));
393492d50984SMatthew G. Knepley         if (isImplicit != fimp) continue;
39355f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDSGetDiscretization(prob, f, &obj));
39365f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscObjectGetClassId(obj, &id));
393792d50984SMatthew G. Knepley         if (id == PETSCFE_CLASSID) {
393892d50984SMatthew G. Knepley           PetscFE fe = (PetscFE) obj;
393992d50984SMatthew G. Knepley 
39405f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEGetQuadrature(fe, &quads[f]));
39415f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscObjectReference((PetscObject)quads[f]));
39425f80ce2aSJacob Faibussowitsch           CHKERRQ(DMSNESGetFEGeom(coordField,cellIS,quads[f],PETSC_FALSE,&geoms[f]));
394392d50984SMatthew G. Knepley         }
394492d50984SMatthew G. Knepley       }
394592d50984SMatthew G. Knepley     }
394692d50984SMatthew G. Knepley   }
394792d50984SMatthew G. Knepley   /* Loop over chunks */
39485f80ce2aSJacob Faibussowitsch   CHKERRQ(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
39495f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetHeightStratum(dm, 1, &fStart, &fEnd));
39505f80ce2aSJacob Faibussowitsch   if (useFEM) CHKERRQ(ISCreate(PETSC_COMM_SELF, &chunkIS));
395192d50984SMatthew G. Knepley   numCells      = cEnd - cStart;
395292d50984SMatthew G. Knepley   numChunks     = 1;
395392d50984SMatthew G. Knepley   cellChunkSize = numCells/numChunks;
395492d50984SMatthew G. Knepley   numChunks     = PetscMin(1,numCells);
39556528b96dSMatthew G. Knepley   key.label     = NULL;
39566528b96dSMatthew G. Knepley   key.value     = 0;
395706ad1575SMatthew G. Knepley   key.part      = 0;
395892d50984SMatthew G. Knepley   for (chunk = 0; chunk < numChunks; ++chunk) {
3959c0006e53SPatrick Farrell     PetscScalar     *elemVec, *fluxL = NULL, *fluxR = NULL;
3960c0006e53SPatrick Farrell     PetscReal       *vol = NULL;
3961c0006e53SPatrick Farrell     PetscFVFaceGeom *fgeom = NULL;
396292d50984SMatthew G. Knepley     PetscInt         cS = cStart+chunk*cellChunkSize, cE = PetscMin(cS+cellChunkSize, cEnd), numCells = cE - cS, c;
3963c0006e53SPatrick Farrell     PetscInt         numFaces = 0;
396492d50984SMatthew G. Knepley 
396592d50984SMatthew G. Knepley     /* Extract field coefficients */
396692d50984SMatthew G. Knepley     if (useFEM) {
39675f80ce2aSJacob Faibussowitsch       CHKERRQ(ISGetPointSubrange(chunkIS, cS, cE, cells));
39685f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetCellFields(dm, chunkIS, locX, locX_t, locA, &u, &u_t, &a));
39695f80ce2aSJacob Faibussowitsch       CHKERRQ(DMGetWorkArray(dm, numCells*totDim, MPIU_SCALAR, &elemVec));
39705f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscArrayzero(elemVec, numCells*totDim));
397192d50984SMatthew G. Knepley     }
397292d50984SMatthew G. Knepley     /* TODO We will interlace both our field coefficients (u, u_t, uL, uR, etc.) and our output (elemVec, fL, fR). I think this works */
397392d50984SMatthew G. Knepley     /* Loop over fields */
397492d50984SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
397592d50984SMatthew G. Knepley       PetscObject  obj;
397692d50984SMatthew G. Knepley       PetscClassId id;
397792d50984SMatthew G. Knepley       PetscBool    fimp;
397892d50984SMatthew G. Knepley       PetscInt     numChunks, numBatches, batchSize, numBlocks, blockSize, Ne, Nr, offset;
397992d50984SMatthew G. Knepley 
39806528b96dSMatthew G. Knepley       key.field = f;
39815f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetImplicit(prob, f, &fimp));
398292d50984SMatthew G. Knepley       if (isImplicit != fimp) continue;
39835f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetDiscretization(prob, f, &obj));
39845f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscObjectGetClassId(obj, &id));
398592d50984SMatthew G. Knepley       if (id == PETSCFE_CLASSID) {
398692d50984SMatthew G. Knepley         PetscFE         fe = (PetscFE) obj;
398792d50984SMatthew G. Knepley         PetscFEGeom    *geom = affineGeom ? affineGeom : geoms[f];
398892d50984SMatthew G. Knepley         PetscFEGeom    *chunkGeom = NULL;
398992d50984SMatthew G. Knepley         PetscQuadrature quad = affineQuad ? affineQuad : quads[f];
399092d50984SMatthew G. Knepley         PetscInt        Nq, Nb;
399192d50984SMatthew G. Knepley 
39925f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
39935f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscQuadratureGetData(quad, NULL, NULL, &Nq, NULL, NULL));
39945f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGetDimension(fe, &Nb));
399592d50984SMatthew G. Knepley         blockSize = Nb;
399692d50984SMatthew G. Knepley         batchSize = numBlocks * blockSize;
39975f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
399892d50984SMatthew G. Knepley         numChunks = numCells / (numBatches*batchSize);
399992d50984SMatthew G. Knepley         Ne        = numChunks*numBatches*batchSize;
400092d50984SMatthew G. Knepley         Nr        = numCells % (numBatches*batchSize);
400192d50984SMatthew G. Knepley         offset    = numCells - Nr;
400292d50984SMatthew G. Knepley         /* Integrate FE residual to get elemVec (need fields at quadrature points) */
400392d50984SMatthew G. Knepley         /*   For FV, I think we use a P0 basis and the cell coefficients (for subdivided cells, we can tweak the basis tabulation to be the indicator function) */
40045f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGeomGetChunk(geom,0,offset,&chunkGeom));
40055f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEIntegrateResidual(prob, key, Ne, chunkGeom, u, u_t, probAux, a, t, elemVec));
40065f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGeomGetChunk(geom,offset,numCells,&chunkGeom));
40075f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEIntegrateResidual(prob, key, Nr, chunkGeom, &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, probAux, &a[offset*totDimAux], t, &elemVec[offset*totDim]));
40085f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGeomRestoreChunk(geom,offset,numCells,&chunkGeom));
400992d50984SMatthew G. Knepley       } else if (id == PETSCFV_CLASSID) {
401092d50984SMatthew G. Knepley         PetscFV fv = (PetscFV) obj;
401192d50984SMatthew G. Knepley 
401292d50984SMatthew G. Knepley         Ne = numFaces;
401392d50984SMatthew G. Knepley         /* Riemann solve over faces (need fields at face centroids) */
401492d50984SMatthew G. Knepley         /*   We need to evaluate FE fields at those coordinates */
40155f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFVIntegrateRHSFunction(fv, prob, f, Ne, fgeom, vol, uL, uR, fluxL, fluxR));
401698921bdaSJacob Faibussowitsch       } else SETERRQ(PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", f);
401792d50984SMatthew G. Knepley     }
401892d50984SMatthew G. Knepley     /* Loop over domain */
401992d50984SMatthew G. Knepley     if (useFEM) {
402092d50984SMatthew G. Knepley       /* Add elemVec to locX */
402192d50984SMatthew G. Knepley       for (c = cS; c < cE; ++c) {
402292d50984SMatthew G. Knepley         const PetscInt cell = cells ? cells[c] : c;
402392d50984SMatthew G. Knepley         const PetscInt cind = c - cStart;
402492d50984SMatthew G. Knepley 
40255f80ce2aSJacob Faibussowitsch         if (mesh->printFEM > 1) CHKERRQ(DMPrintCellVector(cell, name, totDim, &elemVec[cind*totDim]));
402692d50984SMatthew G. Knepley         if (ghostLabel) {
402792d50984SMatthew G. Knepley           PetscInt ghostVal;
402892d50984SMatthew G. Knepley 
40295f80ce2aSJacob Faibussowitsch           CHKERRQ(DMLabelGetValue(ghostLabel,cell,&ghostVal));
403092d50984SMatthew G. Knepley           if (ghostVal > 0) continue;
403192d50984SMatthew G. Knepley         }
40325f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecSetClosure(dm, section, locF, cell, &elemVec[cind*totDim], ADD_ALL_VALUES));
403392d50984SMatthew G. Knepley       }
403492d50984SMatthew G. Knepley     }
403592d50984SMatthew G. Knepley     /* Handle time derivative */
403692d50984SMatthew G. Knepley     if (locX_t) {
403792d50984SMatthew G. Knepley       PetscScalar *x_t, *fa;
403892d50984SMatthew G. Knepley 
40395f80ce2aSJacob Faibussowitsch       CHKERRQ(VecGetArray(locF, &fa));
40405f80ce2aSJacob Faibussowitsch       CHKERRQ(VecGetArray(locX_t, &x_t));
404192d50984SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
404292d50984SMatthew G. Knepley         PetscFV      fv;
404392d50984SMatthew G. Knepley         PetscObject  obj;
404492d50984SMatthew G. Knepley         PetscClassId id;
404592d50984SMatthew G. Knepley         PetscInt     pdim, d;
404692d50984SMatthew G. Knepley 
40475f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDSGetDiscretization(prob, f, &obj));
40485f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscObjectGetClassId(obj, &id));
404992d50984SMatthew G. Knepley         if (id != PETSCFV_CLASSID) continue;
405092d50984SMatthew G. Knepley         fv   = (PetscFV) obj;
40515f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFVGetNumComponents(fv, &pdim));
405292d50984SMatthew G. Knepley         for (c = cS; c < cE; ++c) {
405392d50984SMatthew G. Knepley           const PetscInt cell = cells ? cells[c] : c;
405492d50984SMatthew G. Knepley           PetscScalar   *u_t, *r;
405592d50984SMatthew G. Knepley 
405692d50984SMatthew G. Knepley           if (ghostLabel) {
405792d50984SMatthew G. Knepley             PetscInt ghostVal;
405892d50984SMatthew G. Knepley 
40595f80ce2aSJacob Faibussowitsch             CHKERRQ(DMLabelGetValue(ghostLabel, cell, &ghostVal));
406092d50984SMatthew G. Knepley             if (ghostVal > 0) continue;
406192d50984SMatthew G. Knepley           }
40625f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexPointLocalFieldRead(dm, cell, f, x_t, &u_t));
40635f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexPointLocalFieldRef(dm, cell, f, fa, &r));
406492d50984SMatthew G. Knepley           for (d = 0; d < pdim; ++d) r[d] += u_t[d];
406592d50984SMatthew G. Knepley         }
406692d50984SMatthew G. Knepley       }
40675f80ce2aSJacob Faibussowitsch       CHKERRQ(VecRestoreArray(locX_t, &x_t));
40685f80ce2aSJacob Faibussowitsch       CHKERRQ(VecRestoreArray(locF, &fa));
406992d50984SMatthew G. Knepley     }
407092d50984SMatthew G. Knepley     if (useFEM) {
40715f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexRestoreCellFields(dm, chunkIS, locX, locX_t, locA, &u, &u_t, &a));
40725f80ce2aSJacob Faibussowitsch       CHKERRQ(DMRestoreWorkArray(dm, numCells*totDim, MPIU_SCALAR, &elemVec));
407392d50984SMatthew G. Knepley     }
407492d50984SMatthew G. Knepley   }
40755f80ce2aSJacob Faibussowitsch   if (useFEM) CHKERRQ(ISDestroy(&chunkIS));
40765f80ce2aSJacob Faibussowitsch   CHKERRQ(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
407792d50984SMatthew G. Knepley   /* TODO Could include boundary residual here (see DMPlexComputeResidual_Internal) */
407892d50984SMatthew G. Knepley   if (useFEM) {
407992d50984SMatthew G. Knepley     if (maxDegree <= 1) {
40805f80ce2aSJacob Faibussowitsch       CHKERRQ(DMSNESRestoreFEGeom(coordField,cellIS,affineQuad,PETSC_FALSE,&affineGeom));
40815f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscQuadratureDestroy(&affineQuad));
408292d50984SMatthew G. Knepley     } else {
408392d50984SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
40845f80ce2aSJacob Faibussowitsch         CHKERRQ(DMSNESRestoreFEGeom(coordField,cellIS,quads[f],PETSC_FALSE,&geoms[f]));
40855f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscQuadratureDestroy(&quads[f]));
408692d50984SMatthew G. Knepley       }
40875f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFree2(quads,geoms));
408892d50984SMatthew G. Knepley     }
408992d50984SMatthew G. Knepley   }
40905f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventEnd(DMPLEX_ResidualFEM,dm,0,0,0));
409192d50984SMatthew G. Knepley   PetscFunctionReturn(0);
409292d50984SMatthew G. Knepley }
409392d50984SMatthew G. Knepley 
4094a1cf66bbSMatthew G. Knepley /*
4095a1cf66bbSMatthew G. Knepley   We always assemble JacP, and if the matrix is different from Jac and two different sets of point functions are provided, we also assemble Jac
4096a1cf66bbSMatthew G. Knepley 
4097a1cf66bbSMatthew G. Knepley   X   - The local solution vector
4098a5b23f4aSJose E. Roman   X_t - The local solution time derivative vector, or NULL
4099a1cf66bbSMatthew G. Knepley */
4100a1cf66bbSMatthew G. Knepley PetscErrorCode DMPlexComputeJacobian_Patch_Internal(DM dm, PetscSection section, PetscSection globalSection, IS cellIS,
4101a1cf66bbSMatthew G. Knepley                                                     PetscReal t, PetscReal X_tShift, Vec X, Vec X_t, Mat Jac, Mat JacP, void *ctx)
4102a1cf66bbSMatthew G. Knepley {
4103a1cf66bbSMatthew G. Knepley   DM_Plex         *mesh  = (DM_Plex *) dm->data;
4104a1cf66bbSMatthew G. Knepley   const char      *name = "Jacobian", *nameP = "JacobianPre";
4105a1cf66bbSMatthew G. Knepley   DM               dmAux = NULL;
4106a1cf66bbSMatthew G. Knepley   PetscDS          prob,   probAux = NULL;
4107a1cf66bbSMatthew G. Knepley   PetscSection     sectionAux = NULL;
4108a1cf66bbSMatthew G. Knepley   Vec              A;
4109a1cf66bbSMatthew G. Knepley   DMField          coordField;
4110a1cf66bbSMatthew G. Knepley   PetscFEGeom     *cgeomFEM;
4111a1cf66bbSMatthew G. Knepley   PetscQuadrature  qGeom = NULL;
4112a1cf66bbSMatthew G. Knepley   Mat              J = Jac, JP = JacP;
4113a1cf66bbSMatthew G. Knepley   PetscScalar     *work, *u = NULL, *u_t = NULL, *a = NULL, *elemMat = NULL, *elemMatP = NULL, *elemMatD = NULL;
4114e432b41dSStefano Zampini   PetscBool        hasJac, hasPrec, hasDyn, assembleJac, *isFE, hasFV = PETSC_FALSE;
4115a1cf66bbSMatthew G. Knepley   const PetscInt  *cells;
411606ad1575SMatthew G. Knepley   PetscFormKey key;
41179b2fc754SMatthew G. Knepley   PetscInt         Nf, fieldI, fieldJ, maxDegree, numCells, cStart, cEnd, numChunks, chunkSize, chunk, totDim, totDimAux = 0, sz, wsz, off = 0, offCell = 0;
4118a1cf66bbSMatthew G. Knepley 
4119a1cf66bbSMatthew G. Knepley   PetscFunctionBegin;
41205f80ce2aSJacob Faibussowitsch   CHKERRQ(ISGetLocalSize(cellIS, &numCells));
41215f80ce2aSJacob Faibussowitsch   CHKERRQ(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
41225f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventBegin(DMPLEX_JacobianFEM,dm,0,0,0));
41235f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDS(dm, &prob));
41245f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetAuxiliaryVec(dm, NULL, 0, 0, &A));
41259a2a23afSMatthew G. Knepley   if (A) {
41265f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetDM(A, &dmAux));
41275f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetLocalSection(dmAux, &sectionAux));
41285f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetDS(dmAux, &probAux));
4129a1cf66bbSMatthew G. Knepley   }
4130a1cf66bbSMatthew G. Knepley   /* Get flags */
41315f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetNumFields(prob, &Nf));
41325f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetWorkArray(dm, Nf, MPIU_BOOL, &isFE));
4133a1cf66bbSMatthew G. Knepley   for (fieldI = 0; fieldI < Nf; ++fieldI) {
4134a1cf66bbSMatthew G. Knepley     PetscObject  disc;
4135a1cf66bbSMatthew G. Knepley     PetscClassId id;
41365f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, fieldI, &disc));
41375f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(disc, &id));
4138a1cf66bbSMatthew G. Knepley     if (id == PETSCFE_CLASSID)      {isFE[fieldI] = PETSC_TRUE;}
4139a1cf66bbSMatthew G. Knepley     else if (id == PETSCFV_CLASSID) {hasFV = PETSC_TRUE; isFE[fieldI] = PETSC_FALSE;}
4140a1cf66bbSMatthew G. Knepley   }
41415f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSHasJacobian(prob, &hasJac));
41425f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSHasJacobianPreconditioner(prob, &hasPrec));
41435f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSHasDynamicJacobian(prob, &hasDyn));
4144a1cf66bbSMatthew G. Knepley   assembleJac = hasJac && hasPrec && (Jac != JacP) ? PETSC_TRUE : PETSC_FALSE;
4145a1cf66bbSMatthew G. Knepley   hasDyn      = hasDyn && (X_tShift != 0.0) ? PETSC_TRUE : PETSC_FALSE;
41465f80ce2aSJacob Faibussowitsch   if (hasFV) CHKERRQ(MatSetOption(JP, MAT_IGNORE_ZERO_ENTRIES, PETSC_TRUE)); /* No allocated space for FV stuff, so ignore the zero entries */
41475f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetTotalDimension(prob, &totDim));
41485f80ce2aSJacob Faibussowitsch   if (probAux) CHKERRQ(PetscDSGetTotalDimension(probAux, &totDimAux));
4149a1cf66bbSMatthew G. Knepley   /* Compute batch sizes */
4150a1cf66bbSMatthew G. Knepley   if (isFE[0]) {
4151a1cf66bbSMatthew G. Knepley     PetscFE         fe;
4152a1cf66bbSMatthew G. Knepley     PetscQuadrature q;
4153a1cf66bbSMatthew G. Knepley     PetscInt        numQuadPoints, numBatches, batchSize, numBlocks, blockSize, Nb;
4154a1cf66bbSMatthew G. Knepley 
41555f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, 0, (PetscObject *) &fe));
41565f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGetQuadrature(fe, &q));
41575f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscQuadratureGetData(q, NULL, NULL, &numQuadPoints, NULL, NULL));
41585f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGetDimension(fe, &Nb));
41595f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
4160a1cf66bbSMatthew G. Knepley     blockSize = Nb*numQuadPoints;
4161a1cf66bbSMatthew G. Knepley     batchSize = numBlocks  * blockSize;
4162a1cf66bbSMatthew G. Knepley     chunkSize = numBatches * batchSize;
4163a1cf66bbSMatthew G. Knepley     numChunks = numCells / chunkSize + numCells % chunkSize;
41645f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
4165a1cf66bbSMatthew G. Knepley   } else {
4166a1cf66bbSMatthew G. Knepley     chunkSize = numCells;
4167a1cf66bbSMatthew G. Knepley     numChunks = 1;
4168a1cf66bbSMatthew G. Knepley   }
4169a1cf66bbSMatthew G. Knepley   /* Get work space */
4170a1cf66bbSMatthew G. Knepley   wsz  = (((X?1:0) + (X_t?1:0) + (dmAux?1:0))*totDim + ((hasJac?1:0) + (hasPrec?1:0) + (hasDyn?1:0))*totDim*totDim)*chunkSize;
41715f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetWorkArray(dm, wsz, MPIU_SCALAR, &work));
41725f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscArrayzero(work, wsz));
4173a1cf66bbSMatthew G. Knepley   off      = 0;
4174a1cf66bbSMatthew G. Knepley   u        = X       ? (sz = chunkSize*totDim,        off += sz, work+off-sz) : NULL;
4175a1cf66bbSMatthew G. Knepley   u_t      = X_t     ? (sz = chunkSize*totDim,        off += sz, work+off-sz) : NULL;
4176a1cf66bbSMatthew G. Knepley   a        = dmAux   ? (sz = chunkSize*totDimAux,     off += sz, work+off-sz) : NULL;
4177a1cf66bbSMatthew G. Knepley   elemMat  = hasJac  ? (sz = chunkSize*totDim*totDim, off += sz, work+off-sz) : NULL;
4178a1cf66bbSMatthew G. Knepley   elemMatP = hasPrec ? (sz = chunkSize*totDim*totDim, off += sz, work+off-sz) : NULL;
4179a1cf66bbSMatthew G. Knepley   elemMatD = hasDyn  ? (sz = chunkSize*totDim*totDim, off += sz, work+off-sz) : NULL;
41805f80ce2aSJacob Faibussowitsch   PetscCheck(off == wsz,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Error is workspace size %D should be %D", off, wsz);
4181a1cf66bbSMatthew G. Knepley   /* Setup geometry */
41825f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateField(dm, &coordField));
41835f80ce2aSJacob Faibussowitsch   CHKERRQ(DMFieldGetDegree(coordField, cellIS, NULL, &maxDegree));
41845f80ce2aSJacob Faibussowitsch   if (maxDegree <= 1) CHKERRQ(DMFieldCreateDefaultQuadrature(coordField, cellIS, &qGeom));
4185a1cf66bbSMatthew G. Knepley   if (!qGeom) {
4186a1cf66bbSMatthew G. Knepley     PetscFE fe;
4187a1cf66bbSMatthew G. Knepley 
41885f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, 0, (PetscObject *) &fe));
41895f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGetQuadrature(fe, &qGeom));
41905f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectReference((PetscObject) qGeom));
4191a1cf66bbSMatthew G. Knepley   }
41925f80ce2aSJacob Faibussowitsch   CHKERRQ(DMSNESGetFEGeom(coordField, cellIS, qGeom, PETSC_FALSE, &cgeomFEM));
4193a1cf66bbSMatthew G. Knepley   /* Compute volume integrals */
41945f80ce2aSJacob Faibussowitsch   if (assembleJac) CHKERRQ(MatZeroEntries(J));
41955f80ce2aSJacob Faibussowitsch   CHKERRQ(MatZeroEntries(JP));
41966528b96dSMatthew G. Knepley   key.label = NULL;
41976528b96dSMatthew G. Knepley   key.value = 0;
419806ad1575SMatthew G. Knepley   key.part  = 0;
4199a1cf66bbSMatthew G. Knepley   for (chunk = 0; chunk < numChunks; ++chunk, offCell += chunkSize) {
4200a1cf66bbSMatthew G. Knepley     const PetscInt   Ncell = PetscMin(chunkSize, numCells - offCell);
4201a1cf66bbSMatthew G. Knepley     PetscInt         c;
4202a1cf66bbSMatthew G. Knepley 
4203a1cf66bbSMatthew G. Knepley     /* Extract values */
4204a1cf66bbSMatthew G. Knepley     for (c = 0; c < Ncell; ++c) {
4205a1cf66bbSMatthew G. Knepley       const PetscInt cell = cells ? cells[c+offCell] : c+offCell;
4206a1cf66bbSMatthew G. Knepley       PetscScalar   *x = NULL,  *x_t = NULL;
4207a1cf66bbSMatthew G. Knepley       PetscInt       i;
4208a1cf66bbSMatthew G. Knepley 
4209a1cf66bbSMatthew G. Knepley       if (X) {
42105f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecGetClosure(dm, section, X, cell, NULL, &x));
4211a1cf66bbSMatthew G. Knepley         for (i = 0; i < totDim; ++i) u[c*totDim+i] = x[i];
42125f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecRestoreClosure(dm, section, X, cell, NULL, &x));
4213a1cf66bbSMatthew G. Knepley       }
4214a1cf66bbSMatthew G. Knepley       if (X_t) {
42155f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecGetClosure(dm, section, X_t, cell, NULL, &x_t));
4216a1cf66bbSMatthew G. Knepley         for (i = 0; i < totDim; ++i) u_t[c*totDim+i] = x_t[i];
42175f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecRestoreClosure(dm, section, X_t, cell, NULL, &x_t));
4218a1cf66bbSMatthew G. Knepley       }
4219a1cf66bbSMatthew G. Knepley       if (dmAux) {
42205f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecGetClosure(dmAux, sectionAux, A, cell, NULL, &x));
4221a1cf66bbSMatthew G. Knepley         for (i = 0; i < totDimAux; ++i) a[c*totDimAux+i] = x[i];
42225f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecRestoreClosure(dmAux, sectionAux, A, cell, NULL, &x));
4223a1cf66bbSMatthew G. Knepley       }
4224a1cf66bbSMatthew G. Knepley     }
4225a1cf66bbSMatthew G. Knepley     for (fieldI = 0; fieldI < Nf; ++fieldI) {
4226a1cf66bbSMatthew G. Knepley       PetscFE fe;
42275f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetDiscretization(prob, fieldI, (PetscObject *) &fe));
4228a1cf66bbSMatthew G. Knepley       for (fieldJ = 0; fieldJ < Nf; ++fieldJ) {
42296528b96dSMatthew G. Knepley         key.field = fieldI*Nf + fieldJ;
42305f80ce2aSJacob Faibussowitsch         if (hasJac)  CHKERRQ(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN,     key, Ncell, cgeomFEM, u, u_t, probAux, a, t, X_tShift, elemMat));
42315f80ce2aSJacob Faibussowitsch         if (hasPrec) CHKERRQ(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN_PRE, key, Ncell, cgeomFEM, u, u_t, probAux, a, t, X_tShift, elemMatP));
42325f80ce2aSJacob Faibussowitsch         if (hasDyn)  CHKERRQ(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN_DYN, key, Ncell, cgeomFEM, u, u_t, probAux, a, t, X_tShift, elemMatD));
4233a1cf66bbSMatthew G. Knepley       }
4234a1cf66bbSMatthew G. Knepley       /* For finite volume, add the identity */
4235a1cf66bbSMatthew G. Knepley       if (!isFE[fieldI]) {
4236a1cf66bbSMatthew G. Knepley         PetscFV  fv;
4237a1cf66bbSMatthew G. Knepley         PetscInt eOffset = 0, Nc, fc, foff;
4238a1cf66bbSMatthew G. Knepley 
42395f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDSGetFieldOffset(prob, fieldI, &foff));
42405f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDSGetDiscretization(prob, fieldI, (PetscObject *) &fv));
42415f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFVGetNumComponents(fv, &Nc));
4242a1cf66bbSMatthew G. Knepley         for (c = 0; c < chunkSize; ++c, eOffset += totDim*totDim) {
4243a1cf66bbSMatthew G. Knepley           for (fc = 0; fc < Nc; ++fc) {
4244a1cf66bbSMatthew G. Knepley             const PetscInt i = foff + fc;
4245a1cf66bbSMatthew G. Knepley             if (hasJac)  {elemMat [eOffset+i*totDim+i] = 1.0;}
4246a1cf66bbSMatthew G. Knepley             if (hasPrec) {elemMatP[eOffset+i*totDim+i] = 1.0;}
4247a1cf66bbSMatthew G. Knepley           }
4248a1cf66bbSMatthew G. Knepley         }
4249a1cf66bbSMatthew G. Knepley       }
4250a1cf66bbSMatthew G. Knepley     }
4251a1cf66bbSMatthew G. Knepley     /*   Add contribution from X_t */
4252a1cf66bbSMatthew G. Knepley     if (hasDyn) {for (c = 0; c < chunkSize*totDim*totDim; ++c) elemMat[c] += X_tShift*elemMatD[c];}
4253a1cf66bbSMatthew G. Knepley     /* Insert values into matrix */
4254a1cf66bbSMatthew G. Knepley     for (c = 0; c < Ncell; ++c) {
4255a1cf66bbSMatthew G. Knepley       const PetscInt cell = cells ? cells[c+offCell] : c+offCell;
4256a1cf66bbSMatthew G. Knepley       if (mesh->printFEM > 1) {
42575f80ce2aSJacob Faibussowitsch         if (hasJac)  CHKERRQ(DMPrintCellMatrix(cell, name,  totDim, totDim, &elemMat[(c-cStart)*totDim*totDim]));
42585f80ce2aSJacob Faibussowitsch         if (hasPrec) CHKERRQ(DMPrintCellMatrix(cell, nameP, totDim, totDim, &elemMatP[(c-cStart)*totDim*totDim]));
4259a1cf66bbSMatthew G. Knepley       }
42605f80ce2aSJacob Faibussowitsch       if (assembleJac) CHKERRQ(DMPlexMatSetClosure(dm, section, globalSection, Jac, cell, &elemMat[(c-cStart)*totDim*totDim], ADD_VALUES));
42615f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexMatSetClosure(dm, section, globalSection, JP, cell, &elemMat[(c-cStart)*totDim*totDim], ADD_VALUES));
4262a1cf66bbSMatthew G. Knepley     }
4263a1cf66bbSMatthew G. Knepley   }
4264a1cf66bbSMatthew G. Knepley   /* Cleanup */
42655f80ce2aSJacob Faibussowitsch   CHKERRQ(DMSNESRestoreFEGeom(coordField, cellIS, qGeom, PETSC_FALSE, &cgeomFEM));
42665f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscQuadratureDestroy(&qGeom));
42675f80ce2aSJacob Faibussowitsch   if (hasFV) CHKERRQ(MatSetOption(JacP, MAT_IGNORE_ZERO_ENTRIES, PETSC_FALSE));
42685f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreWorkArray(dm, Nf, MPIU_BOOL, &isFE));
42695f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreWorkArray(dm, ((1 + (X_t?1:0) + (dmAux?1:0))*totDim + ((hasJac?1:0) + (hasPrec?1:0) + (hasDyn?1:0))*totDim*totDim)*chunkSize, MPIU_SCALAR, &work));
4270a1cf66bbSMatthew G. Knepley   /* Compute boundary integrals */
42715f80ce2aSJacob Faibussowitsch   /* CHKERRQ(DMPlexComputeBdJacobian_Internal(dm, X, X_t, t, X_tShift, Jac, JacP, ctx)); */
4272a1cf66bbSMatthew G. Knepley   /* Assemble matrix */
42735f80ce2aSJacob Faibussowitsch   if (assembleJac) {CHKERRQ(MatAssemblyBegin(Jac, MAT_FINAL_ASSEMBLY));CHKERRQ(MatAssemblyEnd(Jac, MAT_FINAL_ASSEMBLY));}
42745f80ce2aSJacob Faibussowitsch   CHKERRQ(MatAssemblyBegin(JacP, MAT_FINAL_ASSEMBLY));CHKERRQ(MatAssemblyEnd(JacP, MAT_FINAL_ASSEMBLY));
42755f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventEnd(DMPLEX_JacobianFEM,dm,0,0,0));
4276a1cf66bbSMatthew G. Knepley   PetscFunctionReturn(0);
4277a1cf66bbSMatthew G. Knepley }
42783e9753d6SMatthew G. Knepley 
42793e9753d6SMatthew G. Knepley /******** FEM Assembly Function ********/
42803e9753d6SMatthew G. Knepley 
42813e9753d6SMatthew G. Knepley static PetscErrorCode DMConvertPlex_Internal(DM dm, DM *plex, PetscBool copy)
42823e9753d6SMatthew G. Knepley {
42833e9753d6SMatthew G. Knepley   PetscBool      isPlex;
42843e9753d6SMatthew G. Knepley 
42853e9753d6SMatthew G. Knepley   PetscFunctionBegin;
42865f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscObjectTypeCompare((PetscObject) dm, DMPLEX, &isPlex));
42873e9753d6SMatthew G. Knepley   if (isPlex) {
42883e9753d6SMatthew G. Knepley     *plex = dm;
42895f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectReference((PetscObject) dm));
42903e9753d6SMatthew G. Knepley   } else {
42915f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectQuery((PetscObject) dm, "dm_plex", (PetscObject *) plex));
42923e9753d6SMatthew G. Knepley     if (!*plex) {
42935f80ce2aSJacob Faibussowitsch       CHKERRQ(DMConvert(dm,DMPLEX,plex));
42945f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscObjectCompose((PetscObject) dm, "dm_plex", (PetscObject) *plex));
42953e9753d6SMatthew G. Knepley       if (copy) {
42965f80ce2aSJacob Faibussowitsch         CHKERRQ(DMCopyAuxiliaryVec(dm, *plex));
42973e9753d6SMatthew G. Knepley       }
42983e9753d6SMatthew G. Knepley     } else {
42995f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscObjectReference((PetscObject) *plex));
43003e9753d6SMatthew G. Knepley     }
43013e9753d6SMatthew G. Knepley   }
43023e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
43033e9753d6SMatthew G. Knepley }
43043e9753d6SMatthew G. Knepley 
43053e9753d6SMatthew G. Knepley /*@
43063e9753d6SMatthew G. Knepley   DMPlexGetGeometryFVM - Return precomputed geometric data
43073e9753d6SMatthew G. Knepley 
43083e9753d6SMatthew G. Knepley   Collective on DM
43093e9753d6SMatthew G. Knepley 
43103e9753d6SMatthew G. Knepley   Input Parameter:
43113e9753d6SMatthew G. Knepley . dm - The DM
43123e9753d6SMatthew G. Knepley 
43133e9753d6SMatthew G. Knepley   Output Parameters:
43143e9753d6SMatthew G. Knepley + facegeom - The values precomputed from face geometry
43153e9753d6SMatthew G. Knepley . cellgeom - The values precomputed from cell geometry
43163e9753d6SMatthew G. Knepley - minRadius - The minimum radius over the mesh of an inscribed sphere in a cell
43173e9753d6SMatthew G. Knepley 
43183e9753d6SMatthew G. Knepley   Level: developer
43193e9753d6SMatthew G. Knepley 
4320446c23c1SPierre Jolivet .seealso: DMTSSetRHSFunctionLocal()
43213e9753d6SMatthew G. Knepley @*/
43223e9753d6SMatthew G. Knepley PetscErrorCode DMPlexGetGeometryFVM(DM dm, Vec *facegeom, Vec *cellgeom, PetscReal *minRadius)
43233e9753d6SMatthew G. Knepley {
43243e9753d6SMatthew G. Knepley   DM             plex;
43253e9753d6SMatthew G. Knepley 
43263e9753d6SMatthew G. Knepley   PetscFunctionBegin;
43273e9753d6SMatthew G. Knepley   PetscValidHeaderSpecific(dm,DM_CLASSID,1);
43285f80ce2aSJacob Faibussowitsch   CHKERRQ(DMConvertPlex_Internal(dm,&plex,PETSC_TRUE));
43295f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetDataFVM(plex, NULL, cellgeom, facegeom, NULL));
43305f80ce2aSJacob Faibussowitsch   if (minRadius) CHKERRQ(DMPlexGetMinRadius(plex, minRadius));
43315f80ce2aSJacob Faibussowitsch   CHKERRQ(DMDestroy(&plex));
43323e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
43333e9753d6SMatthew G. Knepley }
43343e9753d6SMatthew G. Knepley 
43353e9753d6SMatthew G. Knepley /*@
43363e9753d6SMatthew G. Knepley   DMPlexGetGradientDM - Return gradient data layout
43373e9753d6SMatthew G. Knepley 
43383e9753d6SMatthew G. Knepley   Collective on DM
43393e9753d6SMatthew G. Knepley 
43403e9753d6SMatthew G. Knepley   Input Parameters:
43413e9753d6SMatthew G. Knepley + dm - The DM
43423e9753d6SMatthew G. Knepley - fv - The PetscFV
43433e9753d6SMatthew G. Knepley 
43443e9753d6SMatthew G. Knepley   Output Parameter:
43453e9753d6SMatthew G. Knepley . dmGrad - The layout for gradient values
43463e9753d6SMatthew G. Knepley 
43473e9753d6SMatthew G. Knepley   Level: developer
43483e9753d6SMatthew G. Knepley 
4349446c23c1SPierre Jolivet .seealso: DMPlexGetGeometryFVM()
43503e9753d6SMatthew G. Knepley @*/
43513e9753d6SMatthew G. Knepley PetscErrorCode DMPlexGetGradientDM(DM dm, PetscFV fv, DM *dmGrad)
43523e9753d6SMatthew G. Knepley {
43533e9753d6SMatthew G. Knepley   DM             plex;
43543e9753d6SMatthew G. Knepley   PetscBool      computeGradients;
43553e9753d6SMatthew G. Knepley 
43563e9753d6SMatthew G. Knepley   PetscFunctionBegin;
43573e9753d6SMatthew G. Knepley   PetscValidHeaderSpecific(dm,DM_CLASSID,1);
43583e9753d6SMatthew G. Knepley   PetscValidHeaderSpecific(fv,PETSCFV_CLASSID,2);
43593e9753d6SMatthew G. Knepley   PetscValidPointer(dmGrad,3);
43605f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFVGetComputeGradients(fv, &computeGradients));
43613e9753d6SMatthew G. Knepley   if (!computeGradients) {*dmGrad = NULL; PetscFunctionReturn(0);}
43625f80ce2aSJacob Faibussowitsch   CHKERRQ(DMConvertPlex_Internal(dm,&plex,PETSC_TRUE));
43635f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetDataFVM(plex, fv, NULL, NULL, dmGrad));
43645f80ce2aSJacob Faibussowitsch   CHKERRQ(DMDestroy(&plex));
43653e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
43663e9753d6SMatthew G. Knepley }
43673e9753d6SMatthew G. Knepley 
43680c290148SMatthew G. Knepley static PetscErrorCode DMPlexComputeBdResidual_Single_Internal(DM dm, PetscReal t, PetscWeakForm wf, PetscFormKey key, Vec locX, Vec locX_t, Vec locF, DMField coordField, IS facetIS)
43693e9753d6SMatthew G. Knepley {
43703e9753d6SMatthew G. Knepley   DM_Plex         *mesh = (DM_Plex *) dm->data;
43713e9753d6SMatthew G. Knepley   DM               plex = NULL, plexA = NULL;
43723e9753d6SMatthew G. Knepley   DMEnclosureType  encAux;
43733e9753d6SMatthew G. Knepley   PetscDS          prob, probAux = NULL;
43743e9753d6SMatthew G. Knepley   PetscSection     section, sectionAux = NULL;
43753e9753d6SMatthew G. Knepley   Vec              locA = NULL;
43763e9753d6SMatthew G. Knepley   PetscScalar     *u = NULL, *u_t = NULL, *a = NULL, *elemVec = NULL;
43773e9753d6SMatthew G. Knepley   PetscInt         totDim, totDimAux = 0;
43783e9753d6SMatthew G. Knepley 
43793e9753d6SMatthew G. Knepley   PetscFunctionBegin;
43805f80ce2aSJacob Faibussowitsch   CHKERRQ(DMConvert(dm, DMPLEX, &plex));
43815f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &section));
43825f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDS(dm, &prob));
43835f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetTotalDimension(prob, &totDim));
43845f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetAuxiliaryVec(dm, key.label, key.value, key.part, &locA));
43853e9753d6SMatthew G. Knepley   if (locA) {
43863e9753d6SMatthew G. Knepley     DM dmAux;
43873e9753d6SMatthew G. Knepley 
43885f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetDM(locA, &dmAux));
43895f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetEnclosureRelation(dmAux, dm, &encAux));
43905f80ce2aSJacob Faibussowitsch     CHKERRQ(DMConvert(dmAux, DMPLEX, &plexA));
43915f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetDS(plexA, &probAux));
43925f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetTotalDimension(probAux, &totDimAux));
43935f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetLocalSection(plexA, &sectionAux));
43943e9753d6SMatthew G. Knepley   }
43950c290148SMatthew G. Knepley   {
43963e9753d6SMatthew G. Knepley     PetscFEGeom     *fgeom;
43973e9753d6SMatthew G. Knepley     PetscInt         maxDegree;
43983e9753d6SMatthew G. Knepley     PetscQuadrature  qGeom = NULL;
43993e9753d6SMatthew G. Knepley     IS               pointIS;
44003e9753d6SMatthew G. Knepley     const PetscInt  *points;
44013e9753d6SMatthew G. Knepley     PetscInt         numFaces, face, Nq;
44023e9753d6SMatthew G. Knepley 
44035f80ce2aSJacob Faibussowitsch     CHKERRQ(DMLabelGetStratumIS(key.label, key.value, &pointIS));
44040c290148SMatthew G. Knepley     if (!pointIS) goto end; /* No points with that id on this process */
44053e9753d6SMatthew G. Knepley     {
44063e9753d6SMatthew G. Knepley       IS isectIS;
44073e9753d6SMatthew G. Knepley 
44083e9753d6SMatthew G. Knepley       /* TODO: Special cases of ISIntersect where it is quick to check a priori if one is a superset of the other */
44095f80ce2aSJacob Faibussowitsch       CHKERRQ(ISIntersect_Caching_Internal(facetIS,pointIS,&isectIS));
44105f80ce2aSJacob Faibussowitsch       CHKERRQ(ISDestroy(&pointIS));
44113e9753d6SMatthew G. Knepley       pointIS = isectIS;
44123e9753d6SMatthew G. Knepley     }
44135f80ce2aSJacob Faibussowitsch     CHKERRQ(ISGetLocalSize(pointIS,&numFaces));
44145f80ce2aSJacob Faibussowitsch     CHKERRQ(ISGetIndices(pointIS,&points));
44155f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscMalloc4(numFaces*totDim, &u, locX_t ? numFaces*totDim : 0, &u_t, numFaces*totDim, &elemVec, locA ? numFaces*totDimAux : 0, &a));
44165f80ce2aSJacob Faibussowitsch     CHKERRQ(DMFieldGetDegree(coordField,pointIS,NULL,&maxDegree));
44173e9753d6SMatthew G. Knepley     if (maxDegree <= 1) {
44185f80ce2aSJacob Faibussowitsch       CHKERRQ(DMFieldCreateDefaultQuadrature(coordField,pointIS,&qGeom));
44193e9753d6SMatthew G. Knepley     }
44203e9753d6SMatthew G. Knepley     if (!qGeom) {
44213e9753d6SMatthew G. Knepley       PetscFE fe;
44223e9753d6SMatthew G. Knepley 
44235f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetDiscretization(prob, key.field, (PetscObject *) &fe));
44245f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetFaceQuadrature(fe, &qGeom));
44255f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscObjectReference((PetscObject)qGeom));
44263e9753d6SMatthew G. Knepley     }
44275f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscQuadratureGetData(qGeom, NULL, NULL, &Nq, NULL, NULL));
44285f80ce2aSJacob Faibussowitsch     CHKERRQ(DMSNESGetFEGeom(coordField,pointIS,qGeom,PETSC_TRUE,&fgeom));
44293e9753d6SMatthew G. Knepley     for (face = 0; face < numFaces; ++face) {
4430f15274beSMatthew Knepley       const PetscInt point = points[face], *support;
44313e9753d6SMatthew G. Knepley       PetscScalar   *x     = NULL;
4432f15274beSMatthew Knepley       PetscInt       i;
44333e9753d6SMatthew G. Knepley 
44345f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetSupport(dm, point, &support));
44355f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecGetClosure(plex, section, locX, support[0], NULL, &x));
44363e9753d6SMatthew G. Knepley       for (i = 0; i < totDim; ++i) u[face*totDim+i] = x[i];
44375f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecRestoreClosure(plex, section, locX, support[0], NULL, &x));
44383e9753d6SMatthew G. Knepley       if (locX_t) {
44395f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecGetClosure(plex, section, locX_t, support[0], NULL, &x));
44403e9753d6SMatthew G. Knepley         for (i = 0; i < totDim; ++i) u_t[face*totDim+i] = x[i];
44415f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecRestoreClosure(plex, section, locX_t, support[0], NULL, &x));
44423e9753d6SMatthew G. Knepley       }
44433e9753d6SMatthew G. Knepley       if (locA) {
44443e9753d6SMatthew G. Knepley         PetscInt subp;
44453e9753d6SMatthew G. Knepley 
44465f80ce2aSJacob Faibussowitsch         CHKERRQ(DMGetEnclosurePoint(plexA, dm, encAux, support[0], &subp));
44475f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecGetClosure(plexA, sectionAux, locA, subp, NULL, &x));
44483e9753d6SMatthew G. Knepley         for (i = 0; i < totDimAux; ++i) a[face*totDimAux+i] = x[i];
44495f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecRestoreClosure(plexA, sectionAux, locA, subp, NULL, &x));
44503e9753d6SMatthew G. Knepley       }
44513e9753d6SMatthew G. Knepley     }
44525f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscArrayzero(elemVec, numFaces*totDim));
44533e9753d6SMatthew G. Knepley     {
44543e9753d6SMatthew G. Knepley       PetscFE         fe;
44553e9753d6SMatthew G. Knepley       PetscInt        Nb;
44563e9753d6SMatthew G. Knepley       PetscFEGeom     *chunkGeom = NULL;
44573e9753d6SMatthew G. Knepley       /* Conforming batches */
44583e9753d6SMatthew G. Knepley       PetscInt        numChunks, numBatches, numBlocks, Ne, blockSize, batchSize;
44593e9753d6SMatthew G. Knepley       /* Remainder */
44603e9753d6SMatthew G. Knepley       PetscInt        Nr, offset;
44613e9753d6SMatthew G. Knepley 
44625f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetDiscretization(prob, key.field, (PetscObject *) &fe));
44635f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetDimension(fe, &Nb));
44645f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
44653e9753d6SMatthew G. Knepley       /* TODO: documentation is unclear about what is going on with these numbers: how should Nb / Nq factor in ? */
44663e9753d6SMatthew G. Knepley       blockSize = Nb;
44673e9753d6SMatthew G. Knepley       batchSize = numBlocks * blockSize;
44685f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
44693e9753d6SMatthew G. Knepley       numChunks = numFaces / (numBatches*batchSize);
44703e9753d6SMatthew G. Knepley       Ne        = numChunks*numBatches*batchSize;
44713e9753d6SMatthew G. Knepley       Nr        = numFaces % (numBatches*batchSize);
44723e9753d6SMatthew G. Knepley       offset    = numFaces - Nr;
44735f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomGetChunk(fgeom,0,offset,&chunkGeom));
44745f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEIntegrateBdResidual(prob, wf, key, Ne, chunkGeom, u, u_t, probAux, a, t, elemVec));
44755f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomRestoreChunk(fgeom, 0, offset, &chunkGeom));
44765f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomGetChunk(fgeom,offset,numFaces,&chunkGeom));
44775f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEIntegrateBdResidual(prob, wf, key, Nr, chunkGeom, &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, probAux, a ? &a[offset*totDimAux] : NULL, t, &elemVec[offset*totDim]));
44785f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomRestoreChunk(fgeom,offset,numFaces,&chunkGeom));
44793e9753d6SMatthew G. Knepley     }
44803e9753d6SMatthew G. Knepley     for (face = 0; face < numFaces; ++face) {
44813e9753d6SMatthew G. Knepley       const PetscInt point = points[face], *support;
44823e9753d6SMatthew G. Knepley 
44835f80ce2aSJacob Faibussowitsch       if (mesh->printFEM > 1) CHKERRQ(DMPrintCellVector(point, "BdResidual", totDim, &elemVec[face*totDim]));
44845f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetSupport(plex, point, &support));
44855f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecSetClosure(plex, NULL, locF, support[0], &elemVec[face*totDim], ADD_ALL_VALUES));
44863e9753d6SMatthew G. Knepley     }
44875f80ce2aSJacob Faibussowitsch     CHKERRQ(DMSNESRestoreFEGeom(coordField,pointIS,qGeom,PETSC_TRUE,&fgeom));
44885f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscQuadratureDestroy(&qGeom));
44895f80ce2aSJacob Faibussowitsch     CHKERRQ(ISRestoreIndices(pointIS, &points));
44905f80ce2aSJacob Faibussowitsch     CHKERRQ(ISDestroy(&pointIS));
44915f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFree4(u, u_t, elemVec, a));
44923e9753d6SMatthew G. Knepley   }
44930c290148SMatthew G. Knepley   end:
44945f80ce2aSJacob Faibussowitsch   CHKERRQ(DMDestroy(&plex));
44955f80ce2aSJacob Faibussowitsch   CHKERRQ(DMDestroy(&plexA));
44963e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
44973e9753d6SMatthew G. Knepley }
44983e9753d6SMatthew G. Knepley 
44990c290148SMatthew G. Knepley PetscErrorCode DMPlexComputeBdResidualSingle(DM dm, PetscReal t, PetscWeakForm wf, PetscFormKey key, Vec locX, Vec locX_t, Vec locF)
45003e9753d6SMatthew G. Knepley {
45013e9753d6SMatthew G. Knepley   DMField        coordField;
45023e9753d6SMatthew G. Knepley   DMLabel        depthLabel;
45033e9753d6SMatthew G. Knepley   IS             facetIS;
45043e9753d6SMatthew G. Knepley   PetscInt       dim;
45053e9753d6SMatthew G. Knepley 
45063e9753d6SMatthew G. Knepley   PetscFunctionBegin;
45075f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dm, &dim));
45085f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetDepthLabel(dm, &depthLabel));
45095f80ce2aSJacob Faibussowitsch   CHKERRQ(DMLabelGetStratumIS(depthLabel, dim-1, &facetIS));
45105f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateField(dm, &coordField));
45115f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexComputeBdResidual_Single_Internal(dm, t, wf, key, locX, locX_t, locF, coordField, facetIS));
45125f80ce2aSJacob Faibussowitsch   CHKERRQ(ISDestroy(&facetIS));
45133e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
45143e9753d6SMatthew G. Knepley }
45153e9753d6SMatthew G. Knepley 
45163e9753d6SMatthew G. Knepley PetscErrorCode DMPlexComputeBdResidual_Internal(DM dm, Vec locX, Vec locX_t, PetscReal t, Vec locF, void *user)
45173e9753d6SMatthew G. Knepley {
45183e9753d6SMatthew G. Knepley   PetscDS        prob;
45193e9753d6SMatthew G. Knepley   PetscInt       numBd, bd;
45203e9753d6SMatthew G. Knepley   DMField        coordField = NULL;
45213e9753d6SMatthew G. Knepley   IS             facetIS    = NULL;
45223e9753d6SMatthew G. Knepley   DMLabel        depthLabel;
45233e9753d6SMatthew G. Knepley   PetscInt       dim;
45243e9753d6SMatthew G. Knepley 
45253e9753d6SMatthew G. Knepley   PetscFunctionBegin;
45265f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDS(dm, &prob));
45275f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetDepthLabel(dm, &depthLabel));
45285f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dm, &dim));
45295f80ce2aSJacob Faibussowitsch   CHKERRQ(DMLabelGetStratumIS(depthLabel,dim - 1,&facetIS));
45305f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetNumBoundary(prob, &numBd));
45313e9753d6SMatthew G. Knepley   for (bd = 0; bd < numBd; ++bd) {
453245480ffeSMatthew G. Knepley     PetscWeakForm           wf;
45333e9753d6SMatthew G. Knepley     DMBoundaryConditionType type;
45343e9753d6SMatthew G. Knepley     DMLabel                 label;
45353e9753d6SMatthew G. Knepley     const PetscInt         *values;
45360c290148SMatthew G. Knepley     PetscInt                field, numValues, v;
45373e9753d6SMatthew G. Knepley     PetscObject             obj;
45383e9753d6SMatthew G. Knepley     PetscClassId            id;
45390c290148SMatthew G. Knepley     PetscFormKey            key;
45403e9753d6SMatthew G. Knepley 
45415f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetBoundary(prob, bd, &wf, &type, NULL, &label, &numValues, &values, &field, NULL, NULL, NULL, NULL, NULL));
45425f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, field, &obj));
45435f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
45443e9753d6SMatthew G. Knepley     if ((id != PETSCFE_CLASSID) || (type & DM_BC_ESSENTIAL)) continue;
45453e9753d6SMatthew G. Knepley     if (!facetIS) {
45463e9753d6SMatthew G. Knepley       DMLabel  depthLabel;
45473e9753d6SMatthew G. Knepley       PetscInt dim;
45483e9753d6SMatthew G. Knepley 
45495f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetDepthLabel(dm, &depthLabel));
45505f80ce2aSJacob Faibussowitsch       CHKERRQ(DMGetDimension(dm, &dim));
45515f80ce2aSJacob Faibussowitsch       CHKERRQ(DMLabelGetStratumIS(depthLabel, dim - 1, &facetIS));
45523e9753d6SMatthew G. Knepley     }
45535f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetCoordinateField(dm, &coordField));
45540c290148SMatthew G. Knepley     for (v = 0; v < numValues; ++v) {
45550c290148SMatthew G. Knepley       key.label = label;
45560c290148SMatthew G. Knepley       key.value = values[v];
45570c290148SMatthew G. Knepley       key.field = field;
45580c290148SMatthew G. Knepley       key.part  = 0;
45595f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexComputeBdResidual_Single_Internal(dm, t, wf, key, locX, locX_t, locF, coordField, facetIS));
45600c290148SMatthew G. Knepley     }
45613e9753d6SMatthew G. Knepley   }
45625f80ce2aSJacob Faibussowitsch   CHKERRQ(ISDestroy(&facetIS));
45633e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
45643e9753d6SMatthew G. Knepley }
45653e9753d6SMatthew G. Knepley 
456606ad1575SMatthew G. Knepley PetscErrorCode DMPlexComputeResidual_Internal(DM dm, PetscFormKey key, IS cellIS, PetscReal time, Vec locX, Vec locX_t, PetscReal t, Vec locF, void *user)
45673e9753d6SMatthew G. Knepley {
45683e9753d6SMatthew G. Knepley   DM_Plex         *mesh       = (DM_Plex *) dm->data;
45693e9753d6SMatthew G. Knepley   const char      *name       = "Residual";
45703e9753d6SMatthew G. Knepley   DM               dmAux      = NULL;
45713e9753d6SMatthew G. Knepley   DM               dmGrad     = NULL;
45723e9753d6SMatthew G. Knepley   DMLabel          ghostLabel = NULL;
45736528b96dSMatthew G. Knepley   PetscDS          ds         = NULL;
45746528b96dSMatthew G. Knepley   PetscDS          dsAux      = NULL;
45753e9753d6SMatthew G. Knepley   PetscSection     section    = NULL;
45763e9753d6SMatthew G. Knepley   PetscBool        useFEM     = PETSC_FALSE;
45773e9753d6SMatthew G. Knepley   PetscBool        useFVM     = PETSC_FALSE;
45783e9753d6SMatthew G. Knepley   PetscBool        isImplicit = (locX_t || time == PETSC_MIN_REAL) ? PETSC_TRUE : PETSC_FALSE;
45793e9753d6SMatthew G. Knepley   PetscFV          fvm        = NULL;
45803e9753d6SMatthew G. Knepley   PetscFVCellGeom *cgeomFVM   = NULL;
45813e9753d6SMatthew G. Knepley   PetscFVFaceGeom *fgeomFVM   = NULL;
45823e9753d6SMatthew G. Knepley   DMField          coordField = NULL;
45833e9753d6SMatthew G. Knepley   Vec              locA, cellGeometryFVM = NULL, faceGeometryFVM = NULL, grad, locGrad = NULL;
45843e9753d6SMatthew G. Knepley   PetscScalar     *u = NULL, *u_t, *a, *uL, *uR;
45853e9753d6SMatthew G. Knepley   IS               chunkIS;
45863e9753d6SMatthew G. Knepley   const PetscInt  *cells;
45873e9753d6SMatthew G. Knepley   PetscInt         cStart, cEnd, numCells;
45883e9753d6SMatthew G. Knepley   PetscInt         Nf, f, totDim, totDimAux, numChunks, cellChunkSize, faceChunkSize, chunk, fStart, fEnd;
45893e9753d6SMatthew G. Knepley   PetscInt         maxDegree = PETSC_MAX_INT;
45903e9753d6SMatthew G. Knepley   PetscQuadrature  affineQuad = NULL, *quads = NULL;
45913e9753d6SMatthew G. Knepley   PetscFEGeom     *affineGeom = NULL, **geoms = NULL;
45923e9753d6SMatthew G. Knepley 
45933e9753d6SMatthew G. Knepley   PetscFunctionBegin;
45945f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventBegin(DMPLEX_ResidualFEM,dm,0,0,0));
45953e9753d6SMatthew G. Knepley   /* TODO The places where we have to use isFE are probably the member functions for the PetscDisc class */
45963e9753d6SMatthew G. Knepley   /* TODO The FVM geometry is over-manipulated. Make the precalc functions return exactly what we need */
45973e9753d6SMatthew G. Knepley   /* FEM+FVM */
45985f80ce2aSJacob Faibussowitsch   CHKERRQ(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
45995f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetHeightStratum(dm, 1, &fStart, &fEnd));
46003e9753d6SMatthew G. Knepley   /* 1: Get sizes from dm and dmAux */
46015f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &section));
46025f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLabel(dm, "ghost", &ghostLabel));
46035f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCellDS(dm, cells ? cells[cStart] : cStart, &ds));
46045f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetNumFields(ds, &Nf));
46055f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetTotalDimension(ds, &totDim));
46065f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetAuxiliaryVec(dm, key.label, key.value, key.part, &locA));
46073e9753d6SMatthew G. Knepley   if (locA) {
46083e9753d6SMatthew G. Knepley     PetscInt subcell;
46095f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetDM(locA, &dmAux));
46105f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetEnclosurePoint(dmAux, dm, DM_ENC_UNKNOWN, cStart, &subcell));
46115f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetCellDS(dmAux, subcell, &dsAux));
46125f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetTotalDimension(dsAux, &totDimAux));
46133e9753d6SMatthew G. Knepley   }
46143e9753d6SMatthew G. Knepley   /* 2: Get geometric data */
46153e9753d6SMatthew G. Knepley   for (f = 0; f < Nf; ++f) {
46163e9753d6SMatthew G. Knepley     PetscObject  obj;
46173e9753d6SMatthew G. Knepley     PetscClassId id;
46183e9753d6SMatthew G. Knepley     PetscBool    fimp;
46193e9753d6SMatthew G. Knepley 
46205f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetImplicit(ds, f, &fimp));
46213e9753d6SMatthew G. Knepley     if (isImplicit != fimp) continue;
46225f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(ds, f, &obj));
46235f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
46243e9753d6SMatthew G. Knepley     if (id == PETSCFE_CLASSID) {useFEM = PETSC_TRUE;}
46253e9753d6SMatthew G. Knepley     if (id == PETSCFV_CLASSID) {useFVM = PETSC_TRUE; fvm = (PetscFV) obj;}
46263e9753d6SMatthew G. Knepley   }
46273e9753d6SMatthew G. Knepley   if (useFEM) {
46285f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetCoordinateField(dm, &coordField));
46295f80ce2aSJacob Faibussowitsch     CHKERRQ(DMFieldGetDegree(coordField,cellIS,NULL,&maxDegree));
46303e9753d6SMatthew G. Knepley     if (maxDegree <= 1) {
46315f80ce2aSJacob Faibussowitsch       CHKERRQ(DMFieldCreateDefaultQuadrature(coordField,cellIS,&affineQuad));
46323e9753d6SMatthew G. Knepley       if (affineQuad) {
46335f80ce2aSJacob Faibussowitsch         CHKERRQ(DMSNESGetFEGeom(coordField,cellIS,affineQuad,PETSC_FALSE,&affineGeom));
46343e9753d6SMatthew G. Knepley       }
46353e9753d6SMatthew G. Knepley     } else {
46365f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscCalloc2(Nf,&quads,Nf,&geoms));
46373e9753d6SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
46383e9753d6SMatthew G. Knepley         PetscObject  obj;
46393e9753d6SMatthew G. Knepley         PetscClassId id;
46403e9753d6SMatthew G. Knepley         PetscBool    fimp;
46413e9753d6SMatthew G. Knepley 
46425f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDSGetImplicit(ds, f, &fimp));
46433e9753d6SMatthew G. Knepley         if (isImplicit != fimp) continue;
46445f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDSGetDiscretization(ds, f, &obj));
46455f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscObjectGetClassId(obj, &id));
46463e9753d6SMatthew G. Knepley         if (id == PETSCFE_CLASSID) {
46473e9753d6SMatthew G. Knepley           PetscFE fe = (PetscFE) obj;
46483e9753d6SMatthew G. Knepley 
46495f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEGetQuadrature(fe, &quads[f]));
46505f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscObjectReference((PetscObject)quads[f]));
46515f80ce2aSJacob Faibussowitsch           CHKERRQ(DMSNESGetFEGeom(coordField,cellIS,quads[f],PETSC_FALSE,&geoms[f]));
46523e9753d6SMatthew G. Knepley         }
46533e9753d6SMatthew G. Knepley       }
46543e9753d6SMatthew G. Knepley     }
46553e9753d6SMatthew G. Knepley   }
46563e9753d6SMatthew G. Knepley   if (useFVM) {
46575f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexGetGeometryFVM(dm, &faceGeometryFVM, &cellGeometryFVM, NULL));
46585f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetArrayRead(faceGeometryFVM, (const PetscScalar **) &fgeomFVM));
46595f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetArrayRead(cellGeometryFVM, (const PetscScalar **) &cgeomFVM));
46603e9753d6SMatthew G. Knepley     /* Reconstruct and limit cell gradients */
46615f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexGetGradientDM(dm, fvm, &dmGrad));
46623e9753d6SMatthew G. Knepley     if (dmGrad) {
46635f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetHeightStratum(dm, 1, &fStart, &fEnd));
46645f80ce2aSJacob Faibussowitsch       CHKERRQ(DMGetGlobalVector(dmGrad, &grad));
46655f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexReconstructGradients_Internal(dm, fvm, fStart, fEnd, faceGeometryFVM, cellGeometryFVM, locX, grad));
46663e9753d6SMatthew G. Knepley       /* Communicate gradient values */
46675f80ce2aSJacob Faibussowitsch       CHKERRQ(DMGetLocalVector(dmGrad, &locGrad));
46685f80ce2aSJacob Faibussowitsch       CHKERRQ(DMGlobalToLocalBegin(dmGrad, grad, INSERT_VALUES, locGrad));
46695f80ce2aSJacob Faibussowitsch       CHKERRQ(DMGlobalToLocalEnd(dmGrad, grad, INSERT_VALUES, locGrad));
46705f80ce2aSJacob Faibussowitsch       CHKERRQ(DMRestoreGlobalVector(dmGrad, &grad));
46713e9753d6SMatthew G. Knepley     }
46723e9753d6SMatthew G. Knepley     /* Handle non-essential (e.g. outflow) boundary values */
46735f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexInsertBoundaryValues(dm, PETSC_FALSE, locX, time, faceGeometryFVM, cellGeometryFVM, locGrad));
46743e9753d6SMatthew G. Knepley   }
46753e9753d6SMatthew G. Knepley   /* Loop over chunks */
46765f80ce2aSJacob Faibussowitsch   if (useFEM) CHKERRQ(ISCreate(PETSC_COMM_SELF, &chunkIS));
46773e9753d6SMatthew G. Knepley   numCells      = cEnd - cStart;
46783e9753d6SMatthew G. Knepley   numChunks     = 1;
46793e9753d6SMatthew G. Knepley   cellChunkSize = numCells/numChunks;
46803e9753d6SMatthew G. Knepley   faceChunkSize = (fEnd - fStart)/numChunks;
46813e9753d6SMatthew G. Knepley   numChunks     = PetscMin(1,numCells);
46823e9753d6SMatthew G. Knepley   for (chunk = 0; chunk < numChunks; ++chunk) {
46833e9753d6SMatthew G. Knepley     PetscScalar     *elemVec, *fluxL, *fluxR;
46843e9753d6SMatthew G. Knepley     PetscReal       *vol;
46853e9753d6SMatthew G. Knepley     PetscFVFaceGeom *fgeom;
46863e9753d6SMatthew G. Knepley     PetscInt         cS = cStart+chunk*cellChunkSize, cE = PetscMin(cS+cellChunkSize, cEnd), numCells = cE - cS, c;
46873e9753d6SMatthew G. Knepley     PetscInt         fS = fStart+chunk*faceChunkSize, fE = PetscMin(fS+faceChunkSize, fEnd), numFaces = 0, face;
46883e9753d6SMatthew G. Knepley 
46893e9753d6SMatthew G. Knepley     /* Extract field coefficients */
46903e9753d6SMatthew G. Knepley     if (useFEM) {
46915f80ce2aSJacob Faibussowitsch       CHKERRQ(ISGetPointSubrange(chunkIS, cS, cE, cells));
46925f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetCellFields(dm, chunkIS, locX, locX_t, locA, &u, &u_t, &a));
46935f80ce2aSJacob Faibussowitsch       CHKERRQ(DMGetWorkArray(dm, numCells*totDim, MPIU_SCALAR, &elemVec));
46945f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscArrayzero(elemVec, numCells*totDim));
46953e9753d6SMatthew G. Knepley     }
46963e9753d6SMatthew G. Knepley     if (useFVM) {
46975f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetFaceFields(dm, fS, fE, locX, locX_t, faceGeometryFVM, cellGeometryFVM, locGrad, &numFaces, &uL, &uR));
46985f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetFaceGeometry(dm, fS, fE, faceGeometryFVM, cellGeometryFVM, &numFaces, &fgeom, &vol));
46995f80ce2aSJacob Faibussowitsch       CHKERRQ(DMGetWorkArray(dm, numFaces*totDim, MPIU_SCALAR, &fluxL));
47005f80ce2aSJacob Faibussowitsch       CHKERRQ(DMGetWorkArray(dm, numFaces*totDim, MPIU_SCALAR, &fluxR));
47015f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscArrayzero(fluxL, numFaces*totDim));
47025f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscArrayzero(fluxR, numFaces*totDim));
47033e9753d6SMatthew G. Knepley     }
47043e9753d6SMatthew G. Knepley     /* TODO We will interlace both our field coefficients (u, u_t, uL, uR, etc.) and our output (elemVec, fL, fR). I think this works */
47053e9753d6SMatthew G. Knepley     /* Loop over fields */
47063e9753d6SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
47073e9753d6SMatthew G. Knepley       PetscObject  obj;
47083e9753d6SMatthew G. Knepley       PetscClassId id;
47093e9753d6SMatthew G. Knepley       PetscBool    fimp;
47103e9753d6SMatthew G. Knepley       PetscInt     numChunks, numBatches, batchSize, numBlocks, blockSize, Ne, Nr, offset;
47113e9753d6SMatthew G. Knepley 
47126528b96dSMatthew G. Knepley       key.field = f;
47135f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetImplicit(ds, f, &fimp));
47143e9753d6SMatthew G. Knepley       if (isImplicit != fimp) continue;
47155f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetDiscretization(ds, f, &obj));
47165f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscObjectGetClassId(obj, &id));
47173e9753d6SMatthew G. Knepley       if (id == PETSCFE_CLASSID) {
47183e9753d6SMatthew G. Knepley         PetscFE         fe = (PetscFE) obj;
47193e9753d6SMatthew G. Knepley         PetscFEGeom    *geom = affineGeom ? affineGeom : geoms[f];
47203e9753d6SMatthew G. Knepley         PetscFEGeom    *chunkGeom = NULL;
47213e9753d6SMatthew G. Knepley         PetscQuadrature quad = affineQuad ? affineQuad : quads[f];
47223e9753d6SMatthew G. Knepley         PetscInt        Nq, Nb;
47233e9753d6SMatthew G. Knepley 
47245f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
47255f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscQuadratureGetData(quad, NULL, NULL, &Nq, NULL, NULL));
47265f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGetDimension(fe, &Nb));
47273e9753d6SMatthew G. Knepley         blockSize = Nb;
47283e9753d6SMatthew G. Knepley         batchSize = numBlocks * blockSize;
47295f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
47303e9753d6SMatthew G. Knepley         numChunks = numCells / (numBatches*batchSize);
47313e9753d6SMatthew G. Knepley         Ne        = numChunks*numBatches*batchSize;
47323e9753d6SMatthew G. Knepley         Nr        = numCells % (numBatches*batchSize);
47333e9753d6SMatthew G. Knepley         offset    = numCells - Nr;
47343e9753d6SMatthew G. Knepley         /* Integrate FE residual to get elemVec (need fields at quadrature points) */
47353e9753d6SMatthew G. Knepley         /*   For FV, I think we use a P0 basis and the cell coefficients (for subdivided cells, we can tweak the basis tabulation to be the indicator function) */
47365f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGeomGetChunk(geom,0,offset,&chunkGeom));
47375f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEIntegrateResidual(ds, key, Ne, chunkGeom, u, u_t, dsAux, a, t, elemVec));
47385f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGeomGetChunk(geom,offset,numCells,&chunkGeom));
47395f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEIntegrateResidual(ds, key, Nr, chunkGeom, &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, dsAux, &a[offset*totDimAux], t, &elemVec[offset*totDim]));
47405f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGeomRestoreChunk(geom,offset,numCells,&chunkGeom));
47413e9753d6SMatthew G. Knepley       } else if (id == PETSCFV_CLASSID) {
47423e9753d6SMatthew G. Knepley         PetscFV fv = (PetscFV) obj;
47433e9753d6SMatthew G. Knepley 
47443e9753d6SMatthew G. Knepley         Ne = numFaces;
47453e9753d6SMatthew G. Knepley         /* Riemann solve over faces (need fields at face centroids) */
47463e9753d6SMatthew G. Knepley         /*   We need to evaluate FE fields at those coordinates */
47475f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFVIntegrateRHSFunction(fv, ds, f, Ne, fgeom, vol, uL, uR, fluxL, fluxR));
474898921bdaSJacob Faibussowitsch       } else SETERRQ(PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_WRONG, "Unknown discretization type for field %D", f);
47493e9753d6SMatthew G. Knepley     }
47503e9753d6SMatthew G. Knepley     /* Loop over domain */
47513e9753d6SMatthew G. Knepley     if (useFEM) {
47523e9753d6SMatthew G. Knepley       /* Add elemVec to locX */
47533e9753d6SMatthew G. Knepley       for (c = cS; c < cE; ++c) {
47543e9753d6SMatthew G. Knepley         const PetscInt cell = cells ? cells[c] : c;
47553e9753d6SMatthew G. Knepley         const PetscInt cind = c - cStart;
47563e9753d6SMatthew G. Knepley 
47575f80ce2aSJacob Faibussowitsch         if (mesh->printFEM > 1) CHKERRQ(DMPrintCellVector(cell, name, totDim, &elemVec[cind*totDim]));
47583e9753d6SMatthew G. Knepley         if (ghostLabel) {
47593e9753d6SMatthew G. Knepley           PetscInt ghostVal;
47603e9753d6SMatthew G. Knepley 
47615f80ce2aSJacob Faibussowitsch           CHKERRQ(DMLabelGetValue(ghostLabel,cell,&ghostVal));
47623e9753d6SMatthew G. Knepley           if (ghostVal > 0) continue;
47633e9753d6SMatthew G. Knepley         }
47645f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecSetClosure(dm, section, locF, cell, &elemVec[cind*totDim], ADD_ALL_VALUES));
47653e9753d6SMatthew G. Knepley       }
47663e9753d6SMatthew G. Knepley     }
47673e9753d6SMatthew G. Knepley     if (useFVM) {
47683e9753d6SMatthew G. Knepley       PetscScalar *fa;
47693e9753d6SMatthew G. Knepley       PetscInt     iface;
47703e9753d6SMatthew G. Knepley 
47715f80ce2aSJacob Faibussowitsch       CHKERRQ(VecGetArray(locF, &fa));
47723e9753d6SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
47733e9753d6SMatthew G. Knepley         PetscFV      fv;
47743e9753d6SMatthew G. Knepley         PetscObject  obj;
47753e9753d6SMatthew G. Knepley         PetscClassId id;
47763e9753d6SMatthew G. Knepley         PetscInt     foff, pdim;
47773e9753d6SMatthew G. Knepley 
47785f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDSGetDiscretization(ds, f, &obj));
47795f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDSGetFieldOffset(ds, f, &foff));
47805f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscObjectGetClassId(obj, &id));
47813e9753d6SMatthew G. Knepley         if (id != PETSCFV_CLASSID) continue;
47823e9753d6SMatthew G. Knepley         fv   = (PetscFV) obj;
47835f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFVGetNumComponents(fv, &pdim));
47843e9753d6SMatthew G. Knepley         /* Accumulate fluxes to cells */
47853e9753d6SMatthew G. Knepley         for (face = fS, iface = 0; face < fE; ++face) {
47863e9753d6SMatthew G. Knepley           const PetscInt *scells;
47873e9753d6SMatthew G. Knepley           PetscScalar    *fL = NULL, *fR = NULL;
47883e9753d6SMatthew G. Knepley           PetscInt        ghost, d, nsupp, nchild;
47893e9753d6SMatthew G. Knepley 
47905f80ce2aSJacob Faibussowitsch           CHKERRQ(DMLabelGetValue(ghostLabel, face, &ghost));
47915f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexGetSupportSize(dm, face, &nsupp));
47925f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexGetTreeChildren(dm, face, &nchild, NULL));
47933e9753d6SMatthew G. Knepley           if (ghost >= 0 || nsupp > 2 || nchild > 0) continue;
47945f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexGetSupport(dm, face, &scells));
47955f80ce2aSJacob Faibussowitsch           CHKERRQ(DMLabelGetValue(ghostLabel,scells[0],&ghost));
47965f80ce2aSJacob Faibussowitsch           if (ghost <= 0) CHKERRQ(DMPlexPointLocalFieldRef(dm, scells[0], f, fa, &fL));
47975f80ce2aSJacob Faibussowitsch           CHKERRQ(DMLabelGetValue(ghostLabel,scells[1],&ghost));
47985f80ce2aSJacob Faibussowitsch           if (ghost <= 0) CHKERRQ(DMPlexPointLocalFieldRef(dm, scells[1], f, fa, &fR));
47993e9753d6SMatthew G. Knepley           for (d = 0; d < pdim; ++d) {
48003e9753d6SMatthew G. Knepley             if (fL) fL[d] -= fluxL[iface*totDim+foff+d];
48013e9753d6SMatthew G. Knepley             if (fR) fR[d] += fluxR[iface*totDim+foff+d];
48023e9753d6SMatthew G. Knepley           }
48033e9753d6SMatthew G. Knepley           ++iface;
48043e9753d6SMatthew G. Knepley         }
48053e9753d6SMatthew G. Knepley       }
48065f80ce2aSJacob Faibussowitsch       CHKERRQ(VecRestoreArray(locF, &fa));
48073e9753d6SMatthew G. Knepley     }
48083e9753d6SMatthew G. Knepley     /* Handle time derivative */
48093e9753d6SMatthew G. Knepley     if (locX_t) {
48103e9753d6SMatthew G. Knepley       PetscScalar *x_t, *fa;
48113e9753d6SMatthew G. Knepley 
48125f80ce2aSJacob Faibussowitsch       CHKERRQ(VecGetArray(locF, &fa));
48135f80ce2aSJacob Faibussowitsch       CHKERRQ(VecGetArray(locX_t, &x_t));
48143e9753d6SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
48153e9753d6SMatthew G. Knepley         PetscFV      fv;
48163e9753d6SMatthew G. Knepley         PetscObject  obj;
48173e9753d6SMatthew G. Knepley         PetscClassId id;
48183e9753d6SMatthew G. Knepley         PetscInt     pdim, d;
48193e9753d6SMatthew G. Knepley 
48205f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDSGetDiscretization(ds, f, &obj));
48215f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscObjectGetClassId(obj, &id));
48223e9753d6SMatthew G. Knepley         if (id != PETSCFV_CLASSID) continue;
48233e9753d6SMatthew G. Knepley         fv   = (PetscFV) obj;
48245f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFVGetNumComponents(fv, &pdim));
48253e9753d6SMatthew G. Knepley         for (c = cS; c < cE; ++c) {
48263e9753d6SMatthew G. Knepley           const PetscInt cell = cells ? cells[c] : c;
48273e9753d6SMatthew G. Knepley           PetscScalar   *u_t, *r;
48283e9753d6SMatthew G. Knepley 
48293e9753d6SMatthew G. Knepley           if (ghostLabel) {
48303e9753d6SMatthew G. Knepley             PetscInt ghostVal;
48313e9753d6SMatthew G. Knepley 
48325f80ce2aSJacob Faibussowitsch             CHKERRQ(DMLabelGetValue(ghostLabel, cell, &ghostVal));
48333e9753d6SMatthew G. Knepley             if (ghostVal > 0) continue;
48343e9753d6SMatthew G. Knepley           }
48355f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexPointLocalFieldRead(dm, cell, f, x_t, &u_t));
48365f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexPointLocalFieldRef(dm, cell, f, fa, &r));
48373e9753d6SMatthew G. Knepley           for (d = 0; d < pdim; ++d) r[d] += u_t[d];
48383e9753d6SMatthew G. Knepley         }
48393e9753d6SMatthew G. Knepley       }
48405f80ce2aSJacob Faibussowitsch       CHKERRQ(VecRestoreArray(locX_t, &x_t));
48415f80ce2aSJacob Faibussowitsch       CHKERRQ(VecRestoreArray(locF, &fa));
48423e9753d6SMatthew G. Knepley     }
48433e9753d6SMatthew G. Knepley     if (useFEM) {
48445f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexRestoreCellFields(dm, chunkIS, locX, locX_t, locA, &u, &u_t, &a));
48455f80ce2aSJacob Faibussowitsch       CHKERRQ(DMRestoreWorkArray(dm, numCells*totDim, MPIU_SCALAR, &elemVec));
48463e9753d6SMatthew G. Knepley     }
48473e9753d6SMatthew G. Knepley     if (useFVM) {
48485f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexRestoreFaceFields(dm, fS, fE, locX, locX_t, faceGeometryFVM, cellGeometryFVM, locGrad, &numFaces, &uL, &uR));
48495f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexRestoreFaceGeometry(dm, fS, fE, faceGeometryFVM, cellGeometryFVM, &numFaces, &fgeom, &vol));
48505f80ce2aSJacob Faibussowitsch       CHKERRQ(DMRestoreWorkArray(dm, numFaces*totDim, MPIU_SCALAR, &fluxL));
48515f80ce2aSJacob Faibussowitsch       CHKERRQ(DMRestoreWorkArray(dm, numFaces*totDim, MPIU_SCALAR, &fluxR));
48525f80ce2aSJacob Faibussowitsch       if (dmGrad) CHKERRQ(DMRestoreLocalVector(dmGrad, &locGrad));
48533e9753d6SMatthew G. Knepley     }
48543e9753d6SMatthew G. Knepley   }
48555f80ce2aSJacob Faibussowitsch   if (useFEM) CHKERRQ(ISDestroy(&chunkIS));
48565f80ce2aSJacob Faibussowitsch   CHKERRQ(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
48573e9753d6SMatthew G. Knepley 
48583e9753d6SMatthew G. Knepley   if (useFEM) {
48595f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexComputeBdResidual_Internal(dm, locX, locX_t, t, locF, user));
48603e9753d6SMatthew G. Knepley 
48613e9753d6SMatthew G. Knepley     if (maxDegree <= 1) {
48625f80ce2aSJacob Faibussowitsch       CHKERRQ(DMSNESRestoreFEGeom(coordField,cellIS,affineQuad,PETSC_FALSE,&affineGeom));
48635f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscQuadratureDestroy(&affineQuad));
48643e9753d6SMatthew G. Knepley     } else {
48653e9753d6SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
48665f80ce2aSJacob Faibussowitsch         CHKERRQ(DMSNESRestoreFEGeom(coordField,cellIS,quads[f],PETSC_FALSE,&geoms[f]));
48675f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscQuadratureDestroy(&quads[f]));
48683e9753d6SMatthew G. Knepley       }
48695f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFree2(quads,geoms));
48703e9753d6SMatthew G. Knepley     }
48713e9753d6SMatthew G. Knepley   }
48723e9753d6SMatthew G. Knepley 
48733e9753d6SMatthew G. Knepley   /* FEM */
48743e9753d6SMatthew G. Knepley   /* 1: Get sizes from dm and dmAux */
48753e9753d6SMatthew G. Knepley   /* 2: Get geometric data */
48763e9753d6SMatthew G. Knepley   /* 3: Handle boundary values */
48773e9753d6SMatthew G. Knepley   /* 4: Loop over domain */
48783e9753d6SMatthew G. Knepley   /*   Extract coefficients */
48793e9753d6SMatthew G. Knepley   /* Loop over fields */
48803e9753d6SMatthew G. Knepley   /*   Set tiling for FE*/
48813e9753d6SMatthew G. Knepley   /*   Integrate FE residual to get elemVec */
48823e9753d6SMatthew G. Knepley   /*     Loop over subdomain */
48833e9753d6SMatthew G. Knepley   /*       Loop over quad points */
48843e9753d6SMatthew G. Knepley   /*         Transform coords to real space */
48853e9753d6SMatthew G. Knepley   /*         Evaluate field and aux fields at point */
48863e9753d6SMatthew G. Knepley   /*         Evaluate residual at point */
48873e9753d6SMatthew G. Knepley   /*         Transform residual to real space */
48883e9753d6SMatthew G. Knepley   /*       Add residual to elemVec */
48893e9753d6SMatthew G. Knepley   /* Loop over domain */
48903e9753d6SMatthew G. Knepley   /*   Add elemVec to locX */
48913e9753d6SMatthew G. Knepley 
48923e9753d6SMatthew G. Knepley   /* FVM */
48933e9753d6SMatthew G. Knepley   /* Get geometric data */
48943e9753d6SMatthew G. Knepley   /* If using gradients */
48953e9753d6SMatthew G. Knepley   /*   Compute gradient data */
48963e9753d6SMatthew G. Knepley   /*   Loop over domain faces */
48973e9753d6SMatthew G. Knepley   /*     Count computational faces */
48983e9753d6SMatthew G. Knepley   /*     Reconstruct cell gradient */
48993e9753d6SMatthew G. Knepley   /*   Loop over domain cells */
49003e9753d6SMatthew G. Knepley   /*     Limit cell gradients */
49013e9753d6SMatthew G. Knepley   /* Handle boundary values */
49023e9753d6SMatthew G. Knepley   /* Loop over domain faces */
49033e9753d6SMatthew G. Knepley   /*   Read out field, centroid, normal, volume for each side of face */
49043e9753d6SMatthew G. Knepley   /* Riemann solve over faces */
49053e9753d6SMatthew G. Knepley   /* Loop over domain faces */
49063e9753d6SMatthew G. Knepley   /*   Accumulate fluxes to cells */
49073e9753d6SMatthew G. Knepley   /* TODO Change printFEM to printDisc here */
49083e9753d6SMatthew G. Knepley   if (mesh->printFEM) {
49093e9753d6SMatthew G. Knepley     Vec         locFbc;
49103e9753d6SMatthew G. Knepley     PetscInt    pStart, pEnd, p, maxDof;
49113e9753d6SMatthew G. Knepley     PetscScalar *zeroes;
49123e9753d6SMatthew G. Knepley 
49135f80ce2aSJacob Faibussowitsch     CHKERRQ(VecDuplicate(locF,&locFbc));
49145f80ce2aSJacob Faibussowitsch     CHKERRQ(VecCopy(locF,locFbc));
49155f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscSectionGetChart(section,&pStart,&pEnd));
49165f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscSectionGetMaxDof(section,&maxDof));
49175f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscCalloc1(maxDof,&zeroes));
49183e9753d6SMatthew G. Knepley     for (p = pStart; p < pEnd; p++) {
49195f80ce2aSJacob Faibussowitsch       CHKERRQ(VecSetValuesSection(locFbc,section,p,zeroes,INSERT_BC_VALUES));
49203e9753d6SMatthew G. Knepley     }
49215f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFree(zeroes));
49225f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPrintLocalVec(dm, name, mesh->printTol, locFbc));
49235f80ce2aSJacob Faibussowitsch     CHKERRQ(VecDestroy(&locFbc));
49243e9753d6SMatthew G. Knepley   }
49255f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventEnd(DMPLEX_ResidualFEM,dm,0,0,0));
49263e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
49273e9753d6SMatthew G. Knepley }
49283e9753d6SMatthew G. Knepley 
49296528b96dSMatthew G. Knepley /*
49306528b96dSMatthew G. Knepley   1) Allow multiple kernels for BdResidual for hybrid DS
49316528b96dSMatthew G. Knepley 
49326528b96dSMatthew G. Knepley   DONE 2) Get out dsAux for either side at the same time as cohesive cell dsAux
49336528b96dSMatthew G. Knepley 
49346528b96dSMatthew G. Knepley   DONE 3) Change DMGetCellFields() to get different aux data a[] for each side
49356528b96dSMatthew G. Knepley      - I think I just need to replace a[] with the closure from each face
49366528b96dSMatthew G. Knepley 
49376528b96dSMatthew G. Knepley   4) Run both kernels for each non-hybrid field with correct dsAux, and then hybrid field as before
49386528b96dSMatthew G. Knepley */
493906ad1575SMatthew G. Knepley PetscErrorCode DMPlexComputeResidual_Hybrid_Internal(DM dm, PetscFormKey key[], IS cellIS, PetscReal time, Vec locX, Vec locX_t, PetscReal t, Vec locF, void *user)
49403e9753d6SMatthew G. Knepley {
49413e9753d6SMatthew G. Knepley   DM_Plex         *mesh       = (DM_Plex *) dm->data;
49423e9753d6SMatthew G. Knepley   const char      *name       = "Hybrid Residual";
494304c51a94SMatthew G. Knepley   DM               dmAux[3]   = {NULL, NULL, NULL};
49443e9753d6SMatthew G. Knepley   DMLabel          ghostLabel = NULL;
49456528b96dSMatthew G. Knepley   PetscDS          ds         = NULL;
49466528b96dSMatthew G. Knepley   PetscDS          dsAux[3]   = {NULL, NULL, NULL};
494704c51a94SMatthew G. Knepley   Vec              locA[3]    = {NULL, NULL, NULL};
49483e9753d6SMatthew G. Knepley   PetscSection     section    = NULL;
49493e9753d6SMatthew G. Knepley   DMField          coordField = NULL;
49506528b96dSMatthew G. Knepley   PetscScalar     *u = NULL, *u_t, *a[3];
49513e9753d6SMatthew G. Knepley   PetscScalar     *elemVec;
49523e9753d6SMatthew G. Knepley   IS               chunkIS;
49533e9753d6SMatthew G. Knepley   const PetscInt  *cells;
49543e9753d6SMatthew G. Knepley   PetscInt        *faces;
49553e9753d6SMatthew G. Knepley   PetscInt         cStart, cEnd, numCells;
49566528b96dSMatthew G. Knepley   PetscInt         Nf, f, totDim, totDimAux[3], numChunks, cellChunkSize, chunk;
49573e9753d6SMatthew G. Knepley   PetscInt         maxDegree = PETSC_MAX_INT;
49583e9753d6SMatthew G. Knepley   PetscQuadrature  affineQuad = NULL, *quads = NULL;
49593e9753d6SMatthew G. Knepley   PetscFEGeom     *affineGeom = NULL, **geoms = NULL;
49603e9753d6SMatthew G. Knepley 
49613e9753d6SMatthew G. Knepley   PetscFunctionBegin;
49625fedec97SMatthew G. Knepley   if ((key[0].label == key[1].label) && (key[0].value == key[1].value) && (key[0].part == key[1].part)) {
49635fedec97SMatthew G. Knepley     const char *name;
49645f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetName((PetscObject) key[0].label, &name));
496598921bdaSJacob Faibussowitsch     SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Form keys for each side of a cohesive surface must be different (%s, %D, %D)", name, key[0].value, key[0].part);
49665fedec97SMatthew G. Knepley   }
49675f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventBegin(DMPLEX_ResidualFEM,dm,0,0,0));
49683e9753d6SMatthew G. Knepley   /* TODO The places where we have to use isFE are probably the member functions for the PetscDisc class */
49693e9753d6SMatthew G. Knepley   /* FEM */
49705f80ce2aSJacob Faibussowitsch   CHKERRQ(ISGetLocalSize(cellIS, &numCells));
49715f80ce2aSJacob Faibussowitsch   CHKERRQ(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
49723e9753d6SMatthew G. Knepley   /* 1: Get sizes from dm and dmAux */
49735f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetSection(dm, &section));
49745f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLabel(dm, "ghost", &ghostLabel));
49755f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCellDS(dm, cStart, &ds));
49765f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetNumFields(ds, &Nf));
49775f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetTotalDimension(ds, &totDim));
49785f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetAuxiliaryVec(dm, key[2].label, key[2].value, key[2].part, &locA[2]));
497904c51a94SMatthew G. Knepley   if (locA[2]) {
49805f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetDM(locA[2], &dmAux[2]));
49815f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetCellDS(dmAux[2], cStart, &dsAux[2]));
49825f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetTotalDimension(dsAux[2], &totDimAux[2]));
49836528b96dSMatthew G. Knepley     {
49846528b96dSMatthew G. Knepley       const PetscInt *cone;
49856528b96dSMatthew G. Knepley       PetscInt        c;
49866528b96dSMatthew G. Knepley 
49875f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetCone(dm, cStart, &cone));
49886528b96dSMatthew G. Knepley       for (c = 0; c < 2; ++c) {
49896528b96dSMatthew G. Knepley         const PetscInt *support;
49906528b96dSMatthew G. Knepley         PetscInt ssize, s;
49916528b96dSMatthew G. Knepley 
49925f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexGetSupport(dm, cone[c], &support));
49935f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexGetSupportSize(dm, cone[c], &ssize));
49945f80ce2aSJacob Faibussowitsch         PetscCheck(ssize == 2,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Face %D from cell %D has support size %D != 2", cone[c], cStart, ssize);
49956528b96dSMatthew G. Knepley         if      (support[0] == cStart) s = 1;
49966528b96dSMatthew G. Knepley         else if (support[1] == cStart) s = 0;
499798921bdaSJacob Faibussowitsch         else SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Face %D does not have cell %D in its support", cone[c], cStart);
49985f80ce2aSJacob Faibussowitsch         CHKERRQ(DMGetAuxiliaryVec(dm, key[c].label, key[c].value, key[c].part, &locA[c]));
49995f80ce2aSJacob Faibussowitsch         if (locA[c]) CHKERRQ(VecGetDM(locA[c], &dmAux[c]));
500004c51a94SMatthew G. Knepley         else         {dmAux[c] = dmAux[2];}
50015f80ce2aSJacob Faibussowitsch         CHKERRQ(DMGetCellDS(dmAux[c], support[s], &dsAux[c]));
50025f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDSGetTotalDimension(dsAux[c], &totDimAux[c]));
50036528b96dSMatthew G. Knepley       }
50046528b96dSMatthew G. Knepley     }
50053e9753d6SMatthew G. Knepley   }
50063e9753d6SMatthew G. Knepley   /* 2: Setup geometric data */
50075f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateField(dm, &coordField));
50085f80ce2aSJacob Faibussowitsch   CHKERRQ(DMFieldGetDegree(coordField, cellIS, NULL, &maxDegree));
50093e9753d6SMatthew G. Knepley   if (maxDegree > 1) {
50105f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscCalloc2(Nf, &quads, Nf, &geoms));
50113e9753d6SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
50123e9753d6SMatthew G. Knepley       PetscFE fe;
50133e9753d6SMatthew G. Knepley 
50145f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetDiscretization(ds, f, (PetscObject *) &fe));
50153e9753d6SMatthew G. Knepley       if (fe) {
50165f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGetQuadrature(fe, &quads[f]));
50175f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscObjectReference((PetscObject) quads[f]));
50183e9753d6SMatthew G. Knepley       }
50193e9753d6SMatthew G. Knepley     }
50203e9753d6SMatthew G. Knepley   }
50213e9753d6SMatthew G. Knepley   /* Loop over chunks */
50223e9753d6SMatthew G. Knepley   cellChunkSize = numCells;
50233e9753d6SMatthew G. Knepley   numChunks     = !numCells ? 0 : PetscCeilReal(((PetscReal) numCells)/cellChunkSize);
50245f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscCalloc1(2*cellChunkSize, &faces));
50255f80ce2aSJacob Faibussowitsch   CHKERRQ(ISCreateGeneral(PETSC_COMM_SELF, cellChunkSize, faces, PETSC_USE_POINTER, &chunkIS));
50263e9753d6SMatthew G. Knepley   /* Extract field coefficients */
50273e9753d6SMatthew G. Knepley   /* NOTE This needs the end cap faces to have identical orientations */
50285f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetCellFields(dm, cellIS, locX, locX_t, locA[2], &u, &u_t, &a[2]));
50295f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetHybridAuxFields(dm, dmAux, dsAux, cellIS, locA, a));
50305f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetWorkArray(dm, cellChunkSize*totDim, MPIU_SCALAR, &elemVec));
50313e9753d6SMatthew G. Knepley   for (chunk = 0; chunk < numChunks; ++chunk) {
50323e9753d6SMatthew G. Knepley     PetscInt cS = cStart+chunk*cellChunkSize, cE = PetscMin(cS+cellChunkSize, cEnd), numCells = cE - cS, c;
50333e9753d6SMatthew G. Knepley 
50345f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscMemzero(elemVec, cellChunkSize*totDim * sizeof(PetscScalar)));
50353e9753d6SMatthew G. Knepley     /* Get faces */
50363e9753d6SMatthew G. Knepley     for (c = cS; c < cE; ++c) {
50373e9753d6SMatthew G. Knepley       const PetscInt  cell = cells ? cells[c] : c;
50383e9753d6SMatthew G. Knepley       const PetscInt *cone;
50395f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetCone(dm, cell, &cone));
50403e9753d6SMatthew G. Knepley       faces[(c-cS)*2+0] = cone[0];
50413e9753d6SMatthew G. Knepley       faces[(c-cS)*2+1] = cone[1];
50423e9753d6SMatthew G. Knepley     }
50435f80ce2aSJacob Faibussowitsch     CHKERRQ(ISGeneralSetIndices(chunkIS, cellChunkSize, faces, PETSC_USE_POINTER));
50443e9753d6SMatthew G. Knepley     /* Get geometric data */
50453e9753d6SMatthew G. Knepley     if (maxDegree <= 1) {
50465f80ce2aSJacob Faibussowitsch       if (!affineQuad) CHKERRQ(DMFieldCreateDefaultQuadrature(coordField, chunkIS, &affineQuad));
50475f80ce2aSJacob Faibussowitsch       if (affineQuad)  CHKERRQ(DMSNESGetFEGeom(coordField, chunkIS, affineQuad, PETSC_TRUE, &affineGeom));
50483e9753d6SMatthew G. Knepley     } else {
50493e9753d6SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
50505f80ce2aSJacob Faibussowitsch         if (quads[f]) CHKERRQ(DMSNESGetFEGeom(coordField, chunkIS, quads[f], PETSC_TRUE, &geoms[f]));
50513e9753d6SMatthew G. Knepley       }
50523e9753d6SMatthew G. Knepley     }
50533e9753d6SMatthew G. Knepley     /* Loop over fields */
50543e9753d6SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
50553e9753d6SMatthew G. Knepley       PetscFE         fe;
50563e9753d6SMatthew G. Knepley       PetscFEGeom    *geom = affineGeom ? affineGeom : geoms[f];
5057148442b3SMatthew G. Knepley       PetscFEGeom    *chunkGeom = NULL, *remGeom = NULL;
50583e9753d6SMatthew G. Knepley       PetscQuadrature quad = affineQuad ? affineQuad : quads[f];
50593e9753d6SMatthew G. Knepley       PetscInt        numChunks, numBatches, batchSize, numBlocks, blockSize, Ne, Nr, offset, Nq, Nb;
50605fedec97SMatthew G. Knepley       PetscBool       isCohesiveField;
50613e9753d6SMatthew G. Knepley 
50625f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetDiscretization(ds, f, (PetscObject *) &fe));
50633e9753d6SMatthew G. Knepley       if (!fe) continue;
50645f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
50655f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscQuadratureGetData(quad, NULL, NULL, &Nq, NULL, NULL));
50665f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetDimension(fe, &Nb));
50673e9753d6SMatthew G. Knepley       blockSize = Nb;
50683e9753d6SMatthew G. Knepley       batchSize = numBlocks * blockSize;
50695f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
50703e9753d6SMatthew G. Knepley       numChunks = numCells / (numBatches*batchSize);
50713e9753d6SMatthew G. Knepley       Ne        = numChunks*numBatches*batchSize;
50723e9753d6SMatthew G. Knepley       Nr        = numCells % (numBatches*batchSize);
50733e9753d6SMatthew G. Knepley       offset    = numCells - Nr;
50745f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomGetChunk(geom,0,offset,&chunkGeom));
50755f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomGetChunk(geom,offset,numCells,&remGeom));
50765f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetCohesive(ds, f, &isCohesiveField));
50775fedec97SMatthew G. Knepley       chunkGeom->isCohesive = remGeom->isCohesive = PETSC_TRUE;
50786528b96dSMatthew G. Knepley       key[0].field = f;
50796528b96dSMatthew G. Knepley       key[1].field = f;
50805fedec97SMatthew G. Knepley       key[2].field = f;
50815f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEIntegrateHybridResidual(ds, key[0], 0, Ne, chunkGeom, u, u_t, dsAux[0], a[0], t, elemVec));
50825f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEIntegrateHybridResidual(ds, key[0], 0, Nr, remGeom,  &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, dsAux[0], &a[0][offset*totDimAux[0]], t, &elemVec[offset*totDim]));
50835f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEIntegrateHybridResidual(ds, key[1], 1, Ne, chunkGeom, u, u_t, dsAux[1], a[1], t, elemVec));
50845f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEIntegrateHybridResidual(ds, key[1], 1, Nr, remGeom,  &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, dsAux[1], &a[1][offset*totDimAux[1]], t, &elemVec[offset*totDim]));
50855f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEIntegrateHybridResidual(ds, key[2], 2, Ne, chunkGeom, u, u_t, dsAux[2], a[2], t, elemVec));
50865f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEIntegrateHybridResidual(ds, key[2], 2, Nr, remGeom,  &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, dsAux[2], &a[2][offset*totDimAux[2]], t, &elemVec[offset*totDim]));
50875f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomRestoreChunk(geom,offset,numCells,&remGeom));
50885f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomRestoreChunk(geom,0,offset,&chunkGeom));
50893e9753d6SMatthew G. Knepley     }
50903e9753d6SMatthew G. Knepley     /* Add elemVec to locX */
50913e9753d6SMatthew G. Knepley     for (c = cS; c < cE; ++c) {
50923e9753d6SMatthew G. Knepley       const PetscInt cell = cells ? cells[c] : c;
50933e9753d6SMatthew G. Knepley       const PetscInt cind = c - cStart;
50943e9753d6SMatthew G. Knepley 
50955f80ce2aSJacob Faibussowitsch       if (mesh->printFEM > 1) CHKERRQ(DMPrintCellVector(cell, name, totDim, &elemVec[cind*totDim]));
50963e9753d6SMatthew G. Knepley       if (ghostLabel) {
50973e9753d6SMatthew G. Knepley         PetscInt ghostVal;
50983e9753d6SMatthew G. Knepley 
50995f80ce2aSJacob Faibussowitsch         CHKERRQ(DMLabelGetValue(ghostLabel,cell,&ghostVal));
51003e9753d6SMatthew G. Knepley         if (ghostVal > 0) continue;
51013e9753d6SMatthew G. Knepley       }
51025f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecSetClosure(dm, section, locF, cell, &elemVec[cind*totDim], ADD_ALL_VALUES));
51033e9753d6SMatthew G. Knepley     }
51043e9753d6SMatthew G. Knepley   }
51055f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexRestoreCellFields(dm, cellIS, locX, locX_t, locA[2], &u, &u_t, &a[2]));
51065f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexRestoreHybridAuxFields(dmAux, dsAux, cellIS, locA, a));
51075f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreWorkArray(dm, numCells*totDim, MPIU_SCALAR, &elemVec));
51085f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree(faces));
51095f80ce2aSJacob Faibussowitsch   CHKERRQ(ISDestroy(&chunkIS));
51105f80ce2aSJacob Faibussowitsch   CHKERRQ(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
51113e9753d6SMatthew G. Knepley   if (maxDegree <= 1) {
51125f80ce2aSJacob Faibussowitsch     CHKERRQ(DMSNESRestoreFEGeom(coordField,cellIS,affineQuad,PETSC_FALSE,&affineGeom));
51135f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscQuadratureDestroy(&affineQuad));
51143e9753d6SMatthew G. Knepley   } else {
51153e9753d6SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
51165f80ce2aSJacob Faibussowitsch       if (geoms) CHKERRQ(DMSNESRestoreFEGeom(coordField,cellIS,quads[f],PETSC_FALSE,&geoms[f]));
51175f80ce2aSJacob Faibussowitsch       if (quads) CHKERRQ(PetscQuadratureDestroy(&quads[f]));
51183e9753d6SMatthew G. Knepley     }
51195f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFree2(quads,geoms));
51203e9753d6SMatthew G. Knepley   }
51215f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventEnd(DMPLEX_ResidualFEM,dm,0,0,0));
51223e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
51233e9753d6SMatthew G. Knepley }
51243e9753d6SMatthew G. Knepley 
512545480ffeSMatthew G. Knepley PetscErrorCode DMPlexComputeBdJacobian_Single_Internal(DM dm, PetscReal t, PetscWeakForm wf, DMLabel label, PetscInt numValues, const PetscInt values[], PetscInt fieldI, Vec locX, Vec locX_t, PetscReal X_tShift, Mat Jac, Mat JacP, DMField coordField, IS facetIS)
51263e9753d6SMatthew G. Knepley {
51273e9753d6SMatthew G. Knepley   DM_Plex        *mesh = (DM_Plex *) dm->data;
51283e9753d6SMatthew G. Knepley   DM              plex = NULL, plexA = NULL, tdm;
51293e9753d6SMatthew G. Knepley   DMEnclosureType encAux;
51303e9753d6SMatthew G. Knepley   PetscDS         prob, probAux = NULL;
51313e9753d6SMatthew G. Knepley   PetscSection    section, sectionAux = NULL;
5132e432b41dSStefano Zampini   PetscSection    globalSection;
51333e9753d6SMatthew G. Knepley   Vec             locA = NULL, tv;
51343e9753d6SMatthew G. Knepley   PetscScalar    *u = NULL, *u_t = NULL, *a = NULL, *elemMat = NULL;
51353e9753d6SMatthew G. Knepley   PetscInt        v;
51363e9753d6SMatthew G. Knepley   PetscInt        Nf, totDim, totDimAux = 0;
5137e432b41dSStefano Zampini   PetscBool       transform;
51383e9753d6SMatthew G. Knepley 
51393e9753d6SMatthew G. Knepley   PetscFunctionBegin;
51405f80ce2aSJacob Faibussowitsch   CHKERRQ(DMConvert(dm, DMPLEX, &plex));
51415f80ce2aSJacob Faibussowitsch   CHKERRQ(DMHasBasisTransform(dm, &transform));
51425f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetBasisTransformDM_Internal(dm, &tdm));
51435f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetBasisTransformVec_Internal(dm, &tv));
51445f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &section));
51455f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDS(dm, &prob));
51465f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetNumFields(prob, &Nf));
51475f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetTotalDimension(prob, &totDim));
51485f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetAuxiliaryVec(dm, label, values[0], 0, &locA));
51493e9753d6SMatthew G. Knepley   if (locA) {
51503e9753d6SMatthew G. Knepley     DM dmAux;
51513e9753d6SMatthew G. Knepley 
51525f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetDM(locA, &dmAux));
51535f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetEnclosureRelation(dmAux, dm, &encAux));
51545f80ce2aSJacob Faibussowitsch     CHKERRQ(DMConvert(dmAux, DMPLEX, &plexA));
51555f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetDS(plexA, &probAux));
51565f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetTotalDimension(probAux, &totDimAux));
51575f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetLocalSection(plexA, &sectionAux));
51583e9753d6SMatthew G. Knepley   }
51593e9753d6SMatthew G. Knepley 
51605f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetGlobalSection(dm, &globalSection));
51613e9753d6SMatthew G. Knepley   for (v = 0; v < numValues; ++v) {
51623e9753d6SMatthew G. Knepley     PetscFEGeom     *fgeom;
51633e9753d6SMatthew G. Knepley     PetscInt         maxDegree;
51643e9753d6SMatthew G. Knepley     PetscQuadrature  qGeom = NULL;
51653e9753d6SMatthew G. Knepley     IS               pointIS;
51663e9753d6SMatthew G. Knepley     const PetscInt  *points;
516706ad1575SMatthew G. Knepley     PetscFormKey key;
51683e9753d6SMatthew G. Knepley     PetscInt         numFaces, face, Nq;
51693e9753d6SMatthew G. Knepley 
517045480ffeSMatthew G. Knepley     key.label = label;
517145480ffeSMatthew G. Knepley     key.value = values[v];
517206ad1575SMatthew G. Knepley     key.part  = 0;
51735f80ce2aSJacob Faibussowitsch     CHKERRQ(DMLabelGetStratumIS(label, values[v], &pointIS));
51743e9753d6SMatthew G. Knepley     if (!pointIS) continue; /* No points with that id on this process */
51753e9753d6SMatthew G. Knepley     {
51763e9753d6SMatthew G. Knepley       IS isectIS;
51773e9753d6SMatthew G. Knepley 
51783e9753d6SMatthew G. Knepley       /* TODO: Special cases of ISIntersect where it is quick to check a prior if one is a superset of the other */
51795f80ce2aSJacob Faibussowitsch       CHKERRQ(ISIntersect_Caching_Internal(facetIS,pointIS,&isectIS));
51805f80ce2aSJacob Faibussowitsch       CHKERRQ(ISDestroy(&pointIS));
51813e9753d6SMatthew G. Knepley       pointIS = isectIS;
51823e9753d6SMatthew G. Knepley     }
51835f80ce2aSJacob Faibussowitsch     CHKERRQ(ISGetLocalSize(pointIS, &numFaces));
51845f80ce2aSJacob Faibussowitsch     CHKERRQ(ISGetIndices(pointIS, &points));
51855f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscMalloc4(numFaces*totDim, &u, locX_t ? numFaces*totDim : 0, &u_t, numFaces*totDim*totDim, &elemMat, locA ? numFaces*totDimAux : 0, &a));
51865f80ce2aSJacob Faibussowitsch     CHKERRQ(DMFieldGetDegree(coordField,pointIS,NULL,&maxDegree));
51873e9753d6SMatthew G. Knepley     if (maxDegree <= 1) {
51885f80ce2aSJacob Faibussowitsch       CHKERRQ(DMFieldCreateDefaultQuadrature(coordField,pointIS,&qGeom));
51893e9753d6SMatthew G. Knepley     }
51903e9753d6SMatthew G. Knepley     if (!qGeom) {
51913e9753d6SMatthew G. Knepley       PetscFE fe;
51923e9753d6SMatthew G. Knepley 
51935f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetDiscretization(prob, fieldI, (PetscObject *) &fe));
51945f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetFaceQuadrature(fe, &qGeom));
51955f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscObjectReference((PetscObject)qGeom));
51963e9753d6SMatthew G. Knepley     }
51975f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscQuadratureGetData(qGeom, NULL, NULL, &Nq, NULL, NULL));
51985f80ce2aSJacob Faibussowitsch     CHKERRQ(DMSNESGetFEGeom(coordField,pointIS,qGeom,PETSC_TRUE,&fgeom));
51993e9753d6SMatthew G. Knepley     for (face = 0; face < numFaces; ++face) {
5200f15274beSMatthew Knepley       const PetscInt point = points[face], *support;
52013e9753d6SMatthew G. Knepley       PetscScalar   *x     = NULL;
5202f15274beSMatthew Knepley       PetscInt       i;
52033e9753d6SMatthew G. Knepley 
52045f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetSupport(dm, point, &support));
52055f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecGetClosure(plex, section, locX, support[0], NULL, &x));
52063e9753d6SMatthew G. Knepley       for (i = 0; i < totDim; ++i) u[face*totDim+i] = x[i];
52075f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecRestoreClosure(plex, section, locX, support[0], NULL, &x));
52083e9753d6SMatthew G. Knepley       if (locX_t) {
52095f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecGetClosure(plex, section, locX_t, support[0], NULL, &x));
52103e9753d6SMatthew G. Knepley         for (i = 0; i < totDim; ++i) u_t[face*totDim+i] = x[i];
52115f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecRestoreClosure(plex, section, locX_t, support[0], NULL, &x));
52123e9753d6SMatthew G. Knepley       }
52133e9753d6SMatthew G. Knepley       if (locA) {
52143e9753d6SMatthew G. Knepley         PetscInt subp;
52155f80ce2aSJacob Faibussowitsch         CHKERRQ(DMGetEnclosurePoint(plexA, dm, encAux, support[0], &subp));
52165f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecGetClosure(plexA, sectionAux, locA, subp, NULL, &x));
52173e9753d6SMatthew G. Knepley         for (i = 0; i < totDimAux; ++i) a[face*totDimAux+i] = x[i];
52185f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexVecRestoreClosure(plexA, sectionAux, locA, subp, NULL, &x));
52193e9753d6SMatthew G. Knepley       }
52203e9753d6SMatthew G. Knepley     }
52215f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscArrayzero(elemMat, numFaces*totDim*totDim));
52223e9753d6SMatthew G. Knepley     {
52233e9753d6SMatthew G. Knepley       PetscFE         fe;
52243e9753d6SMatthew G. Knepley       PetscInt        Nb;
52253e9753d6SMatthew G. Knepley       /* Conforming batches */
52263e9753d6SMatthew G. Knepley       PetscInt        numChunks, numBatches, numBlocks, Ne, blockSize, batchSize;
52273e9753d6SMatthew G. Knepley       /* Remainder */
52283e9753d6SMatthew G. Knepley       PetscFEGeom    *chunkGeom = NULL;
52293e9753d6SMatthew G. Knepley       PetscInt        fieldJ, Nr, offset;
52303e9753d6SMatthew G. Knepley 
52315f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetDiscretization(prob, fieldI, (PetscObject *) &fe));
52325f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetDimension(fe, &Nb));
52335f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
52343e9753d6SMatthew G. Knepley       blockSize = Nb;
52353e9753d6SMatthew G. Knepley       batchSize = numBlocks * blockSize;
52365f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
52373e9753d6SMatthew G. Knepley       numChunks = numFaces / (numBatches*batchSize);
52383e9753d6SMatthew G. Knepley       Ne        = numChunks*numBatches*batchSize;
52393e9753d6SMatthew G. Knepley       Nr        = numFaces % (numBatches*batchSize);
52403e9753d6SMatthew G. Knepley       offset    = numFaces - Nr;
52415f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomGetChunk(fgeom,0,offset,&chunkGeom));
52423e9753d6SMatthew G. Knepley       for (fieldJ = 0; fieldJ < Nf; ++fieldJ) {
524345480ffeSMatthew G. Knepley         key.field = fieldI*Nf+fieldJ;
52445f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEIntegrateBdJacobian(prob, wf, key, Ne, chunkGeom, u, u_t, probAux, a, t, X_tShift, elemMat));
52453e9753d6SMatthew G. Knepley       }
52465f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomGetChunk(fgeom,offset,numFaces,&chunkGeom));
52473e9753d6SMatthew G. Knepley       for (fieldJ = 0; fieldJ < Nf; ++fieldJ) {
524845480ffeSMatthew G. Knepley         key.field = fieldI*Nf+fieldJ;
52495f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEIntegrateBdJacobian(prob, wf, key, Nr, chunkGeom, &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, probAux, a ? &a[offset*totDimAux] : NULL, t, X_tShift, &elemMat[offset*totDim*totDim]));
52503e9753d6SMatthew G. Knepley       }
52515f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomRestoreChunk(fgeom,offset,numFaces,&chunkGeom));
52523e9753d6SMatthew G. Knepley     }
52533e9753d6SMatthew G. Knepley     for (face = 0; face < numFaces; ++face) {
52543e9753d6SMatthew G. Knepley       const PetscInt point = points[face], *support;
52553e9753d6SMatthew G. Knepley 
52563e9753d6SMatthew G. Knepley       /* Transform to global basis before insertion in Jacobian */
52575f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetSupport(plex, point, &support));
52585f80ce2aSJacob Faibussowitsch       if (transform) CHKERRQ(DMPlexBasisTransformPointTensor_Internal(dm, tdm, tv, support[0], PETSC_TRUE, totDim, &elemMat[face*totDim*totDim]));
52595f80ce2aSJacob Faibussowitsch       if (mesh->printFEM > 1) CHKERRQ(DMPrintCellMatrix(point, "BdJacobian", totDim, totDim, &elemMat[face*totDim*totDim]));
52605f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexMatSetClosure(plex, section, globalSection, JacP, support[0], &elemMat[face*totDim*totDim], ADD_VALUES));
52613e9753d6SMatthew G. Knepley     }
52625f80ce2aSJacob Faibussowitsch     CHKERRQ(DMSNESRestoreFEGeom(coordField,pointIS,qGeom,PETSC_TRUE,&fgeom));
52635f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscQuadratureDestroy(&qGeom));
52645f80ce2aSJacob Faibussowitsch     CHKERRQ(ISRestoreIndices(pointIS, &points));
52655f80ce2aSJacob Faibussowitsch     CHKERRQ(ISDestroy(&pointIS));
52665f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFree4(u, u_t, elemMat, a));
52673e9753d6SMatthew G. Knepley   }
52685f80ce2aSJacob Faibussowitsch   if (plex)  CHKERRQ(DMDestroy(&plex));
52695f80ce2aSJacob Faibussowitsch   if (plexA) CHKERRQ(DMDestroy(&plexA));
52703e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
52713e9753d6SMatthew G. Knepley }
52723e9753d6SMatthew G. Knepley 
527345480ffeSMatthew G. Knepley PetscErrorCode DMPlexComputeBdJacobianSingle(DM dm, PetscReal t, PetscWeakForm wf, DMLabel label, PetscInt numValues, const PetscInt values[], PetscInt field, Vec locX, Vec locX_t, PetscReal X_tShift, Mat Jac, Mat JacP)
52743e9753d6SMatthew G. Knepley {
52753e9753d6SMatthew G. Knepley   DMField        coordField;
52763e9753d6SMatthew G. Knepley   DMLabel        depthLabel;
52773e9753d6SMatthew G. Knepley   IS             facetIS;
52783e9753d6SMatthew G. Knepley   PetscInt       dim;
52793e9753d6SMatthew G. Knepley 
52803e9753d6SMatthew G. Knepley   PetscFunctionBegin;
52815f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dm, &dim));
52825f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetDepthLabel(dm, &depthLabel));
52835f80ce2aSJacob Faibussowitsch   CHKERRQ(DMLabelGetStratumIS(depthLabel, dim-1, &facetIS));
52845f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateField(dm, &coordField));
52855f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexComputeBdJacobian_Single_Internal(dm, t, wf, label, numValues, values, field, locX, locX_t, X_tShift, Jac, JacP, coordField, facetIS));
52865f80ce2aSJacob Faibussowitsch   CHKERRQ(ISDestroy(&facetIS));
52873e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
52883e9753d6SMatthew G. Knepley }
52893e9753d6SMatthew G. Knepley 
52903e9753d6SMatthew G. Knepley PetscErrorCode DMPlexComputeBdJacobian_Internal(DM dm, Vec locX, Vec locX_t, PetscReal t, PetscReal X_tShift, Mat Jac, Mat JacP, void *user)
52913e9753d6SMatthew G. Knepley {
52923e9753d6SMatthew G. Knepley   PetscDS          prob;
52933e9753d6SMatthew G. Knepley   PetscInt         dim, numBd, bd;
52943e9753d6SMatthew G. Knepley   DMLabel          depthLabel;
52953e9753d6SMatthew G. Knepley   DMField          coordField = NULL;
52963e9753d6SMatthew G. Knepley   IS               facetIS;
52973e9753d6SMatthew G. Knepley 
52983e9753d6SMatthew G. Knepley   PetscFunctionBegin;
52995f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDS(dm, &prob));
53005f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetDepthLabel(dm, &depthLabel));
53015f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetDimension(dm, &dim));
53025f80ce2aSJacob Faibussowitsch   CHKERRQ(DMLabelGetStratumIS(depthLabel, dim-1, &facetIS));
53035f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetNumBoundary(prob, &numBd));
53045f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateField(dm, &coordField));
53053e9753d6SMatthew G. Knepley   for (bd = 0; bd < numBd; ++bd) {
530645480ffeSMatthew G. Knepley     PetscWeakForm           wf;
53073e9753d6SMatthew G. Knepley     DMBoundaryConditionType type;
53083e9753d6SMatthew G. Knepley     DMLabel                 label;
53093e9753d6SMatthew G. Knepley     const PetscInt         *values;
53103e9753d6SMatthew G. Knepley     PetscInt                fieldI, numValues;
53113e9753d6SMatthew G. Knepley     PetscObject             obj;
53123e9753d6SMatthew G. Knepley     PetscClassId            id;
53133e9753d6SMatthew G. Knepley 
53145f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetBoundary(prob, bd, &wf, &type, NULL, &label, &numValues, &values, &fieldI, NULL, NULL, NULL, NULL, NULL));
53155f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, fieldI, &obj));
53165f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId(obj, &id));
53173e9753d6SMatthew G. Knepley     if ((id != PETSCFE_CLASSID) || (type & DM_BC_ESSENTIAL)) continue;
53185f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexComputeBdJacobian_Single_Internal(dm, t, wf, label, numValues, values, fieldI, locX, locX_t, X_tShift, Jac, JacP, coordField, facetIS));
53193e9753d6SMatthew G. Knepley   }
53205f80ce2aSJacob Faibussowitsch   CHKERRQ(ISDestroy(&facetIS));
53213e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
53223e9753d6SMatthew G. Knepley }
53233e9753d6SMatthew G. Knepley 
532406ad1575SMatthew G. Knepley PetscErrorCode DMPlexComputeJacobian_Internal(DM dm, PetscFormKey key, IS cellIS, PetscReal t, PetscReal X_tShift, Vec X, Vec X_t, Mat Jac, Mat JacP,void *user)
53253e9753d6SMatthew G. Knepley {
53263e9753d6SMatthew G. Knepley   DM_Plex        *mesh  = (DM_Plex *) dm->data;
53273e9753d6SMatthew G. Knepley   const char     *name  = "Jacobian";
53289a2a23afSMatthew G. Knepley   DM              dmAux = NULL, plex, tdm;
53293e9753d6SMatthew G. Knepley   DMEnclosureType encAux;
53303e9753d6SMatthew G. Knepley   Vec             A, tv;
53313e9753d6SMatthew G. Knepley   DMField         coordField;
53323e9753d6SMatthew G. Knepley   PetscDS         prob, probAux = NULL;
5333e432b41dSStefano Zampini   PetscSection    section, globalSection, sectionAux;
53343e9753d6SMatthew G. Knepley   PetscScalar    *elemMat, *elemMatP, *elemMatD, *u, *u_t, *a = NULL;
53353e9753d6SMatthew G. Knepley   const PetscInt *cells;
53363e9753d6SMatthew G. Knepley   PetscInt        Nf, fieldI, fieldJ;
53373e9753d6SMatthew G. Knepley   PetscInt        totDim, totDimAux, cStart, cEnd, numCells, c;
5338e432b41dSStefano Zampini   PetscBool       hasJac, hasPrec, hasDyn, hasFV = PETSC_FALSE, transform;
53393e9753d6SMatthew G. Knepley 
53403e9753d6SMatthew G. Knepley   PetscFunctionBegin;
53415f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventBegin(DMPLEX_JacobianFEM,dm,0,0,0));
53425f80ce2aSJacob Faibussowitsch   CHKERRQ(ISGetLocalSize(cellIS, &numCells));
53435f80ce2aSJacob Faibussowitsch   CHKERRQ(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
53445f80ce2aSJacob Faibussowitsch   CHKERRQ(DMHasBasisTransform(dm, &transform));
53455f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetBasisTransformDM_Internal(dm, &tdm));
53465f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetBasisTransformVec_Internal(dm, &tv));
53475f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &section));
53485f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetGlobalSection(dm, &globalSection));
53495f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCellDS(dm, cells ? cells[cStart] : cStart, &prob));
53505f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetNumFields(prob, &Nf));
53515f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetTotalDimension(prob, &totDim));
53525f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSHasJacobian(prob, &hasJac));
53535f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSHasJacobianPreconditioner(prob, &hasPrec));
53543e9753d6SMatthew G. Knepley   /* user passed in the same matrix, avoid double contributions and
53553e9753d6SMatthew G. Knepley      only assemble the Jacobian */
53563e9753d6SMatthew G. Knepley   if (hasJac && Jac == JacP) hasPrec = PETSC_FALSE;
53575f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSHasDynamicJacobian(prob, &hasDyn));
53583e9753d6SMatthew G. Knepley   hasDyn = hasDyn && (X_tShift != 0.0) ? PETSC_TRUE : PETSC_FALSE;
53595f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetAuxiliaryVec(dm, key.label, key.value, key.part, &A));
53609a2a23afSMatthew G. Knepley   if (A) {
53615f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetDM(A, &dmAux));
53625f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetEnclosureRelation(dmAux, dm, &encAux));
53635f80ce2aSJacob Faibussowitsch     CHKERRQ(DMConvert(dmAux, DMPLEX, &plex));
53645f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetLocalSection(plex, &sectionAux));
53655f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetDS(dmAux, &probAux));
53665f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetTotalDimension(probAux, &totDimAux));
53673e9753d6SMatthew G. Knepley   }
53685f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc5(numCells*totDim,&u,X_t ? numCells*totDim : 0,&u_t,hasJac ? numCells*totDim*totDim : 0,&elemMat,hasPrec ? numCells*totDim*totDim : 0, &elemMatP,hasDyn ? numCells*totDim*totDim : 0, &elemMatD));
53695f80ce2aSJacob Faibussowitsch   if (dmAux) CHKERRQ(PetscMalloc1(numCells*totDimAux, &a));
53705f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateField(dm, &coordField));
53713e9753d6SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
53723e9753d6SMatthew G. Knepley     const PetscInt cell = cells ? cells[c] : c;
53733e9753d6SMatthew G. Knepley     const PetscInt cind = c - cStart;
53743e9753d6SMatthew G. Knepley     PetscScalar   *x = NULL,  *x_t = NULL;
53753e9753d6SMatthew G. Knepley     PetscInt       i;
53763e9753d6SMatthew G. Knepley 
53775f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecGetClosure(dm, section, X, cell, NULL, &x));
53783e9753d6SMatthew G. Knepley     for (i = 0; i < totDim; ++i) u[cind*totDim+i] = x[i];
53795f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecRestoreClosure(dm, section, X, cell, NULL, &x));
53803e9753d6SMatthew G. Knepley     if (X_t) {
53815f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecGetClosure(dm, section, X_t, cell, NULL, &x_t));
53823e9753d6SMatthew G. Knepley       for (i = 0; i < totDim; ++i) u_t[cind*totDim+i] = x_t[i];
53835f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecRestoreClosure(dm, section, X_t, cell, NULL, &x_t));
53843e9753d6SMatthew G. Knepley     }
53853e9753d6SMatthew G. Knepley     if (dmAux) {
53863e9753d6SMatthew G. Knepley       PetscInt subcell;
53875f80ce2aSJacob Faibussowitsch       CHKERRQ(DMGetEnclosurePoint(dmAux, dm, encAux, cell, &subcell));
53885f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecGetClosure(plex, sectionAux, A, subcell, NULL, &x));
53893e9753d6SMatthew G. Knepley       for (i = 0; i < totDimAux; ++i) a[cind*totDimAux+i] = x[i];
53905f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecRestoreClosure(plex, sectionAux, A, subcell, NULL, &x));
53913e9753d6SMatthew G. Knepley     }
53923e9753d6SMatthew G. Knepley   }
53935f80ce2aSJacob Faibussowitsch   if (hasJac)  CHKERRQ(PetscArrayzero(elemMat,  numCells*totDim*totDim));
53945f80ce2aSJacob Faibussowitsch   if (hasPrec) CHKERRQ(PetscArrayzero(elemMatP, numCells*totDim*totDim));
53955f80ce2aSJacob Faibussowitsch   if (hasDyn)  CHKERRQ(PetscArrayzero(elemMatD, numCells*totDim*totDim));
53963e9753d6SMatthew G. Knepley   for (fieldI = 0; fieldI < Nf; ++fieldI) {
53973e9753d6SMatthew G. Knepley     PetscClassId    id;
53983e9753d6SMatthew G. Knepley     PetscFE         fe;
53993e9753d6SMatthew G. Knepley     PetscQuadrature qGeom = NULL;
54003e9753d6SMatthew G. Knepley     PetscInt        Nb;
54013e9753d6SMatthew G. Knepley     /* Conforming batches */
54023e9753d6SMatthew G. Knepley     PetscInt        numChunks, numBatches, numBlocks, Ne, blockSize, batchSize;
54033e9753d6SMatthew G. Knepley     /* Remainder */
54043e9753d6SMatthew G. Knepley     PetscInt        Nr, offset, Nq;
54053e9753d6SMatthew G. Knepley     PetscInt        maxDegree;
54063e9753d6SMatthew G. Knepley     PetscFEGeom     *cgeomFEM, *chunkGeom = NULL, *remGeom = NULL;
54073e9753d6SMatthew G. Knepley 
54085f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, fieldI, (PetscObject *) &fe));
54095f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetClassId((PetscObject) fe, &id));
54103e9753d6SMatthew G. Knepley     if (id == PETSCFV_CLASSID) {hasFV = PETSC_TRUE; continue;}
54115f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGetDimension(fe, &Nb));
54125f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
54135f80ce2aSJacob Faibussowitsch     CHKERRQ(DMFieldGetDegree(coordField,cellIS,NULL,&maxDegree));
54143e9753d6SMatthew G. Knepley     if (maxDegree <= 1) {
54155f80ce2aSJacob Faibussowitsch       CHKERRQ(DMFieldCreateDefaultQuadrature(coordField,cellIS,&qGeom));
54163e9753d6SMatthew G. Knepley     }
54173e9753d6SMatthew G. Knepley     if (!qGeom) {
54185f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetQuadrature(fe,&qGeom));
54195f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscObjectReference((PetscObject)qGeom));
54203e9753d6SMatthew G. Knepley     }
54215f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscQuadratureGetData(qGeom, NULL, NULL, &Nq, NULL, NULL));
54225f80ce2aSJacob Faibussowitsch     CHKERRQ(DMSNESGetFEGeom(coordField,cellIS,qGeom,PETSC_FALSE,&cgeomFEM));
54233e9753d6SMatthew G. Knepley     blockSize = Nb;
54243e9753d6SMatthew G. Knepley     batchSize = numBlocks * blockSize;
54255f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
54263e9753d6SMatthew G. Knepley     numChunks = numCells / (numBatches*batchSize);
54273e9753d6SMatthew G. Knepley     Ne        = numChunks*numBatches*batchSize;
54283e9753d6SMatthew G. Knepley     Nr        = numCells % (numBatches*batchSize);
54293e9753d6SMatthew G. Knepley     offset    = numCells - Nr;
54305f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGeomGetChunk(cgeomFEM,0,offset,&chunkGeom));
54315f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGeomGetChunk(cgeomFEM,offset,numCells,&remGeom));
54323e9753d6SMatthew G. Knepley     for (fieldJ = 0; fieldJ < Nf; ++fieldJ) {
54336528b96dSMatthew G. Knepley       key.field = fieldI*Nf+fieldJ;
54343e9753d6SMatthew G. Knepley       if (hasJac) {
54355f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN, key, Ne, chunkGeom, u, u_t, probAux, a, t, X_tShift, elemMat));
54365f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN, key, Nr, remGeom, &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, probAux, &a[offset*totDimAux], t, X_tShift, &elemMat[offset*totDim*totDim]));
54373e9753d6SMatthew G. Knepley       }
54383e9753d6SMatthew G. Knepley       if (hasPrec) {
54395f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN_PRE, key, Ne, chunkGeom, u, u_t, probAux, a, t, X_tShift, elemMatP));
54405f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN_PRE, key, Nr, remGeom, &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, probAux, &a[offset*totDimAux], t, X_tShift, &elemMatP[offset*totDim*totDim]));
54413e9753d6SMatthew G. Knepley       }
54423e9753d6SMatthew G. Knepley       if (hasDyn) {
54435f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN_DYN, key, Ne, chunkGeom, u, u_t, probAux, a, t, X_tShift, elemMatD));
54445f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN_DYN, key, Nr, remGeom, &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, probAux, &a[offset*totDimAux], t, X_tShift, &elemMatD[offset*totDim*totDim]));
54453e9753d6SMatthew G. Knepley       }
54463e9753d6SMatthew G. Knepley     }
54475f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGeomRestoreChunk(cgeomFEM,offset,numCells,&remGeom));
54485f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGeomRestoreChunk(cgeomFEM,0,offset,&chunkGeom));
54495f80ce2aSJacob Faibussowitsch     CHKERRQ(DMSNESRestoreFEGeom(coordField,cellIS,qGeom,PETSC_FALSE,&cgeomFEM));
54505f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscQuadratureDestroy(&qGeom));
54513e9753d6SMatthew G. Knepley   }
54523e9753d6SMatthew G. Knepley   /*   Add contribution from X_t */
54533e9753d6SMatthew G. Knepley   if (hasDyn) {for (c = 0; c < numCells*totDim*totDim; ++c) elemMat[c] += X_tShift*elemMatD[c];}
54543e9753d6SMatthew G. Knepley   if (hasFV) {
54553e9753d6SMatthew G. Knepley     PetscClassId id;
54563e9753d6SMatthew G. Knepley     PetscFV      fv;
54573e9753d6SMatthew G. Knepley     PetscInt     offsetI, NcI, NbI = 1, fc, f;
54583e9753d6SMatthew G. Knepley 
54593e9753d6SMatthew G. Knepley     for (fieldI = 0; fieldI < Nf; ++fieldI) {
54605f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetDiscretization(prob, fieldI, (PetscObject *) &fv));
54615f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetFieldOffset(prob, fieldI, &offsetI));
54625f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscObjectGetClassId((PetscObject) fv, &id));
54633e9753d6SMatthew G. Knepley       if (id != PETSCFV_CLASSID) continue;
54643e9753d6SMatthew G. Knepley       /* Put in the identity */
54655f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFVGetNumComponents(fv, &NcI));
54663e9753d6SMatthew G. Knepley       for (c = cStart; c < cEnd; ++c) {
54673e9753d6SMatthew G. Knepley         const PetscInt cind    = c - cStart;
54683e9753d6SMatthew G. Knepley         const PetscInt eOffset = cind*totDim*totDim;
54693e9753d6SMatthew G. Knepley         for (fc = 0; fc < NcI; ++fc) {
54703e9753d6SMatthew G. Knepley           for (f = 0; f < NbI; ++f) {
54713e9753d6SMatthew G. Knepley             const PetscInt i = offsetI + f*NcI+fc;
54723e9753d6SMatthew G. Knepley             if (hasPrec) {
54733e9753d6SMatthew G. Knepley               if (hasJac) {elemMat[eOffset+i*totDim+i] = 1.0;}
54743e9753d6SMatthew G. Knepley               elemMatP[eOffset+i*totDim+i] = 1.0;
54753e9753d6SMatthew G. Knepley             } else {elemMat[eOffset+i*totDim+i] = 1.0;}
54763e9753d6SMatthew G. Knepley           }
54773e9753d6SMatthew G. Knepley         }
54783e9753d6SMatthew G. Knepley       }
54793e9753d6SMatthew G. Knepley     }
54803e9753d6SMatthew G. Knepley     /* No allocated space for FV stuff, so ignore the zero entries */
54815f80ce2aSJacob Faibussowitsch     CHKERRQ(MatSetOption(JacP, MAT_IGNORE_ZERO_ENTRIES, PETSC_TRUE));
54823e9753d6SMatthew G. Knepley   }
54833e9753d6SMatthew G. Knepley   /* Insert values into matrix */
54843e9753d6SMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
54853e9753d6SMatthew G. Knepley     const PetscInt cell = cells ? cells[c] : c;
54863e9753d6SMatthew G. Knepley     const PetscInt cind = c - cStart;
54873e9753d6SMatthew G. Knepley 
54883e9753d6SMatthew G. Knepley     /* Transform to global basis before insertion in Jacobian */
54895f80ce2aSJacob Faibussowitsch     if (transform) CHKERRQ(DMPlexBasisTransformPointTensor_Internal(dm, tdm, tv, cell, PETSC_TRUE, totDim, &elemMat[cind*totDim*totDim]));
54903e9753d6SMatthew G. Knepley     if (hasPrec) {
54913e9753d6SMatthew G. Knepley       if (hasJac) {
54925f80ce2aSJacob Faibussowitsch         if (mesh->printFEM > 1) CHKERRQ(DMPrintCellMatrix(cell, name, totDim, totDim, &elemMat[cind*totDim*totDim]));
54935f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexMatSetClosure(dm, section, globalSection, Jac, cell, &elemMat[cind*totDim*totDim], ADD_VALUES));
54943e9753d6SMatthew G. Knepley       }
54955f80ce2aSJacob Faibussowitsch       if (mesh->printFEM > 1) CHKERRQ(DMPrintCellMatrix(cell, name, totDim, totDim, &elemMatP[cind*totDim*totDim]));
54965f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexMatSetClosure(dm, section, globalSection, JacP, cell, &elemMatP[cind*totDim*totDim], ADD_VALUES));
54973e9753d6SMatthew G. Knepley     } else {
54983e9753d6SMatthew G. Knepley       if (hasJac) {
54995f80ce2aSJacob Faibussowitsch         if (mesh->printFEM > 1) CHKERRQ(DMPrintCellMatrix(cell, name, totDim, totDim, &elemMat[cind*totDim*totDim]));
55005f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexMatSetClosure(dm, section, globalSection, JacP, cell, &elemMat[cind*totDim*totDim], ADD_VALUES));
55013e9753d6SMatthew G. Knepley       }
55023e9753d6SMatthew G. Knepley     }
55033e9753d6SMatthew G. Knepley   }
55045f80ce2aSJacob Faibussowitsch   CHKERRQ(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
55055f80ce2aSJacob Faibussowitsch   if (hasFV) CHKERRQ(MatSetOption(JacP, MAT_IGNORE_ZERO_ENTRIES, PETSC_FALSE));
55065f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree5(u,u_t,elemMat,elemMatP,elemMatD));
55073e9753d6SMatthew G. Knepley   if (dmAux) {
55085f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFree(a));
55095f80ce2aSJacob Faibussowitsch     CHKERRQ(DMDestroy(&plex));
55103e9753d6SMatthew G. Knepley   }
55113e9753d6SMatthew G. Knepley   /* Compute boundary integrals */
55125f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexComputeBdJacobian_Internal(dm, X, X_t, t, X_tShift, Jac, JacP, user));
55133e9753d6SMatthew G. Knepley   /* Assemble matrix */
55143e9753d6SMatthew G. Knepley   if (hasJac && hasPrec) {
55155f80ce2aSJacob Faibussowitsch     CHKERRQ(MatAssemblyBegin(Jac, MAT_FINAL_ASSEMBLY));
55165f80ce2aSJacob Faibussowitsch     CHKERRQ(MatAssemblyEnd(Jac, MAT_FINAL_ASSEMBLY));
55173e9753d6SMatthew G. Knepley   }
55185f80ce2aSJacob Faibussowitsch   CHKERRQ(MatAssemblyBegin(JacP, MAT_FINAL_ASSEMBLY));
55195f80ce2aSJacob Faibussowitsch   CHKERRQ(MatAssemblyEnd(JacP, MAT_FINAL_ASSEMBLY));
55205f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventEnd(DMPLEX_JacobianFEM,dm,0,0,0));
55213e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
55223e9753d6SMatthew G. Knepley }
55233e9753d6SMatthew G. Knepley 
552406ad1575SMatthew G. Knepley PetscErrorCode DMPlexComputeJacobian_Hybrid_Internal(DM dm, PetscFormKey key[], IS cellIS, PetscReal t, PetscReal X_tShift, Vec locX, Vec locX_t, Mat Jac, Mat JacP, void *user)
55253e9753d6SMatthew G. Knepley {
55263e9753d6SMatthew G. Knepley   DM_Plex         *mesh          = (DM_Plex *) dm->data;
55273e9753d6SMatthew G. Knepley   const char      *name          = "Hybrid Jacobian";
5528148442b3SMatthew G. Knepley   DM               dmAux[3]      = {NULL, NULL, NULL};
5529148442b3SMatthew G. Knepley   DMLabel          ghostLabel    = NULL;
55303e9753d6SMatthew G. Knepley   DM               plex          = NULL;
55313e9753d6SMatthew G. Knepley   DM               plexA         = NULL;
5532148442b3SMatthew G. Knepley   PetscDS          ds            = NULL;
5533148442b3SMatthew G. Knepley   PetscDS          dsAux[3]      = {NULL, NULL, NULL};
5534148442b3SMatthew G. Knepley   Vec              locA[3]       = {NULL, NULL, NULL};
55353e9753d6SMatthew G. Knepley   PetscSection     section       = NULL;
5536148442b3SMatthew G. Knepley   PetscSection     sectionAux[3] = {NULL, NULL, NULL};
55373e9753d6SMatthew G. Knepley   DMField          coordField    = NULL;
5538148442b3SMatthew G. Knepley   PetscScalar     *u = NULL, *u_t, *a[3];
55393e9753d6SMatthew G. Knepley   PetscScalar     *elemMat, *elemMatP;
5540e432b41dSStefano Zampini   PetscSection     globalSection;
55413e9753d6SMatthew G. Knepley   IS               chunkIS;
55423e9753d6SMatthew G. Knepley   const PetscInt  *cells;
55433e9753d6SMatthew G. Knepley   PetscInt        *faces;
55443e9753d6SMatthew G. Knepley   PetscInt         cStart, cEnd, numCells;
5545148442b3SMatthew G. Knepley   PetscInt         Nf, fieldI, fieldJ, totDim, totDimAux[3], numChunks, cellChunkSize, chunk;
55463e9753d6SMatthew G. Knepley   PetscInt         maxDegree = PETSC_MAX_INT;
55473e9753d6SMatthew G. Knepley   PetscQuadrature  affineQuad = NULL, *quads = NULL;
55483e9753d6SMatthew G. Knepley   PetscFEGeom     *affineGeom = NULL, **geoms = NULL;
5549e432b41dSStefano Zampini   PetscBool        hasBdJac, hasBdPrec;
55503e9753d6SMatthew G. Knepley 
55513e9753d6SMatthew G. Knepley   PetscFunctionBegin;
55525fedec97SMatthew G. Knepley   if ((key[0].label == key[1].label) && (key[0].value == key[1].value) && (key[0].part == key[1].part)) {
55535fedec97SMatthew G. Knepley     const char *name;
55545f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectGetName((PetscObject) key[0].label, &name));
555598921bdaSJacob Faibussowitsch     SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Form keys for each side of a cohesive surface must be different (%s, %D, %D)", name, key[0].value, key[0].part);
55565fedec97SMatthew G. Knepley   }
55575f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventBegin(DMPLEX_JacobianFEM,dm,0,0,0));
55585f80ce2aSJacob Faibussowitsch   CHKERRQ(ISGetLocalSize(cellIS, &numCells));
55595f80ce2aSJacob Faibussowitsch   CHKERRQ(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
55605f80ce2aSJacob Faibussowitsch   CHKERRQ(DMConvert(dm, DMPLEX, &plex));
55615f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetSection(dm, &section));
55625f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetGlobalSection(dm, &globalSection));
55635f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLabel(dm, "ghost", &ghostLabel));
55645f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCellDS(dm, cStart, &ds));
55655f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetNumFields(ds, &Nf));
55665f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetTotalDimension(ds, &totDim));
55675f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSHasBdJacobian(ds, &hasBdJac));
55685f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSHasBdJacobianPreconditioner(ds, &hasBdPrec));
55695f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetAuxiliaryVec(dm, key[2].label, key[2].value, key[2].part, &locA[2]));
5570148442b3SMatthew G. Knepley   if (locA[2]) {
55715f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetDM(locA[2], &dmAux[2]));
55725f80ce2aSJacob Faibussowitsch     CHKERRQ(DMConvert(dmAux[2], DMPLEX, &plexA));
55735f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetSection(dmAux[2], &sectionAux[2]));
55745f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetCellDS(dmAux[2], cStart, &dsAux[2]));
55755f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetTotalDimension(dsAux[2], &totDimAux[2]));
5576148442b3SMatthew G. Knepley     {
5577148442b3SMatthew G. Knepley       const PetscInt *cone;
5578148442b3SMatthew G. Knepley       PetscInt        c;
5579148442b3SMatthew G. Knepley 
55805f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetCone(dm, cStart, &cone));
5581148442b3SMatthew G. Knepley       for (c = 0; c < 2; ++c) {
5582148442b3SMatthew G. Knepley         const PetscInt *support;
5583148442b3SMatthew G. Knepley         PetscInt ssize, s;
5584148442b3SMatthew G. Knepley 
55855f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexGetSupport(dm, cone[c], &support));
55865f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexGetSupportSize(dm, cone[c], &ssize));
55875f80ce2aSJacob Faibussowitsch         PetscCheck(ssize == 2,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Face %D from cell %D has support size %D != 2", cone[c], cStart, ssize);
5588148442b3SMatthew G. Knepley         if      (support[0] == cStart) s = 1;
5589148442b3SMatthew G. Knepley         else if (support[1] == cStart) s = 0;
559098921bdaSJacob Faibussowitsch         else SETERRQ(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Face %D does not have cell %D in its support", cone[c], cStart);
55915f80ce2aSJacob Faibussowitsch         CHKERRQ(DMGetAuxiliaryVec(dm, key[c].label, key[c].value, key[c].part, &locA[c]));
55925f80ce2aSJacob Faibussowitsch         if (locA[c]) CHKERRQ(VecGetDM(locA[c], &dmAux[c]));
5593148442b3SMatthew G. Knepley         else         {dmAux[c] = dmAux[2];}
55945f80ce2aSJacob Faibussowitsch         CHKERRQ(DMGetCellDS(dmAux[c], support[s], &dsAux[c]));
55955f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDSGetTotalDimension(dsAux[c], &totDimAux[c]));
5596148442b3SMatthew G. Knepley       }
5597148442b3SMatthew G. Knepley     }
55983e9753d6SMatthew G. Knepley   }
55995f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateField(dm, &coordField));
56005f80ce2aSJacob Faibussowitsch   CHKERRQ(DMFieldGetDegree(coordField, cellIS, NULL, &maxDegree));
56013e9753d6SMatthew G. Knepley   if (maxDegree > 1) {
56023e9753d6SMatthew G. Knepley     PetscInt f;
56035f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscCalloc2(Nf, &quads, Nf, &geoms));
56043e9753d6SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
56053e9753d6SMatthew G. Knepley       PetscFE fe;
56063e9753d6SMatthew G. Knepley 
56075f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetDiscretization(ds, f, (PetscObject *) &fe));
56083e9753d6SMatthew G. Knepley       if (fe) {
56095f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEGetQuadrature(fe, &quads[f]));
56105f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscObjectReference((PetscObject) quads[f]));
56113e9753d6SMatthew G. Knepley       }
56123e9753d6SMatthew G. Knepley     }
56133e9753d6SMatthew G. Knepley   }
56143e9753d6SMatthew G. Knepley   cellChunkSize = numCells;
56153e9753d6SMatthew G. Knepley   numChunks     = !numCells ? 0 : PetscCeilReal(((PetscReal) numCells)/cellChunkSize);
56165f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscCalloc1(2*cellChunkSize, &faces));
56175f80ce2aSJacob Faibussowitsch   CHKERRQ(ISCreateGeneral(PETSC_COMM_SELF, cellChunkSize, faces, PETSC_USE_POINTER, &chunkIS));
56185f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetCellFields(dm, cellIS, locX, locX_t, locA[2], &u, &u_t, &a[2]));
56195f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexGetHybridAuxFields(dm, dmAux, dsAux, cellIS, locA, a));
56205f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetWorkArray(dm, hasBdJac  ? cellChunkSize*totDim*totDim : 0, MPIU_SCALAR, &elemMat));
56215f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetWorkArray(dm, hasBdPrec ? cellChunkSize*totDim*totDim : 0, MPIU_SCALAR, &elemMatP));
56223e9753d6SMatthew G. Knepley   for (chunk = 0; chunk < numChunks; ++chunk) {
56233e9753d6SMatthew G. Knepley     PetscInt cS = cStart+chunk*cellChunkSize, cE = PetscMin(cS+cellChunkSize, cEnd), numCells = cE - cS, c;
56243e9753d6SMatthew G. Knepley 
56255f80ce2aSJacob Faibussowitsch     if (hasBdJac)  CHKERRQ(PetscMemzero(elemMat,  numCells*totDim*totDim * sizeof(PetscScalar)));
56265f80ce2aSJacob Faibussowitsch     if (hasBdPrec) CHKERRQ(PetscMemzero(elemMatP, numCells*totDim*totDim * sizeof(PetscScalar)));
56273e9753d6SMatthew G. Knepley     /* Get faces */
56283e9753d6SMatthew G. Knepley     for (c = cS; c < cE; ++c) {
56293e9753d6SMatthew G. Knepley       const PetscInt  cell = cells ? cells[c] : c;
56303e9753d6SMatthew G. Knepley       const PetscInt *cone;
56315f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexGetCone(plex, cell, &cone));
56323e9753d6SMatthew G. Knepley       faces[(c-cS)*2+0] = cone[0];
56333e9753d6SMatthew G. Knepley       faces[(c-cS)*2+1] = cone[1];
56343e9753d6SMatthew G. Knepley     }
56355f80ce2aSJacob Faibussowitsch     CHKERRQ(ISGeneralSetIndices(chunkIS, cellChunkSize, faces, PETSC_USE_POINTER));
56363e9753d6SMatthew G. Knepley     if (maxDegree <= 1) {
56375f80ce2aSJacob Faibussowitsch       if (!affineQuad) CHKERRQ(DMFieldCreateDefaultQuadrature(coordField, chunkIS, &affineQuad));
56385f80ce2aSJacob Faibussowitsch       if (affineQuad)  CHKERRQ(DMSNESGetFEGeom(coordField, chunkIS, affineQuad, PETSC_TRUE, &affineGeom));
56393e9753d6SMatthew G. Knepley     } else {
56403e9753d6SMatthew G. Knepley       PetscInt f;
56413e9753d6SMatthew G. Knepley       for (f = 0; f < Nf; ++f) {
56425f80ce2aSJacob Faibussowitsch         if (quads[f]) CHKERRQ(DMSNESGetFEGeom(coordField, chunkIS, quads[f], PETSC_TRUE, &geoms[f]));
56433e9753d6SMatthew G. Knepley       }
56443e9753d6SMatthew G. Knepley     }
56453e9753d6SMatthew G. Knepley 
56463e9753d6SMatthew G. Knepley     for (fieldI = 0; fieldI < Nf; ++fieldI) {
56473e9753d6SMatthew G. Knepley       PetscFE         feI;
56483e9753d6SMatthew G. Knepley       PetscFEGeom    *geom = affineGeom ? affineGeom : geoms[fieldI];
56493e9753d6SMatthew G. Knepley       PetscFEGeom    *chunkGeom = NULL, *remGeom = NULL;
56503e9753d6SMatthew G. Knepley       PetscQuadrature quad = affineQuad ? affineQuad : quads[fieldI];
56513e9753d6SMatthew G. Knepley       PetscInt        numChunks, numBatches, batchSize, numBlocks, blockSize, Ne, Nr, offset, Nq, Nb;
56525fedec97SMatthew G. Knepley       PetscBool       isCohesiveField;
56533e9753d6SMatthew G. Knepley 
56545f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetDiscretization(ds, fieldI, (PetscObject *) &feI));
56553e9753d6SMatthew G. Knepley       if (!feI) continue;
56565f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetTileSizes(feI, NULL, &numBlocks, NULL, &numBatches));
56575f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscQuadratureGetData(quad, NULL, NULL, &Nq, NULL, NULL));
56585f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetDimension(feI, &Nb));
56593e9753d6SMatthew G. Knepley       blockSize = Nb;
56603e9753d6SMatthew G. Knepley       batchSize = numBlocks * blockSize;
56615f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFESetTileSizes(feI, blockSize, numBlocks, batchSize, numBatches));
56623e9753d6SMatthew G. Knepley       numChunks = numCells / (numBatches*batchSize);
56633e9753d6SMatthew G. Knepley       Ne        = numChunks*numBatches*batchSize;
56643e9753d6SMatthew G. Knepley       Nr        = numCells % (numBatches*batchSize);
56653e9753d6SMatthew G. Knepley       offset    = numCells - Nr;
56665f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomGetChunk(geom,0,offset,&chunkGeom));
56675f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomGetChunk(geom,offset,numCells,&remGeom));
56685f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscDSGetCohesive(ds, fieldI, &isCohesiveField));
56693e9753d6SMatthew G. Knepley       for (fieldJ = 0; fieldJ < Nf; ++fieldJ) {
56703e9753d6SMatthew G. Knepley         PetscFE feJ;
56713e9753d6SMatthew G. Knepley 
56725f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscDSGetDiscretization(ds, fieldJ, (PetscObject *) &feJ));
56733e9753d6SMatthew G. Knepley         if (!feJ) continue;
5674148442b3SMatthew G. Knepley         key[0].field = fieldI*Nf+fieldJ;
5675148442b3SMatthew G. Knepley         key[1].field = fieldI*Nf+fieldJ;
56765fedec97SMatthew G. Knepley         key[2].field = fieldI*Nf+fieldJ;
5677148442b3SMatthew G. Knepley         if (hasBdJac) {
56785f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN, key[0], 0, Ne, chunkGeom, u, u_t, dsAux[0], a[0], t, X_tShift, elemMat));
56795f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN, key[0], 0, Nr, remGeom, &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, dsAux[0], &a[0][offset*totDimAux[0]], t, X_tShift, &elemMat[offset*totDim*totDim]));
56805f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN, key[1], 1, Ne, chunkGeom, u, u_t, dsAux[1], a[1], t, X_tShift, elemMat));
56815f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN, key[1], 1, Nr, remGeom, &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, dsAux[1], &a[1][offset*totDimAux[1]], t, X_tShift, &elemMat[offset*totDim*totDim]));
5682148442b3SMatthew G. Knepley         }
5683148442b3SMatthew G. Knepley         if (hasBdPrec) {
56845f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN_PRE, key[0], 0, Ne, chunkGeom, u, u_t, dsAux[0], a[0], t, X_tShift, elemMatP));
56855f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN_PRE, key[0], 0, Nr, remGeom, &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, dsAux[0], &a[0][offset*totDimAux[0]], t, X_tShift, &elemMatP[offset*totDim*totDim]));
56865f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN_PRE, key[1], 1, Ne, chunkGeom, u, u_t, dsAux[1], a[1], t, X_tShift, elemMatP));
56875f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN_PRE, key[1], 1, Nr, remGeom, &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, dsAux[1], &a[1][offset*totDimAux[1]], t, X_tShift, &elemMatP[offset*totDim*totDim]));
5688148442b3SMatthew G. Knepley         }
56895fedec97SMatthew G. Knepley         if (hasBdJac) {
56905f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN, key[2], 2, Ne, chunkGeom, u, u_t, dsAux[2], a[2], t, X_tShift, elemMat));
56915f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN, key[2], 2, Nr, remGeom, &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, dsAux[2], &a[2][offset*totDimAux[2]], t, X_tShift, &elemMat[offset*totDim*totDim]));
5692148442b3SMatthew G. Knepley         }
56935fedec97SMatthew G. Knepley         if (hasBdPrec) {
56945f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN_PRE, key[2], 2, Ne, chunkGeom, u, u_t, dsAux[2], a[2], t, X_tShift, elemMatP));
56955f80ce2aSJacob Faibussowitsch           CHKERRQ(PetscFEIntegrateHybridJacobian(ds, PETSCFE_JACOBIAN_PRE, key[2], 2, Nr, remGeom, &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, dsAux[2], &a[2][offset*totDimAux[2]], t, X_tShift, &elemMatP[offset*totDim*totDim]));
56963e9753d6SMatthew G. Knepley         }
56973e9753d6SMatthew G. Knepley       }
56985f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomRestoreChunk(geom,offset,numCells,&remGeom));
56995f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGeomRestoreChunk(geom,0,offset,&chunkGeom));
57003e9753d6SMatthew G. Knepley     }
57013e9753d6SMatthew G. Knepley     /* Insert values into matrix */
57023e9753d6SMatthew G. Knepley     for (c = cS; c < cE; ++c) {
57033e9753d6SMatthew G. Knepley       const PetscInt cell = cells ? cells[c] : c;
57043e9753d6SMatthew G. Knepley       const PetscInt cind = c - cS;
57053e9753d6SMatthew G. Knepley 
57063e9753d6SMatthew G. Knepley       if (hasBdPrec) {
57073e9753d6SMatthew G. Knepley         if (hasBdJac) {
57085f80ce2aSJacob Faibussowitsch           if (mesh->printFEM > 1) CHKERRQ(DMPrintCellMatrix(cell, name, totDim, totDim, &elemMat[cind*totDim*totDim]));
57095f80ce2aSJacob Faibussowitsch           CHKERRQ(DMPlexMatSetClosure(plex, section, globalSection, Jac, cell, &elemMat[cind*totDim*totDim], ADD_VALUES));
57103e9753d6SMatthew G. Knepley         }
57115f80ce2aSJacob Faibussowitsch         if (mesh->printFEM > 1) CHKERRQ(DMPrintCellMatrix(cell, name, totDim, totDim, &elemMatP[cind*totDim*totDim]));
57125f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexMatSetClosure(plex, section, globalSection, JacP, cell, &elemMatP[cind*totDim*totDim], ADD_VALUES));
57133e9753d6SMatthew G. Knepley       } else if (hasBdJac) {
57145f80ce2aSJacob Faibussowitsch         if (mesh->printFEM > 1) CHKERRQ(DMPrintCellMatrix(cell, name, totDim, totDim, &elemMat[cind*totDim*totDim]));
57155f80ce2aSJacob Faibussowitsch         CHKERRQ(DMPlexMatSetClosure(plex, section, globalSection, JacP, cell, &elemMat[cind*totDim*totDim], ADD_VALUES));
57163e9753d6SMatthew G. Knepley       }
57173e9753d6SMatthew G. Knepley     }
57183e9753d6SMatthew G. Knepley   }
57195f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexRestoreCellFields(dm, cellIS, locX, locX_t, locA[2], &u, &u_t, &a[2]));
57205f80ce2aSJacob Faibussowitsch   CHKERRQ(DMPlexRestoreHybridAuxFields(dmAux, dsAux, cellIS, locA, a));
57215f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreWorkArray(dm, hasBdJac  ? cellChunkSize*totDim*totDim : 0, MPIU_SCALAR, &elemMat));
57225f80ce2aSJacob Faibussowitsch   CHKERRQ(DMRestoreWorkArray(dm, hasBdPrec ? cellChunkSize*totDim*totDim : 0, MPIU_SCALAR, &elemMatP));
57235f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree(faces));
57245f80ce2aSJacob Faibussowitsch   CHKERRQ(ISDestroy(&chunkIS));
57255f80ce2aSJacob Faibussowitsch   CHKERRQ(ISRestorePointRange(cellIS, &cStart, &cEnd, &cells));
57263e9753d6SMatthew G. Knepley   if (maxDegree <= 1) {
57275f80ce2aSJacob Faibussowitsch     CHKERRQ(DMSNESRestoreFEGeom(coordField,cellIS,affineQuad,PETSC_FALSE,&affineGeom));
57285f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscQuadratureDestroy(&affineQuad));
57293e9753d6SMatthew G. Knepley   } else {
57303e9753d6SMatthew G. Knepley     PetscInt f;
57313e9753d6SMatthew G. Knepley     for (f = 0; f < Nf; ++f) {
57325f80ce2aSJacob Faibussowitsch       if (geoms) CHKERRQ(DMSNESRestoreFEGeom(coordField,cellIS,quads[f],PETSC_FALSE, &geoms[f]));
57335f80ce2aSJacob Faibussowitsch       if (quads) CHKERRQ(PetscQuadratureDestroy(&quads[f]));
57343e9753d6SMatthew G. Knepley     }
57355f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFree2(quads,geoms));
57363e9753d6SMatthew G. Knepley   }
57375f80ce2aSJacob Faibussowitsch   if (dmAux[2]) CHKERRQ(DMDestroy(&plexA));
57385f80ce2aSJacob Faibussowitsch   CHKERRQ(DMDestroy(&plex));
57393e9753d6SMatthew G. Knepley   /* Assemble matrix */
57403e9753d6SMatthew G. Knepley   if (hasBdJac && hasBdPrec) {
57415f80ce2aSJacob Faibussowitsch     CHKERRQ(MatAssemblyBegin(Jac, MAT_FINAL_ASSEMBLY));
57425f80ce2aSJacob Faibussowitsch     CHKERRQ(MatAssemblyEnd(Jac, MAT_FINAL_ASSEMBLY));
57433e9753d6SMatthew G. Knepley   }
57445f80ce2aSJacob Faibussowitsch   CHKERRQ(MatAssemblyBegin(JacP, MAT_FINAL_ASSEMBLY));
57455f80ce2aSJacob Faibussowitsch   CHKERRQ(MatAssemblyEnd(JacP, MAT_FINAL_ASSEMBLY));
57465f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventEnd(DMPLEX_JacobianFEM,dm,0,0,0));
57473e9753d6SMatthew G. Knepley   PetscFunctionReturn(0);
57483e9753d6SMatthew G. Knepley }
57498e3a2eefSMatthew G. Knepley 
57508e3a2eefSMatthew G. Knepley /*
57518e3a2eefSMatthew G. Knepley   DMPlexComputeJacobian_Action_Internal - Form the local portion of the Jacobian action Z = J(X) Y at the local solution X using pointwise functions specified by the user.
57528e3a2eefSMatthew G. Knepley 
57538e3a2eefSMatthew G. Knepley   Input Parameters:
57548e3a2eefSMatthew G. Knepley + dm     - The mesh
57558e3a2eefSMatthew G. Knepley . key    - The PetscWeakFormKey indcating where integration should happen
575606ad1575SMatthew G. Knepley . cellIS - The cells to integrate over
57578e3a2eefSMatthew G. Knepley . t      - The time
57588e3a2eefSMatthew G. Knepley . X_tShift - The multiplier for the Jacobian with repsect to X_t
57598e3a2eefSMatthew G. Knepley . X      - Local solution vector
57608e3a2eefSMatthew G. Knepley . X_t    - Time-derivative of the local solution vector
57618e3a2eefSMatthew G. Knepley . Y      - Local input vector
576206ad1575SMatthew G. Knepley - user   - the user context
57638e3a2eefSMatthew G. Knepley 
57648e3a2eefSMatthew G. Knepley   Output Parameter:
57658e3a2eefSMatthew G. Knepley . Z - Local output vector
57668e3a2eefSMatthew G. Knepley 
57678e3a2eefSMatthew G. Knepley   Note:
57688e3a2eefSMatthew G. Knepley   We form the residual one batch of elements at a time. This allows us to offload work onto an accelerator,
57698e3a2eefSMatthew G. Knepley   like a GPU, or vectorize on a multicore machine.
57708e3a2eefSMatthew G. Knepley */
577106ad1575SMatthew G. Knepley PetscErrorCode DMPlexComputeJacobian_Action_Internal(DM dm, PetscFormKey key, IS cellIS, PetscReal t, PetscReal X_tShift, Vec X, Vec X_t, Vec Y, Vec Z, void *user)
57728e3a2eefSMatthew G. Knepley {
57738e3a2eefSMatthew G. Knepley   DM_Plex        *mesh  = (DM_Plex *) dm->data;
57748e3a2eefSMatthew G. Knepley   const char     *name  = "Jacobian";
57758e3a2eefSMatthew G. Knepley   DM              dmAux = NULL, plex, plexAux = NULL;
57768e3a2eefSMatthew G. Knepley   DMEnclosureType encAux;
57778e3a2eefSMatthew G. Knepley   Vec             A;
57788e3a2eefSMatthew G. Knepley   DMField         coordField;
57798e3a2eefSMatthew G. Knepley   PetscDS         prob, probAux = NULL;
57808e3a2eefSMatthew G. Knepley   PetscQuadrature quad;
57818e3a2eefSMatthew G. Knepley   PetscSection    section, globalSection, sectionAux;
57828e3a2eefSMatthew G. Knepley   PetscScalar    *elemMat, *elemMatD, *u, *u_t, *a = NULL, *y, *z;
57838e3a2eefSMatthew G. Knepley   const PetscInt *cells;
57848e3a2eefSMatthew G. Knepley   PetscInt        Nf, fieldI, fieldJ;
57858e3a2eefSMatthew G. Knepley   PetscInt        totDim, totDimAux = 0, cStart, cEnd, numCells, c;
57868e3a2eefSMatthew G. Knepley   PetscBool       hasDyn;
57878e3a2eefSMatthew G. Knepley 
57888e3a2eefSMatthew G. Knepley   PetscFunctionBegin;
57895f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventBegin(DMPLEX_JacobianFEM,dm,0,0,0));
57905f80ce2aSJacob Faibussowitsch   CHKERRQ(DMConvert(dm, DMPLEX, &plex));
57918e3a2eefSMatthew G. Knepley   if (!cellIS) {
57928e3a2eefSMatthew G. Knepley     PetscInt depth;
57938e3a2eefSMatthew G. Knepley 
57945f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexGetDepth(plex, &depth));
57955f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetStratumIS(plex, "dim", depth, &cellIS));
57965f80ce2aSJacob Faibussowitsch     if (!cellIS) CHKERRQ(DMGetStratumIS(plex, "depth", depth, &cellIS));
57978e3a2eefSMatthew G. Knepley   } else {
57985f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscObjectReference((PetscObject) cellIS));
57998e3a2eefSMatthew G. Knepley   }
58005f80ce2aSJacob Faibussowitsch   CHKERRQ(ISGetLocalSize(cellIS, &numCells));
58015f80ce2aSJacob Faibussowitsch   CHKERRQ(ISGetPointRange(cellIS, &cStart, &cEnd, &cells));
58025f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetLocalSection(dm, &section));
58035f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetGlobalSection(dm, &globalSection));
58045f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCellDS(dm, cells ? cells[cStart] : cStart, &prob));
58055f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetNumFields(prob, &Nf));
58065f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSGetTotalDimension(prob, &totDim));
58075f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscDSHasDynamicJacobian(prob, &hasDyn));
58088e3a2eefSMatthew G. Knepley   hasDyn = hasDyn && (X_tShift != 0.0) ? PETSC_TRUE : PETSC_FALSE;
58095f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetAuxiliaryVec(dm, key.label, key.value, key.part, &A));
58108e3a2eefSMatthew G. Knepley   if (A) {
58115f80ce2aSJacob Faibussowitsch     CHKERRQ(VecGetDM(A, &dmAux));
58125f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetEnclosureRelation(dmAux, dm, &encAux));
58135f80ce2aSJacob Faibussowitsch     CHKERRQ(DMConvert(dmAux, DMPLEX, &plexAux));
58145f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetLocalSection(plexAux, &sectionAux));
58155f80ce2aSJacob Faibussowitsch     CHKERRQ(DMGetDS(dmAux, &probAux));
58165f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetTotalDimension(probAux, &totDimAux));
58178e3a2eefSMatthew G. Knepley   }
58185f80ce2aSJacob Faibussowitsch   CHKERRQ(VecSet(Z, 0.0));
58195f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscMalloc6(numCells*totDim,&u,X_t ? numCells*totDim : 0,&u_t,numCells*totDim*totDim,&elemMat,hasDyn ? numCells*totDim*totDim : 0, &elemMatD,numCells*totDim,&y,totDim,&z));
58205f80ce2aSJacob Faibussowitsch   if (dmAux) CHKERRQ(PetscMalloc1(numCells*totDimAux, &a));
58215f80ce2aSJacob Faibussowitsch   CHKERRQ(DMGetCoordinateField(dm, &coordField));
58228e3a2eefSMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
58238e3a2eefSMatthew G. Knepley     const PetscInt cell = cells ? cells[c] : c;
58248e3a2eefSMatthew G. Knepley     const PetscInt cind = c - cStart;
58258e3a2eefSMatthew G. Knepley     PetscScalar   *x = NULL,  *x_t = NULL;
58268e3a2eefSMatthew G. Knepley     PetscInt       i;
58278e3a2eefSMatthew G. Knepley 
58285f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecGetClosure(plex, section, X, cell, NULL, &x));
58298e3a2eefSMatthew G. Knepley     for (i = 0; i < totDim; ++i) u[cind*totDim+i] = x[i];
58305f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecRestoreClosure(plex, section, X, cell, NULL, &x));
58318e3a2eefSMatthew G. Knepley     if (X_t) {
58325f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecGetClosure(plex, section, X_t, cell, NULL, &x_t));
58338e3a2eefSMatthew G. Knepley       for (i = 0; i < totDim; ++i) u_t[cind*totDim+i] = x_t[i];
58345f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecRestoreClosure(plex, section, X_t, cell, NULL, &x_t));
58358e3a2eefSMatthew G. Knepley     }
58368e3a2eefSMatthew G. Knepley     if (dmAux) {
58378e3a2eefSMatthew G. Knepley       PetscInt subcell;
58385f80ce2aSJacob Faibussowitsch       CHKERRQ(DMGetEnclosurePoint(dmAux, dm, encAux, cell, &subcell));
58395f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecGetClosure(plexAux, sectionAux, A, subcell, NULL, &x));
58408e3a2eefSMatthew G. Knepley       for (i = 0; i < totDimAux; ++i) a[cind*totDimAux+i] = x[i];
58415f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPlexVecRestoreClosure(plexAux, sectionAux, A, subcell, NULL, &x));
58428e3a2eefSMatthew G. Knepley     }
58435f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecGetClosure(plex, section, Y, cell, NULL, &x));
58448e3a2eefSMatthew G. Knepley     for (i = 0; i < totDim; ++i) y[cind*totDim+i] = x[i];
58455f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecRestoreClosure(plex, section, Y, cell, NULL, &x));
58468e3a2eefSMatthew G. Knepley   }
58475f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscArrayzero(elemMat, numCells*totDim*totDim));
58485f80ce2aSJacob Faibussowitsch   if (hasDyn)  CHKERRQ(PetscArrayzero(elemMatD, numCells*totDim*totDim));
58498e3a2eefSMatthew G. Knepley   for (fieldI = 0; fieldI < Nf; ++fieldI) {
58508e3a2eefSMatthew G. Knepley     PetscFE  fe;
58518e3a2eefSMatthew G. Knepley     PetscInt Nb;
58528e3a2eefSMatthew G. Knepley     /* Conforming batches */
58538e3a2eefSMatthew G. Knepley     PetscInt numChunks, numBatches, numBlocks, Ne, blockSize, batchSize;
58548e3a2eefSMatthew G. Knepley     /* Remainder */
58558e3a2eefSMatthew G. Knepley     PetscInt Nr, offset, Nq;
58568e3a2eefSMatthew G. Knepley     PetscQuadrature qGeom = NULL;
58578e3a2eefSMatthew G. Knepley     PetscInt    maxDegree;
58588e3a2eefSMatthew G. Knepley     PetscFEGeom *cgeomFEM, *chunkGeom = NULL, *remGeom = NULL;
58598e3a2eefSMatthew G. Knepley 
58605f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscDSGetDiscretization(prob, fieldI, (PetscObject *) &fe));
58615f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGetQuadrature(fe, &quad));
58625f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGetDimension(fe, &Nb));
58635f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGetTileSizes(fe, NULL, &numBlocks, NULL, &numBatches));
58645f80ce2aSJacob Faibussowitsch     CHKERRQ(DMFieldGetDegree(coordField,cellIS,NULL,&maxDegree));
58655f80ce2aSJacob Faibussowitsch     if (maxDegree <= 1) CHKERRQ(DMFieldCreateDefaultQuadrature(coordField,cellIS,&qGeom));
58668e3a2eefSMatthew G. Knepley     if (!qGeom) {
58675f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEGetQuadrature(fe,&qGeom));
58685f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscObjectReference((PetscObject)qGeom));
58698e3a2eefSMatthew G. Knepley     }
58705f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscQuadratureGetData(qGeom, NULL, NULL, &Nq, NULL, NULL));
58715f80ce2aSJacob Faibussowitsch     CHKERRQ(DMSNESGetFEGeom(coordField,cellIS,qGeom,PETSC_FALSE,&cgeomFEM));
58728e3a2eefSMatthew G. Knepley     blockSize = Nb;
58738e3a2eefSMatthew G. Knepley     batchSize = numBlocks * blockSize;
58745f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFESetTileSizes(fe, blockSize, numBlocks, batchSize, numBatches));
58758e3a2eefSMatthew G. Knepley     numChunks = numCells / (numBatches*batchSize);
58768e3a2eefSMatthew G. Knepley     Ne        = numChunks*numBatches*batchSize;
58778e3a2eefSMatthew G. Knepley     Nr        = numCells % (numBatches*batchSize);
58788e3a2eefSMatthew G. Knepley     offset    = numCells - Nr;
58795f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGeomGetChunk(cgeomFEM,0,offset,&chunkGeom));
58805f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGeomGetChunk(cgeomFEM,offset,numCells,&remGeom));
58818e3a2eefSMatthew G. Knepley     for (fieldJ = 0; fieldJ < Nf; ++fieldJ) {
58828e3a2eefSMatthew G. Knepley       key.field = fieldI*Nf + fieldJ;
58835f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN, key, Ne, chunkGeom, u, u_t, probAux, a, t, X_tShift, elemMat));
58845f80ce2aSJacob Faibussowitsch       CHKERRQ(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN, key, Nr, remGeom, &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, probAux, &a[offset*totDimAux], t, X_tShift, &elemMat[offset*totDim*totDim]));
58858e3a2eefSMatthew G. Knepley       if (hasDyn) {
58865f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN_DYN, key, Ne, chunkGeom, u, u_t, probAux, a, t, X_tShift, elemMatD));
58875f80ce2aSJacob Faibussowitsch         CHKERRQ(PetscFEIntegrateJacobian(prob, PETSCFE_JACOBIAN_DYN, key, Nr, remGeom, &u[offset*totDim], u_t ? &u_t[offset*totDim] : NULL, probAux, &a[offset*totDimAux], t, X_tShift, &elemMatD[offset*totDim*totDim]));
58888e3a2eefSMatthew G. Knepley       }
58898e3a2eefSMatthew G. Knepley     }
58905f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGeomRestoreChunk(cgeomFEM,offset,numCells,&remGeom));
58915f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscFEGeomRestoreChunk(cgeomFEM,0,offset,&chunkGeom));
58925f80ce2aSJacob Faibussowitsch     CHKERRQ(DMSNESRestoreFEGeom(coordField,cellIS,qGeom,PETSC_FALSE,&cgeomFEM));
58935f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscQuadratureDestroy(&qGeom));
58948e3a2eefSMatthew G. Knepley   }
58958e3a2eefSMatthew G. Knepley   if (hasDyn) {
58968e3a2eefSMatthew G. Knepley     for (c = 0; c < numCells*totDim*totDim; ++c) elemMat[c] += X_tShift*elemMatD[c];
58978e3a2eefSMatthew G. Knepley   }
58988e3a2eefSMatthew G. Knepley   for (c = cStart; c < cEnd; ++c) {
58998e3a2eefSMatthew G. Knepley     const PetscInt     cell = cells ? cells[c] : c;
59008e3a2eefSMatthew G. Knepley     const PetscInt     cind = c - cStart;
59018e3a2eefSMatthew G. Knepley     const PetscBLASInt M = totDim, one = 1;
59028e3a2eefSMatthew G. Knepley     const PetscScalar  a = 1.0, b = 0.0;
59038e3a2eefSMatthew G. Knepley 
59048e3a2eefSMatthew G. Knepley     PetscStackCallBLAS("BLASgemv", BLASgemv_("N", &M, &M, &a, &elemMat[cind*totDim*totDim], &M, &y[cind*totDim], &one, &b, z, &one));
59058e3a2eefSMatthew G. Knepley     if (mesh->printFEM > 1) {
59065f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPrintCellMatrix(c, name, totDim, totDim, &elemMat[cind*totDim*totDim]));
59075f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPrintCellVector(c, "Y",  totDim, &y[cind*totDim]));
59085f80ce2aSJacob Faibussowitsch       CHKERRQ(DMPrintCellVector(c, "Z",  totDim, z));
59098e3a2eefSMatthew G. Knepley     }
59105f80ce2aSJacob Faibussowitsch     CHKERRQ(DMPlexVecSetClosure(dm, section, Z, cell, z, ADD_VALUES));
59118e3a2eefSMatthew G. Knepley   }
59125f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree6(u,u_t,elemMat,elemMatD,y,z));
59138e3a2eefSMatthew G. Knepley   if (mesh->printFEM) {
59145f80ce2aSJacob Faibussowitsch     CHKERRQ(PetscPrintf(PetscObjectComm((PetscObject)Z), "Z:\n"));
59155f80ce2aSJacob Faibussowitsch     CHKERRQ(VecView(Z, NULL));
59168e3a2eefSMatthew G. Knepley   }
59175f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscFree(a));
59185f80ce2aSJacob Faibussowitsch   CHKERRQ(ISDestroy(&cellIS));
59195f80ce2aSJacob Faibussowitsch   CHKERRQ(DMDestroy(&plexAux));
59205f80ce2aSJacob Faibussowitsch   CHKERRQ(DMDestroy(&plex));
59215f80ce2aSJacob Faibussowitsch   CHKERRQ(PetscLogEventEnd(DMPLEX_JacobianFEM,dm,0,0,0));
59228e3a2eefSMatthew G. Knepley   PetscFunctionReturn(0);
59238e3a2eefSMatthew G. Knepley }
5924