151a454edSToby Isaac #include <petsc/private/dmfieldimpl.h> /*I "petscdmfield.h" I*/ 20145028aSToby Isaac #include <petsc/private/petscfeimpl.h> /*I "petscdmfield.h" I*/ 351a454edSToby Isaac #include <petscfe.h> 451a454edSToby Isaac #include <petscdmplex.h> 551a454edSToby Isaac #include <petscds.h> 651a454edSToby Isaac 751a454edSToby Isaac typedef struct _n_DMField_DS 851a454edSToby Isaac { 951a454edSToby Isaac PetscBool multifieldVec; 10*6858538eSMatthew G. Knepley PetscInt height; /* Point height at which we want values and number of discretizations */ 11*6858538eSMatthew G. Knepley PetscInt fieldNum; /* Number in DS of field which we evaluate */ 12*6858538eSMatthew G. Knepley PetscObject *disc; /* Discretizations of this field at each height */ 13*6858538eSMatthew G. Knepley Vec vec; /* Field values */ 14*6858538eSMatthew G. Knepley DM dmDG; /* DM for the DG values */ 15*6858538eSMatthew G. Knepley PetscObject *discDG; /* DG Discretizations of this field at each height */ 16*6858538eSMatthew G. Knepley Vec vecDG; /* DG Field values */ 17*6858538eSMatthew G. Knepley } DMField_DS; 1851a454edSToby Isaac 1951a454edSToby Isaac static PetscErrorCode DMFieldDestroy_DS(DMField field) 2051a454edSToby Isaac { 21*6858538eSMatthew G. Knepley DMField_DS *dsfield = (DMField_DS *) field->data; 2251a454edSToby Isaac PetscInt i; 2351a454edSToby Isaac 2451a454edSToby Isaac PetscFunctionBegin; 259566063dSJacob Faibussowitsch PetscCall(VecDestroy(&dsfield->vec)); 26*6858538eSMatthew G. Knepley for (i = 0; i < dsfield->height; i++) PetscCall(PetscObjectDereference(dsfield->disc[i])); 279566063dSJacob Faibussowitsch PetscCall(PetscFree(dsfield->disc)); 28*6858538eSMatthew G. Knepley PetscCall(VecDestroy(&dsfield->vecDG)); 29*6858538eSMatthew G. Knepley if (dsfield->discDG) for (i = 0; i < dsfield->height; i++) PetscCall(PetscObjectDereference(dsfield->discDG[i])); 30*6858538eSMatthew G. Knepley PetscCall(PetscFree(dsfield->discDG)); 319566063dSJacob Faibussowitsch PetscCall(PetscFree(dsfield)); 3251a454edSToby Isaac PetscFunctionReturn(0); 3351a454edSToby Isaac } 3451a454edSToby Isaac 3551a454edSToby Isaac static PetscErrorCode DMFieldView_DS(DMField field,PetscViewer viewer) 3651a454edSToby Isaac { 3751a454edSToby Isaac DMField_DS *dsfield = (DMField_DS *) field->data; 3851a454edSToby Isaac PetscObject disc; 39*6858538eSMatthew G. Knepley PetscBool iascii; 4051a454edSToby Isaac 4151a454edSToby Isaac PetscFunctionBegin; 429566063dSJacob Faibussowitsch PetscCall(PetscObjectTypeCompare((PetscObject) viewer, PETSCVIEWERASCII, &iascii)); 4351a454edSToby Isaac disc = dsfield->disc[0]; 4451a454edSToby Isaac if (iascii) { 4563a3b9bcSJacob Faibussowitsch PetscCall(PetscViewerASCIIPrintf(viewer, "PetscDS field %" PetscInt_FMT "\n", dsfield->fieldNum)); 469566063dSJacob Faibussowitsch PetscCall(PetscViewerASCIIPushTab(viewer)); 479566063dSJacob Faibussowitsch PetscCall(PetscObjectView(disc, viewer)); 489566063dSJacob Faibussowitsch PetscCall(PetscViewerASCIIPopTab(viewer)); 4951a454edSToby Isaac } 509566063dSJacob Faibussowitsch PetscCall(PetscViewerASCIIPushTab(viewer)); 5128b400f6SJacob Faibussowitsch PetscCheck(!dsfield->multifieldVec, PetscObjectComm((PetscObject) field), PETSC_ERR_SUP, "View of subfield not implemented yet"); 529566063dSJacob Faibussowitsch PetscCall(VecView(dsfield->vec, viewer)); 539566063dSJacob Faibussowitsch PetscCall(PetscViewerASCIIPopTab(viewer)); 5451a454edSToby Isaac PetscFunctionReturn(0); 5551a454edSToby Isaac } 5651a454edSToby Isaac 57*6858538eSMatthew G. Knepley static PetscErrorCode DMFieldDSGetHeightDisc(DMField field, PetscInt height, PetscObject discList[], PetscObject *disc) 5851a454edSToby Isaac { 5951a454edSToby Isaac PetscFunctionBegin; 60*6858538eSMatthew G. Knepley if (!discList[height]) { 6151a454edSToby Isaac PetscClassId id; 6251a454edSToby Isaac 63*6858538eSMatthew G. Knepley PetscCall(PetscObjectGetClassId(discList[0], &id)); 64*6858538eSMatthew G. Knepley if (id == PETSCFE_CLASSID) PetscCall(PetscFECreateHeightTrace((PetscFE) discList[0], height, (PetscFE *) &discList[height])); 6551a454edSToby Isaac } 66*6858538eSMatthew G. Knepley *disc = discList[height]; 6751a454edSToby Isaac PetscFunctionReturn(0); 6851a454edSToby Isaac } 6951a454edSToby Isaac 7062bd480fSMatthew G. Knepley /* y[m,c] = A[m,n,c] . b[n] */ 7151a454edSToby Isaac #define DMFieldDSdot(y,A,b,m,n,c,cast) \ 7251a454edSToby Isaac do { \ 7351a454edSToby Isaac PetscInt _i, _j, _k; \ 7451a454edSToby Isaac for (_i = 0; _i < (m); _i++) { \ 7551a454edSToby Isaac for (_k = 0; _k < (c); _k++) { \ 7651a454edSToby Isaac (y)[_i * (c) + _k] = 0.; \ 7751a454edSToby Isaac } \ 7851a454edSToby Isaac for (_j = 0; _j < (n); _j++) { \ 7951a454edSToby Isaac for (_k = 0; _k < (c); _k++) { \ 8051a454edSToby Isaac (y)[_i * (c) + _k] += (A)[(_i * (n) + _j) * (c) + _k] * cast((b)[_j]); \ 8151a454edSToby Isaac } \ 8251a454edSToby Isaac } \ 8351a454edSToby Isaac } \ 8451a454edSToby Isaac } while (0) 8551a454edSToby Isaac 86*6858538eSMatthew G. Knepley /* 87*6858538eSMatthew G. Knepley Since this is used for coordinates, we need to allow for the possibility that values come from multiple sections/Vecs, so that we can have DG version of the coordinates for periodicity. This reproduces DMPlexGetCellCoordinates_Internal(). 88*6858538eSMatthew G. Knepley */ 89*6858538eSMatthew G. Knepley PetscErrorCode DMFieldGetClosure_Internal(DMField field, PetscInt cell, PetscBool *isDG, PetscInt *Nc, const PetscScalar *array[], PetscScalar *values[]) 90*6858538eSMatthew G. Knepley { 91*6858538eSMatthew G. Knepley DMField_DS *dsfield = (DMField_DS *) field->data; 92*6858538eSMatthew G. Knepley DM fdm = dsfield->dmDG; 93*6858538eSMatthew G. Knepley PetscSection s = NULL; 94*6858538eSMatthew G. Knepley const PetscScalar *cvalues; 95*6858538eSMatthew G. Knepley PetscInt pStart, pEnd; 96*6858538eSMatthew G. Knepley 97*6858538eSMatthew G. Knepley PetscFunctionBeginHot; 98*6858538eSMatthew G. Knepley *isDG = PETSC_FALSE; 99*6858538eSMatthew G. Knepley *Nc = 0; 100*6858538eSMatthew G. Knepley *array = NULL; 101*6858538eSMatthew G. Knepley *values = NULL; 102*6858538eSMatthew G. Knepley /* Check for cellwise section */ 103*6858538eSMatthew G. Knepley if (fdm) PetscCall(DMGetLocalSection(fdm, &s)); 104*6858538eSMatthew G. Knepley if (!s) goto cg; 105*6858538eSMatthew G. Knepley /* Check that the cell exists in the cellwise section */ 106*6858538eSMatthew G. Knepley PetscCall(PetscSectionGetChart(s, &pStart, &pEnd)); 107*6858538eSMatthew G. Knepley if (cell < pStart || cell >= pEnd) goto cg; 108*6858538eSMatthew G. Knepley /* Check for cellwise coordinates for this cell */ 109*6858538eSMatthew G. Knepley PetscCall(PetscSectionGetDof(s, cell, Nc)); 110*6858538eSMatthew G. Knepley if (!*Nc) goto cg; 111*6858538eSMatthew G. Knepley /* Check for cellwise coordinates */ 112*6858538eSMatthew G. Knepley if (!dsfield->vecDG) goto cg; 113*6858538eSMatthew G. Knepley /* Get cellwise coordinates */ 114*6858538eSMatthew G. Knepley PetscCall(VecGetArrayRead(dsfield->vecDG, array)); 115*6858538eSMatthew G. Knepley PetscCall(DMPlexPointLocalRead(fdm, cell, *array, &cvalues)); 116*6858538eSMatthew G. Knepley PetscCall(DMGetWorkArray(fdm, *Nc, MPIU_SCALAR, values)); 117*6858538eSMatthew G. Knepley PetscCall(PetscArraycpy(*values, cvalues, *Nc)); 118*6858538eSMatthew G. Knepley PetscCall(VecRestoreArrayRead(dsfield->vecDG, array)); 119*6858538eSMatthew G. Knepley *isDG = PETSC_TRUE; 120*6858538eSMatthew G. Knepley PetscFunctionReturn(0); 121*6858538eSMatthew G. Knepley cg: 122*6858538eSMatthew G. Knepley /* Use continuous values */ 123*6858538eSMatthew G. Knepley PetscCall(DMFieldGetDM(field, &fdm)); 124*6858538eSMatthew G. Knepley PetscCall(DMGetLocalSection(fdm, &s)); 125*6858538eSMatthew G. Knepley PetscCall(DMPlexVecGetClosure(fdm, s, dsfield->vec, cell, Nc, values)); 126*6858538eSMatthew G. Knepley PetscFunctionReturn(0); 127*6858538eSMatthew G. Knepley } 128*6858538eSMatthew G. Knepley 129*6858538eSMatthew G. Knepley PetscErrorCode DMFieldRestoreClosure_Internal(DMField field, PetscInt cell, PetscBool *isDG, PetscInt *Nc, const PetscScalar *array[], PetscScalar *values[]) 130*6858538eSMatthew G. Knepley { 131*6858538eSMatthew G. Knepley DMField_DS *dsfield = (DMField_DS *) field->data; 132*6858538eSMatthew G. Knepley DM fdm; 133*6858538eSMatthew G. Knepley PetscSection s; 134*6858538eSMatthew G. Knepley 135*6858538eSMatthew G. Knepley PetscFunctionBeginHot; 136*6858538eSMatthew G. Knepley if (*isDG) { 137*6858538eSMatthew G. Knepley PetscCall(DMRestoreWorkArray(dsfield->dmDG, *Nc, MPIU_SCALAR, values)); 138*6858538eSMatthew G. Knepley } else { 139*6858538eSMatthew G. Knepley PetscCall(DMFieldGetDM(field, &fdm)); 140*6858538eSMatthew G. Knepley PetscCall(DMGetLocalSection(fdm, &s)); 141*6858538eSMatthew G. Knepley PetscCall(DMPlexVecRestoreClosure(fdm, s, dsfield->vec, cell, Nc, (PetscScalar **) values)); 142*6858538eSMatthew G. Knepley } 143*6858538eSMatthew G. Knepley PetscFunctionReturn(0); 144*6858538eSMatthew G. Knepley } 145*6858538eSMatthew G. Knepley 146ef0bb6c7SMatthew G. Knepley /* TODO: Reorganize interface so that I can reuse a tabulation rather than mallocing each time */ 14751a454edSToby Isaac static PetscErrorCode DMFieldEvaluateFE_DS(DMField field, IS pointIS, PetscQuadrature quad, PetscDataType type, void *B, void *D, void *H) 14851a454edSToby Isaac { 14951a454edSToby Isaac DMField_DS *dsfield = (DMField_DS *) field->data; 15051a454edSToby Isaac DM dm; 15151a454edSToby Isaac PetscObject disc; 15251a454edSToby Isaac PetscClassId classid; 15351a454edSToby Isaac PetscInt nq, nc, dim, meshDim, numCells; 15451a454edSToby Isaac PetscSection section; 15551a454edSToby Isaac const PetscReal *qpoints; 15651a454edSToby Isaac PetscBool isStride; 15751a454edSToby Isaac const PetscInt *points = NULL; 15851a454edSToby Isaac PetscInt sfirst = -1, stride = -1; 15951a454edSToby Isaac 16051a454edSToby Isaac PetscFunctionBeginHot; 16151a454edSToby Isaac dm = field->dm; 16251a454edSToby Isaac nc = field->numComponents; 1639566063dSJacob Faibussowitsch PetscCall(PetscQuadratureGetData(quad,&dim,NULL,&nq,&qpoints,NULL)); 164*6858538eSMatthew G. Knepley PetscCall(DMFieldDSGetHeightDisc(field, dsfield->height - 1 - dim, dsfield->disc, &disc)); 1659566063dSJacob Faibussowitsch PetscCall(DMGetDimension(dm,&meshDim)); 1669566063dSJacob Faibussowitsch PetscCall(DMGetLocalSection(dm,§ion)); 1679566063dSJacob Faibussowitsch PetscCall(PetscSectionGetField(section,dsfield->fieldNum,§ion)); 1689566063dSJacob Faibussowitsch PetscCall(PetscObjectGetClassId(disc,&classid)); 16951a454edSToby Isaac /* TODO: batch */ 1709566063dSJacob Faibussowitsch PetscCall(PetscObjectTypeCompare((PetscObject)pointIS,ISSTRIDE,&isStride)); 1719566063dSJacob Faibussowitsch PetscCall(ISGetLocalSize(pointIS,&numCells)); 1721baa6e33SBarry Smith if (isStride) PetscCall(ISStrideGetInfo(pointIS,&sfirst,&stride)); 1731baa6e33SBarry Smith else PetscCall(ISGetIndices(pointIS,&points)); 17451a454edSToby Isaac if (classid == PETSCFE_CLASSID) { 17551a454edSToby Isaac PetscFE fe = (PetscFE) disc; 17651a454edSToby Isaac PetscInt feDim, i; 177ef0bb6c7SMatthew G. Knepley PetscInt K = H ? 2 : (D ? 1 : (B ? 0 : -1)); 178ef0bb6c7SMatthew G. Knepley PetscTabulation T; 17951a454edSToby Isaac 1809566063dSJacob Faibussowitsch PetscCall(PetscFEGetDimension(fe,&feDim)); 1819566063dSJacob Faibussowitsch PetscCall(PetscFECreateTabulation(fe,1,nq,qpoints,K,&T)); 18251a454edSToby Isaac for (i = 0; i < numCells; i++) { 18351a454edSToby Isaac PetscInt c = isStride ? (sfirst + i * stride) : points[i]; 1842710589cSToby Isaac PetscInt closureSize; 185*6858538eSMatthew G. Knepley const PetscScalar *array; 1862710589cSToby Isaac PetscScalar *elem = NULL; 187*6858538eSMatthew G. Knepley PetscBool isDG; 18851a454edSToby Isaac 189*6858538eSMatthew G. Knepley PetscCall(DMFieldGetClosure_Internal(field, c, &isDG, &closureSize, &array, &elem)); 19051a454edSToby Isaac if (B) { 19162bd480fSMatthew G. Knepley /* field[c] = T[q,b,c] . coef[b], so v[c] = T[q,b,c] . coords[b] */ 19251a454edSToby Isaac if (type == PETSC_SCALAR) { 19351a454edSToby Isaac PetscScalar *cB = &((PetscScalar *) B)[nc * nq * i]; 19451a454edSToby Isaac 195ef0bb6c7SMatthew G. Knepley DMFieldDSdot(cB,T->T[0],elem,nq,feDim,nc,(PetscScalar)); 19651a454edSToby Isaac } else { 19751a454edSToby Isaac PetscReal *cB = &((PetscReal *) B)[nc * nq * i]; 19851a454edSToby Isaac 199ef0bb6c7SMatthew G. Knepley DMFieldDSdot(cB,T->T[0],elem,nq,feDim,nc,PetscRealPart); 20051a454edSToby Isaac } 20151a454edSToby Isaac } 20251a454edSToby Isaac if (D) { 20351a454edSToby Isaac if (type == PETSC_SCALAR) { 20451a454edSToby Isaac PetscScalar *cD = &((PetscScalar *) D)[nc * nq * dim * i]; 20551a454edSToby Isaac 206ef0bb6c7SMatthew G. Knepley DMFieldDSdot(cD,T->T[1],elem,nq,feDim,(nc * dim),(PetscScalar)); 20751a454edSToby Isaac } else { 20851a454edSToby Isaac PetscReal *cD = &((PetscReal *) D)[nc * nq * dim * i]; 20951a454edSToby Isaac 210ef0bb6c7SMatthew G. Knepley DMFieldDSdot(cD,T->T[1],elem,nq,feDim,(nc * dim),PetscRealPart); 21151a454edSToby Isaac } 21251a454edSToby Isaac } 21351a454edSToby Isaac if (H) { 21451a454edSToby Isaac if (type == PETSC_SCALAR) { 21551a454edSToby Isaac PetscScalar *cH = &((PetscScalar *) H)[nc * nq * dim * dim * i]; 21651a454edSToby Isaac 217ef0bb6c7SMatthew G. Knepley DMFieldDSdot(cH,T->T[2],elem,nq,feDim,(nc * dim * dim),(PetscScalar)); 21851a454edSToby Isaac } else { 21951a454edSToby Isaac PetscReal *cH = &((PetscReal *) H)[nc * nq * dim * dim * i]; 22051a454edSToby Isaac 221ef0bb6c7SMatthew G. Knepley DMFieldDSdot(cH,T->T[2],elem,nq,feDim,(nc * dim * dim),PetscRealPart); 22251a454edSToby Isaac } 22351a454edSToby Isaac } 224*6858538eSMatthew G. Knepley PetscCall(DMFieldRestoreClosure_Internal(field, c, &isDG, &closureSize, &array, &elem)); 22551a454edSToby Isaac } 2269566063dSJacob Faibussowitsch PetscCall(PetscTabulationDestroy(&T)); 2272da392ccSBarry Smith } else SETERRQ(PetscObjectComm((PetscObject)field),PETSC_ERR_SUP,"Not implemented"); 22851a454edSToby Isaac if (!isStride) { 2299566063dSJacob Faibussowitsch PetscCall(ISRestoreIndices(pointIS,&points)); 23051a454edSToby Isaac } 23151a454edSToby Isaac PetscFunctionReturn(0); 23251a454edSToby Isaac } 23351a454edSToby Isaac 234a6216909SToby Isaac static PetscErrorCode DMFieldEvaluate_DS(DMField field, Vec points, PetscDataType datatype, void *B, void *D, void *H) 235a6216909SToby Isaac { 236a6216909SToby Isaac DMField_DS *dsfield = (DMField_DS *) field->data; 237a6216909SToby Isaac PetscSF cellSF = NULL; 238a6216909SToby Isaac const PetscSFNode *cells; 239a6216909SToby Isaac PetscInt c, nFound, numCells, feDim, nc; 240a6216909SToby Isaac const PetscInt *cellDegrees; 241a6216909SToby Isaac const PetscScalar *pointsArray; 242a6216909SToby Isaac PetscScalar *cellPoints; 243a6216909SToby Isaac PetscInt gatherSize, gatherMax; 244a6216909SToby Isaac PetscInt dim, dimR, offset; 245a6216909SToby Isaac MPI_Datatype pointType; 246a6216909SToby Isaac PetscObject cellDisc; 247a6216909SToby Isaac PetscFE cellFE; 248a6216909SToby Isaac PetscClassId discID; 249a6216909SToby Isaac PetscReal *coordsReal, *coordsRef; 250a6216909SToby Isaac PetscSection section; 251a6216909SToby Isaac PetscScalar *cellBs = NULL, *cellDs = NULL, *cellHs = NULL; 252a6216909SToby Isaac PetscReal *cellBr = NULL, *cellDr = NULL, *cellHr = NULL; 2534cbe5319SToby Isaac PetscReal *v, *J, *invJ, *detJ; 254a6216909SToby Isaac 255a6216909SToby Isaac PetscFunctionBegin; 256a6216909SToby Isaac nc = field->numComponents; 2579566063dSJacob Faibussowitsch PetscCall(DMGetLocalSection(field->dm,§ion)); 258*6858538eSMatthew G. Knepley PetscCall(DMFieldDSGetHeightDisc(field, 0, dsfield->disc, &cellDisc)); 2599566063dSJacob Faibussowitsch PetscCall(PetscObjectGetClassId(cellDisc, &discID)); 26008401ef6SPierre Jolivet PetscCheck(discID == PETSCFE_CLASSID,PETSC_COMM_SELF,PETSC_ERR_PLIB, "Discretization type not supported"); 261a6216909SToby Isaac cellFE = (PetscFE) cellDisc; 2629566063dSJacob Faibussowitsch PetscCall(PetscFEGetDimension(cellFE,&feDim)); 2639566063dSJacob Faibussowitsch PetscCall(DMGetCoordinateDim(field->dm, &dim)); 2649566063dSJacob Faibussowitsch PetscCall(DMGetDimension(field->dm, &dimR)); 2659566063dSJacob Faibussowitsch PetscCall(DMLocatePoints(field->dm, points, DM_POINTLOCATION_NONE, &cellSF)); 2669566063dSJacob Faibussowitsch PetscCall(PetscSFGetGraph(cellSF, &numCells, &nFound, NULL, &cells)); 267a6216909SToby Isaac for (c = 0; c < nFound; c++) { 26863a3b9bcSJacob Faibussowitsch PetscCheck(cells[c].index >= 0,PetscObjectComm((PetscObject)points),PETSC_ERR_ARG_WRONG, "Point %" PetscInt_FMT " could not be located", c); 269a6216909SToby Isaac } 2709566063dSJacob Faibussowitsch PetscCall(PetscSFComputeDegreeBegin(cellSF,&cellDegrees)); 2719566063dSJacob Faibussowitsch PetscCall(PetscSFComputeDegreeEnd(cellSF,&cellDegrees)); 272a6216909SToby Isaac for (c = 0, gatherSize = 0, gatherMax = 0; c < numCells; c++) { 273a6216909SToby Isaac gatherMax = PetscMax(gatherMax,cellDegrees[c]); 274a6216909SToby Isaac gatherSize += cellDegrees[c]; 275a6216909SToby Isaac } 2769566063dSJacob Faibussowitsch PetscCall(PetscMalloc3(gatherSize*dim,&cellPoints,gatherMax*dim,&coordsReal,gatherMax*dimR,&coordsRef)); 2779566063dSJacob Faibussowitsch PetscCall(PetscMalloc4(gatherMax*dimR,&v,gatherMax*dimR*dimR,&J,gatherMax*dimR*dimR,&invJ,gatherMax,&detJ)); 2781baa6e33SBarry Smith if (datatype == PETSC_SCALAR) PetscCall(PetscMalloc3(B ? nc * gatherSize : 0, &cellBs, D ? nc * dim * gatherSize : 0, &cellDs, H ? nc * dim * dim * gatherSize : 0, &cellHs)); 2791baa6e33SBarry Smith else PetscCall(PetscMalloc3(B ? nc * gatherSize : 0, &cellBr, D ? nc * dim * gatherSize : 0, &cellDr, H ? nc * dim * dim * gatherSize : 0, &cellHr)); 280a6216909SToby Isaac 2819566063dSJacob Faibussowitsch PetscCallMPI(MPI_Type_contiguous(dim,MPIU_SCALAR,&pointType)); 2829566063dSJacob Faibussowitsch PetscCallMPI(MPI_Type_commit(&pointType)); 2839566063dSJacob Faibussowitsch PetscCall(VecGetArrayRead(points,&pointsArray)); 2849566063dSJacob Faibussowitsch PetscCall(PetscSFGatherBegin(cellSF, pointType, pointsArray, cellPoints)); 2859566063dSJacob Faibussowitsch PetscCall(PetscSFGatherEnd(cellSF, pointType, pointsArray, cellPoints)); 2869566063dSJacob Faibussowitsch PetscCall(VecRestoreArrayRead(points,&pointsArray)); 287a6216909SToby Isaac for (c = 0, offset = 0; c < numCells; c++) { 288a6216909SToby Isaac PetscInt nq = cellDegrees[c], p; 289a6216909SToby Isaac 290a6216909SToby Isaac if (nq) { 291ef0bb6c7SMatthew G. Knepley PetscInt K = H ? 2 : (D ? 1 : (B ? 0 : -1)); 292ef0bb6c7SMatthew G. Knepley PetscTabulation T; 293*6858538eSMatthew G. Knepley PetscQuadrature quad; 294*6858538eSMatthew G. Knepley const PetscScalar *array; 295a6216909SToby Isaac PetscScalar *elem = NULL; 2964cbe5319SToby Isaac PetscReal *quadPoints; 297*6858538eSMatthew G. Knepley PetscBool isDG; 298*6858538eSMatthew G. Knepley PetscInt closureSize, d, e, f, g; 299a6216909SToby Isaac 3004d1a973fSToby Isaac for (p = 0; p < dim * nq; p++) coordsReal[p] = PetscRealPart(cellPoints[dim * offset + p]); 3019566063dSJacob Faibussowitsch PetscCall(DMPlexCoordinatesToReference(field->dm, c, nq, coordsReal, coordsRef)); 3029566063dSJacob Faibussowitsch PetscCall(PetscFECreateTabulation(cellFE,1,nq,coordsRef,K,&T)); 3039566063dSJacob Faibussowitsch PetscCall(PetscQuadratureCreate(PETSC_COMM_SELF, &quad)); 3049566063dSJacob Faibussowitsch PetscCall(PetscMalloc1(dimR * nq, &quadPoints)); 3054cbe5319SToby Isaac for (p = 0; p < dimR * nq; p++) quadPoints[p] = coordsRef[p]; 3069566063dSJacob Faibussowitsch PetscCall(PetscQuadratureSetData(quad, dimR, 0, nq, quadPoints, NULL)); 3079566063dSJacob Faibussowitsch PetscCall(DMPlexComputeCellGeometryFEM(field->dm, c, quad, v, J, invJ, detJ)); 3089566063dSJacob Faibussowitsch PetscCall(PetscQuadratureDestroy(&quad)); 309*6858538eSMatthew G. Knepley PetscCall(DMFieldGetClosure_Internal(field, c, &isDG, &closureSize, &array, &elem)); 310a6216909SToby Isaac if (B) { 311a6216909SToby Isaac if (datatype == PETSC_SCALAR) { 312a6216909SToby Isaac PetscScalar *cB = &cellBs[nc * offset]; 313a6216909SToby Isaac 314ef0bb6c7SMatthew G. Knepley DMFieldDSdot(cB,T->T[0],elem,nq,feDim,nc,(PetscScalar)); 315a6216909SToby Isaac } else { 316a6216909SToby Isaac PetscReal *cB = &cellBr[nc * offset]; 317a6216909SToby Isaac 318ef0bb6c7SMatthew G. Knepley DMFieldDSdot(cB,T->T[0],elem,nq,feDim,nc,PetscRealPart); 319a6216909SToby Isaac } 320a6216909SToby Isaac } 321a6216909SToby Isaac if (D) { 322a6216909SToby Isaac if (datatype == PETSC_SCALAR) { 323a6216909SToby Isaac PetscScalar *cD = &cellDs[nc * dim * offset]; 324a6216909SToby Isaac 325ef0bb6c7SMatthew G. Knepley DMFieldDSdot(cD,T->T[1],elem,nq,feDim,(nc * dim),(PetscScalar)); 3264cbe5319SToby Isaac for (p = 0; p < nq; p++) { 3274cbe5319SToby Isaac for (g = 0; g < nc; g++) { 3284d1a973fSToby Isaac PetscScalar vs[3]; 3294d1a973fSToby Isaac 3304cbe5319SToby Isaac for (d = 0; d < dimR; d++) { 3314d1a973fSToby Isaac vs[d] = 0.; 3324cbe5319SToby Isaac for (e = 0; e < dimR; e++) { 3334d1a973fSToby Isaac vs[d] += invJ[dimR * dimR * p + e * dimR + d] * cD[(nc * p + g) * dimR + e]; 3344cbe5319SToby Isaac } 3354cbe5319SToby Isaac } 3364cbe5319SToby Isaac for (d = 0; d < dimR; d++) { 3374d1a973fSToby Isaac cD[(nc * p + g) * dimR + d] = vs[d]; 3384cbe5319SToby Isaac } 3394cbe5319SToby Isaac } 3404cbe5319SToby Isaac } 341a6216909SToby Isaac } else { 342a6216909SToby Isaac PetscReal *cD = &cellDr[nc * dim * offset]; 343a6216909SToby Isaac 344ef0bb6c7SMatthew G. Knepley DMFieldDSdot(cD,T->T[1],elem,nq,feDim,(nc * dim),PetscRealPart); 3454cbe5319SToby Isaac for (p = 0; p < nq; p++) { 3464cbe5319SToby Isaac for (g = 0; g < nc; g++) { 3474cbe5319SToby Isaac for (d = 0; d < dimR; d++) { 3484cbe5319SToby Isaac v[d] = 0.; 3494cbe5319SToby Isaac for (e = 0; e < dimR; e++) { 3504cbe5319SToby Isaac v[d] += invJ[dimR * dimR * p + e * dimR + d] * cD[(nc * p + g) * dimR + e]; 3514cbe5319SToby Isaac } 3524cbe5319SToby Isaac } 3534cbe5319SToby Isaac for (d = 0; d < dimR; d++) { 3544cbe5319SToby Isaac cD[(nc * p + g) * dimR + d] = v[d]; 3554cbe5319SToby Isaac } 3564cbe5319SToby Isaac } 3574cbe5319SToby Isaac } 358a6216909SToby Isaac } 359a6216909SToby Isaac } 360a6216909SToby Isaac if (H) { 361a6216909SToby Isaac if (datatype == PETSC_SCALAR) { 362a6216909SToby Isaac PetscScalar *cH = &cellHs[nc * dim * dim * offset]; 363a6216909SToby Isaac 364ef0bb6c7SMatthew G. Knepley DMFieldDSdot(cH,T->T[2],elem,nq,feDim,(nc * dim * dim),(PetscScalar)); 3654cbe5319SToby Isaac for (p = 0; p < nq; p++) { 3664cbe5319SToby Isaac for (g = 0; g < nc * dimR; g++) { 3674d1a973fSToby Isaac PetscScalar vs[3]; 3684d1a973fSToby Isaac 3694cbe5319SToby Isaac for (d = 0; d < dimR; d++) { 3704d1a973fSToby Isaac vs[d] = 0.; 3714cbe5319SToby Isaac for (e = 0; e < dimR; e++) { 3724d1a973fSToby Isaac vs[d] += invJ[dimR * dimR * p + e * dimR + d] * cH[(nc * dimR * p + g) * dimR + e]; 3734cbe5319SToby Isaac } 3744cbe5319SToby Isaac } 3754cbe5319SToby Isaac for (d = 0; d < dimR; d++) { 3764d1a973fSToby Isaac cH[(nc * dimR * p + g) * dimR + d] = vs[d]; 3774cbe5319SToby Isaac } 3784cbe5319SToby Isaac } 3794cbe5319SToby Isaac for (g = 0; g < nc; g++) { 3804cbe5319SToby Isaac for (f = 0; f < dimR; f++) { 3814d1a973fSToby Isaac PetscScalar vs[3]; 3824d1a973fSToby Isaac 3834cbe5319SToby Isaac for (d = 0; d < dimR; d++) { 3844d1a973fSToby Isaac vs[d] = 0.; 3854cbe5319SToby Isaac for (e = 0; e < dimR; e++) { 3864d1a973fSToby Isaac vs[d] += invJ[dimR * dimR * p + e * dimR + d] * cH[((nc * p + g) * dimR + e) * dimR + f]; 3874cbe5319SToby Isaac } 3884cbe5319SToby Isaac } 3894cbe5319SToby Isaac for (d = 0; d < dimR; d++) { 3904d1a973fSToby Isaac cH[((nc * p + g) * dimR + d) * dimR + f] = vs[d]; 3914cbe5319SToby Isaac } 3924cbe5319SToby Isaac } 3934cbe5319SToby Isaac } 3944cbe5319SToby Isaac } 395a6216909SToby Isaac } else { 396a6216909SToby Isaac PetscReal *cH = &cellHr[nc * dim * dim * offset]; 397a6216909SToby Isaac 398ef0bb6c7SMatthew G. Knepley DMFieldDSdot(cH,T->T[2],elem,nq,feDim,(nc * dim * dim),PetscRealPart); 3994cbe5319SToby Isaac for (p = 0; p < nq; p++) { 4004cbe5319SToby Isaac for (g = 0; g < nc * dimR; g++) { 4014cbe5319SToby Isaac for (d = 0; d < dimR; d++) { 4024cbe5319SToby Isaac v[d] = 0.; 4034cbe5319SToby Isaac for (e = 0; e < dimR; e++) { 4044cbe5319SToby Isaac v[d] += invJ[dimR * dimR * p + e * dimR + d] * cH[(nc * dimR * p + g) * dimR + e]; 4054cbe5319SToby Isaac } 4064cbe5319SToby Isaac } 4074cbe5319SToby Isaac for (d = 0; d < dimR; d++) { 4084cbe5319SToby Isaac cH[(nc * dimR * p + g) * dimR + d] = v[d]; 4094cbe5319SToby Isaac } 4104cbe5319SToby Isaac } 4114cbe5319SToby Isaac for (g = 0; g < nc; g++) { 4124cbe5319SToby Isaac for (f = 0; f < dimR; f++) { 4134cbe5319SToby Isaac for (d = 0; d < dimR; d++) { 4144cbe5319SToby Isaac v[d] = 0.; 4154cbe5319SToby Isaac for (e = 0; e < dimR; e++) { 4164cbe5319SToby Isaac v[d] += invJ[dimR * dimR * p + e * dimR + d] * cH[((nc * p + g) * dimR + e) * dimR + f]; 4174cbe5319SToby Isaac } 4184cbe5319SToby Isaac } 4194cbe5319SToby Isaac for (d = 0; d < dimR; d++) { 4204cbe5319SToby Isaac cH[((nc * p + g) * dimR + d) * dimR + f] = v[d]; 4214cbe5319SToby Isaac } 4224cbe5319SToby Isaac } 4234cbe5319SToby Isaac } 4244cbe5319SToby Isaac } 425a6216909SToby Isaac } 426a6216909SToby Isaac } 427*6858538eSMatthew G. Knepley PetscCall(DMFieldRestoreClosure_Internal(field, c, &isDG, &closureSize, &array, &elem)); 4289566063dSJacob Faibussowitsch PetscCall(PetscTabulationDestroy(&T)); 429a6216909SToby Isaac } 430a6216909SToby Isaac offset += nq; 431a6216909SToby Isaac } 432a6216909SToby Isaac { 433a6216909SToby Isaac MPI_Datatype origtype; 4344cbe5319SToby Isaac 435a6216909SToby Isaac if (datatype == PETSC_SCALAR) { 436a6216909SToby Isaac origtype = MPIU_SCALAR; 437a6216909SToby Isaac } else { 438a6216909SToby Isaac origtype = MPIU_REAL; 439a6216909SToby Isaac } 440a6216909SToby Isaac if (B) { 441a6216909SToby Isaac MPI_Datatype Btype; 442a6216909SToby Isaac 4439566063dSJacob Faibussowitsch PetscCallMPI(MPI_Type_contiguous(nc, origtype, &Btype)); 4449566063dSJacob Faibussowitsch PetscCallMPI(MPI_Type_commit(&Btype)); 4459566063dSJacob Faibussowitsch PetscCall(PetscSFScatterBegin(cellSF,Btype,(datatype == PETSC_SCALAR) ? (void *) cellBs : (void *) cellBr, B)); 4469566063dSJacob Faibussowitsch PetscCall(PetscSFScatterEnd(cellSF,Btype,(datatype == PETSC_SCALAR) ? (void *) cellBs : (void *) cellBr, B)); 4479566063dSJacob Faibussowitsch PetscCallMPI(MPI_Type_free(&Btype)); 448a6216909SToby Isaac } 449a6216909SToby Isaac if (D) { 450a6216909SToby Isaac MPI_Datatype Dtype; 451a6216909SToby Isaac 4529566063dSJacob Faibussowitsch PetscCallMPI(MPI_Type_contiguous(nc * dim, origtype, &Dtype)); 4539566063dSJacob Faibussowitsch PetscCallMPI(MPI_Type_commit(&Dtype)); 4549566063dSJacob Faibussowitsch PetscCall(PetscSFScatterBegin(cellSF,Dtype,(datatype == PETSC_SCALAR) ? (void *) cellDs : (void *) cellDr, D)); 4559566063dSJacob Faibussowitsch PetscCall(PetscSFScatterEnd(cellSF,Dtype,(datatype == PETSC_SCALAR) ? (void *) cellDs : (void *) cellDr, D)); 4569566063dSJacob Faibussowitsch PetscCallMPI(MPI_Type_free(&Dtype)); 457a6216909SToby Isaac } 458a6216909SToby Isaac if (H) { 459a6216909SToby Isaac MPI_Datatype Htype; 460a6216909SToby Isaac 4619566063dSJacob Faibussowitsch PetscCallMPI(MPI_Type_contiguous(nc * dim * dim, origtype, &Htype)); 4629566063dSJacob Faibussowitsch PetscCallMPI(MPI_Type_commit(&Htype)); 4639566063dSJacob Faibussowitsch PetscCall(PetscSFScatterBegin(cellSF,Htype,(datatype == PETSC_SCALAR) ? (void *) cellHs : (void *) cellHr, H)); 4649566063dSJacob Faibussowitsch PetscCall(PetscSFScatterEnd(cellSF,Htype,(datatype == PETSC_SCALAR) ? (void *) cellHs : (void *) cellHr, H)); 4659566063dSJacob Faibussowitsch PetscCallMPI(MPI_Type_free(&Htype)); 466a6216909SToby Isaac } 467a6216909SToby Isaac } 4689566063dSJacob Faibussowitsch PetscCall(PetscFree4(v,J,invJ,detJ)); 4699566063dSJacob Faibussowitsch PetscCall(PetscFree3(cellBr, cellDr, cellHr)); 4709566063dSJacob Faibussowitsch PetscCall(PetscFree3(cellBs, cellDs, cellHs)); 4719566063dSJacob Faibussowitsch PetscCall(PetscFree3(cellPoints,coordsReal,coordsRef)); 4729566063dSJacob Faibussowitsch PetscCallMPI(MPI_Type_free(&pointType)); 4739566063dSJacob Faibussowitsch PetscCall(PetscSFDestroy(&cellSF)); 474a6216909SToby Isaac PetscFunctionReturn(0); 475a6216909SToby Isaac } 476a6216909SToby Isaac 477805e7170SToby Isaac static PetscErrorCode DMFieldEvaluateFV_DS(DMField field, IS pointIS, PetscDataType type, void *B, void *D, void *H) 478805e7170SToby Isaac { 479805e7170SToby Isaac DMField_DS *dsfield = (DMField_DS *) field->data; 480805e7170SToby Isaac PetscInt h, imin; 481805e7170SToby Isaac PetscInt dim; 482805e7170SToby Isaac PetscClassId id; 483805e7170SToby Isaac PetscQuadrature quad = NULL; 484b7260050SToby Isaac PetscInt maxDegree; 485805e7170SToby Isaac PetscFEGeom *geom; 486805e7170SToby Isaac PetscInt Nq, Nc, dimC, qNc, N; 487805e7170SToby Isaac PetscInt numPoints; 488805e7170SToby Isaac void *qB = NULL, *qD = NULL, *qH = NULL; 489805e7170SToby Isaac const PetscReal *weights; 490805e7170SToby Isaac MPI_Datatype mpitype = type == PETSC_SCALAR ? MPIU_SCALAR : MPIU_REAL; 491805e7170SToby Isaac PetscObject disc; 492805e7170SToby Isaac DMField coordField; 493805e7170SToby Isaac 494805e7170SToby Isaac PetscFunctionBegin; 495805e7170SToby Isaac Nc = field->numComponents; 4969566063dSJacob Faibussowitsch PetscCall(DMGetCoordinateDim(field->dm, &dimC)); 4979566063dSJacob Faibussowitsch PetscCall(DMGetDimension(field->dm, &dim)); 4989566063dSJacob Faibussowitsch PetscCall(ISGetLocalSize(pointIS, &numPoints)); 4999566063dSJacob Faibussowitsch PetscCall(ISGetMinMax(pointIS,&imin,NULL)); 500805e7170SToby Isaac for (h = 0; h < dsfield->height; h++) { 501805e7170SToby Isaac PetscInt hEnd; 502805e7170SToby Isaac 5039566063dSJacob Faibussowitsch PetscCall(DMPlexGetHeightStratum(field->dm,h,NULL,&hEnd)); 504805e7170SToby Isaac if (imin < hEnd) break; 505805e7170SToby Isaac } 506805e7170SToby Isaac dim -= h; 507*6858538eSMatthew G. Knepley PetscCall(DMFieldDSGetHeightDisc(field, h, dsfield->disc, &disc)); 5089566063dSJacob Faibussowitsch PetscCall(PetscObjectGetClassId(disc,&id)); 50908401ef6SPierre Jolivet PetscCheck(id == PETSCFE_CLASSID,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Discretization not supported"); 5109566063dSJacob Faibussowitsch PetscCall(DMGetCoordinateField(field->dm, &coordField)); 5119566063dSJacob Faibussowitsch PetscCall(DMFieldGetDegree(coordField, pointIS, NULL, &maxDegree)); 512b7260050SToby Isaac if (maxDegree <= 1) { 5139566063dSJacob Faibussowitsch PetscCall(DMFieldCreateDefaultQuadrature(coordField, pointIS, &quad)); 514805e7170SToby Isaac } 5159566063dSJacob Faibussowitsch if (!quad) PetscCall(DMFieldCreateDefaultQuadrature(field, pointIS, &quad)); 51628b400f6SJacob Faibussowitsch PetscCheck(quad,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Could not determine quadrature for cell averages"); 5179566063dSJacob Faibussowitsch PetscCall(DMFieldCreateFEGeom(coordField,pointIS,quad,PETSC_FALSE,&geom)); 5189566063dSJacob Faibussowitsch PetscCall(PetscQuadratureGetData(quad, NULL, &qNc, &Nq, NULL, &weights)); 51908401ef6SPierre Jolivet PetscCheck(qNc == 1,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Expected scalar quadrature components"); 520805e7170SToby Isaac N = numPoints * Nq * Nc; 5219566063dSJacob Faibussowitsch if (B) PetscCall(DMGetWorkArray(field->dm, N, mpitype, &qB)); 5229566063dSJacob Faibussowitsch if (D) PetscCall(DMGetWorkArray(field->dm, N * dimC, mpitype, &qD)); 5239566063dSJacob Faibussowitsch if (H) PetscCall(DMGetWorkArray(field->dm, N * dimC * dimC, mpitype, &qH)); 5249566063dSJacob Faibussowitsch PetscCall(DMFieldEvaluateFE(field,pointIS,quad,type,qB,qD,qH)); 525805e7170SToby Isaac if (B) { 526805e7170SToby Isaac PetscInt i, j, k; 527805e7170SToby Isaac 528805e7170SToby Isaac if (type == PETSC_SCALAR) { 529805e7170SToby Isaac PetscScalar * sB = (PetscScalar *) B; 530805e7170SToby Isaac PetscScalar * sqB = (PetscScalar *) qB; 531805e7170SToby Isaac 532805e7170SToby Isaac for (i = 0; i < numPoints; i++) { 533805e7170SToby Isaac PetscReal vol = 0.; 534805e7170SToby Isaac 535805e7170SToby Isaac for (j = 0; j < Nc; j++) {sB[i * Nc + j] = 0.;} 536805e7170SToby Isaac for (k = 0; k < Nq; k++) { 537805e7170SToby Isaac vol += geom->detJ[i * Nq + k] * weights[k]; 538805e7170SToby Isaac for (j = 0; j < Nc; j++) { 539805e7170SToby Isaac sB[i * Nc + j] += geom->detJ[i * Nq + k] * weights[k] * sqB[ (i * Nq + k) * Nc + j]; 540805e7170SToby Isaac } 541805e7170SToby Isaac } 54262bd480fSMatthew G. Knepley for (k = 0; k < Nc; k++) sB[i * Nc + k] /= vol; 543805e7170SToby Isaac } 544805e7170SToby Isaac } else { 545805e7170SToby Isaac PetscReal * rB = (PetscReal *) B; 546805e7170SToby Isaac PetscReal * rqB = (PetscReal *) qB; 547805e7170SToby Isaac 548805e7170SToby Isaac for (i = 0; i < numPoints; i++) { 549805e7170SToby Isaac PetscReal vol = 0.; 550805e7170SToby Isaac 551805e7170SToby Isaac for (j = 0; j < Nc; j++) {rB[i * Nc + j] = 0.;} 552805e7170SToby Isaac for (k = 0; k < Nq; k++) { 553805e7170SToby Isaac vol += geom->detJ[i * Nq + k] * weights[k]; 554805e7170SToby Isaac for (j = 0; j < Nc; j++) { 555805e7170SToby Isaac rB[i * Nc + j] += weights[k] * rqB[ (i * Nq + k) * Nc + j]; 556805e7170SToby Isaac } 557805e7170SToby Isaac } 558805e7170SToby Isaac for (k = 0; k < Nc; k++) rB[i * Nc + k] /= vol; 559805e7170SToby Isaac } 560805e7170SToby Isaac } 561805e7170SToby Isaac } 562805e7170SToby Isaac if (D) { 563805e7170SToby Isaac PetscInt i, j, k, l, m; 564805e7170SToby Isaac 565805e7170SToby Isaac if (type == PETSC_SCALAR) { 566805e7170SToby Isaac PetscScalar * sD = (PetscScalar *) D; 567805e7170SToby Isaac PetscScalar * sqD = (PetscScalar *) qD; 568805e7170SToby Isaac 569805e7170SToby Isaac for (i = 0; i < numPoints; i++) { 570805e7170SToby Isaac PetscReal vol = 0.; 571805e7170SToby Isaac 572805e7170SToby Isaac for (j = 0; j < Nc * dimC; j++) {sD[i * Nc * dimC + j] = 0.;} 573805e7170SToby Isaac for (k = 0; k < Nq; k++) { 574805e7170SToby Isaac vol += geom->detJ[i * Nq + k] * weights[k]; 575805e7170SToby Isaac for (j = 0; j < Nc; j++) { 576805e7170SToby Isaac PetscScalar pD[3] = {0.,0.,0.}; 577805e7170SToby Isaac 578805e7170SToby Isaac for (l = 0; l < dimC; l++) { 579805e7170SToby Isaac for (m = 0; m < dim; m++) { 580805e7170SToby Isaac pD[l] += geom->invJ[((i * Nq + k) * dimC + m) * dimC + l] * sqD[((i * Nq + k) * Nc + j) * dim + m]; 581805e7170SToby Isaac } 582805e7170SToby Isaac } 583805e7170SToby Isaac for (l = 0; l < dimC; l++) { 584805e7170SToby Isaac sD[(i * Nc + j) * dimC + l] += geom->detJ[i * Nq + k] * weights[k] * pD[l]; 585805e7170SToby Isaac } 586805e7170SToby Isaac } 587805e7170SToby Isaac } 588805e7170SToby Isaac for (k = 0; k < Nc * dimC; k++) sD[i * Nc * dimC + k] /= vol; 589805e7170SToby Isaac } 590805e7170SToby Isaac } else { 591805e7170SToby Isaac PetscReal * rD = (PetscReal *) D; 592805e7170SToby Isaac PetscReal * rqD = (PetscReal *) qD; 593805e7170SToby Isaac 594805e7170SToby Isaac for (i = 0; i < numPoints; i++) { 595805e7170SToby Isaac PetscReal vol = 0.; 596805e7170SToby Isaac 597805e7170SToby Isaac for (j = 0; j < Nc * dimC; j++) {rD[i * Nc * dimC + j] = 0.;} 598805e7170SToby Isaac for (k = 0; k < Nq; k++) { 599805e7170SToby Isaac vol += geom->detJ[i * Nq + k] * weights[k]; 600805e7170SToby Isaac for (j = 0; j < Nc; j++) { 601805e7170SToby Isaac PetscReal pD[3] = {0.,0.,0.}; 602805e7170SToby Isaac 603805e7170SToby Isaac for (l = 0; l < dimC; l++) { 604805e7170SToby Isaac for (m = 0; m < dim; m++) { 605805e7170SToby Isaac pD[l] += geom->invJ[((i * Nq + k) * dimC + m) * dimC + l] * rqD[((i * Nq + k) * Nc + j) * dim + m]; 606805e7170SToby Isaac } 607805e7170SToby Isaac } 608805e7170SToby Isaac for (l = 0; l < dimC; l++) { 609805e7170SToby Isaac rD[(i * Nc + j) * dimC + l] += geom->detJ[i * Nq + k] * weights[k] * pD[l]; 610805e7170SToby Isaac } 611805e7170SToby Isaac } 612805e7170SToby Isaac } 613805e7170SToby Isaac for (k = 0; k < Nc * dimC; k++) rD[i * Nc * dimC + k] /= vol; 614805e7170SToby Isaac } 615805e7170SToby Isaac } 616805e7170SToby Isaac } 617805e7170SToby Isaac if (H) { 618805e7170SToby Isaac PetscInt i, j, k, l, m, q, r; 619805e7170SToby Isaac 620805e7170SToby Isaac if (type == PETSC_SCALAR) { 621805e7170SToby Isaac PetscScalar * sH = (PetscScalar *) H; 622805e7170SToby Isaac PetscScalar * sqH = (PetscScalar *) qH; 623805e7170SToby Isaac 624805e7170SToby Isaac for (i = 0; i < numPoints; i++) { 625805e7170SToby Isaac PetscReal vol = 0.; 626805e7170SToby Isaac 627805e7170SToby Isaac for (j = 0; j < Nc * dimC * dimC; j++) {sH[i * Nc * dimC * dimC + j] = 0.;} 628805e7170SToby Isaac for (k = 0; k < Nq; k++) { 6294d1a973fSToby Isaac const PetscReal *invJ = &geom->invJ[(i * Nq + k) * dimC * dimC]; 630805e7170SToby Isaac 631805e7170SToby Isaac vol += geom->detJ[i * Nq + k] * weights[k]; 632805e7170SToby Isaac for (j = 0; j < Nc; j++) { 633805e7170SToby Isaac PetscScalar pH[3][3] = {{0.,0.,0.},{0.,0.,0.},{0.,0.,0.}}; 634805e7170SToby Isaac const PetscScalar *spH = &sqH[((i * Nq + k) * Nc + j) * dimC * dimC]; 635805e7170SToby Isaac 636805e7170SToby Isaac for (l = 0; l < dimC; l++) { 637805e7170SToby Isaac for (m = 0; m < dimC; m++) { 638805e7170SToby Isaac for (q = 0; q < dim; q++) { 639805e7170SToby Isaac for (r = 0; r < dim; r++) { 640805e7170SToby Isaac pH[l][m] += invJ[q * dimC + l] * invJ[r * dimC + m] * spH[q * dim + r]; 641805e7170SToby Isaac } 642805e7170SToby Isaac } 643805e7170SToby Isaac } 644805e7170SToby Isaac } 645805e7170SToby Isaac for (l = 0; l < dimC; l++) { 646805e7170SToby Isaac for (m = 0; m < dimC; m++) { 647805e7170SToby Isaac sH[(i * Nc + j) * dimC * dimC + l * dimC + m] += geom->detJ[i * Nq + k] * weights[k] * pH[l][m]; 648805e7170SToby Isaac } 649805e7170SToby Isaac } 650805e7170SToby Isaac } 651805e7170SToby Isaac } 652805e7170SToby Isaac for (k = 0; k < Nc * dimC * dimC; k++) sH[i * Nc * dimC * dimC + k] /= vol; 653805e7170SToby Isaac } 654805e7170SToby Isaac } else { 655805e7170SToby Isaac PetscReal * rH = (PetscReal *) H; 656805e7170SToby Isaac PetscReal * rqH = (PetscReal *) qH; 657805e7170SToby Isaac 658805e7170SToby Isaac for (i = 0; i < numPoints; i++) { 659805e7170SToby Isaac PetscReal vol = 0.; 660805e7170SToby Isaac 661805e7170SToby Isaac for (j = 0; j < Nc * dimC * dimC; j++) {rH[i * Nc * dimC * dimC + j] = 0.;} 662805e7170SToby Isaac for (k = 0; k < Nq; k++) { 663805e7170SToby Isaac const PetscReal *invJ = &geom->invJ[(i * Nq + k) * dimC * dimC]; 664805e7170SToby Isaac 665805e7170SToby Isaac vol += geom->detJ[i * Nq + k] * weights[k]; 666805e7170SToby Isaac for (j = 0; j < Nc; j++) { 667805e7170SToby Isaac PetscReal pH[3][3] = {{0.,0.,0.},{0.,0.,0.},{0.,0.,0.}}; 668805e7170SToby Isaac const PetscReal *rpH = &rqH[((i * Nq + k) * Nc + j) * dimC * dimC]; 669805e7170SToby Isaac 670805e7170SToby Isaac for (l = 0; l < dimC; l++) { 671805e7170SToby Isaac for (m = 0; m < dimC; m++) { 672805e7170SToby Isaac for (q = 0; q < dim; q++) { 673805e7170SToby Isaac for (r = 0; r < dim; r++) { 674805e7170SToby Isaac pH[l][m] += invJ[q * dimC + l] * invJ[r * dimC + m] * rpH[q * dim + r]; 675805e7170SToby Isaac } 676805e7170SToby Isaac } 677805e7170SToby Isaac } 678805e7170SToby Isaac } 679805e7170SToby Isaac for (l = 0; l < dimC; l++) { 680805e7170SToby Isaac for (m = 0; m < dimC; m++) { 681805e7170SToby Isaac rH[(i * Nc + j) * dimC * dimC + l * dimC + m] += geom->detJ[i * Nq + k] * weights[k] * pH[l][m]; 682805e7170SToby Isaac } 683805e7170SToby Isaac } 684805e7170SToby Isaac } 685805e7170SToby Isaac } 686805e7170SToby Isaac for (k = 0; k < Nc * dimC * dimC; k++) rH[i * Nc * dimC * dimC + k] /= vol; 687805e7170SToby Isaac } 688805e7170SToby Isaac } 689805e7170SToby Isaac } 6909566063dSJacob Faibussowitsch if (B) PetscCall(DMRestoreWorkArray(field->dm, N, mpitype, &qB)); 6919566063dSJacob Faibussowitsch if (D) PetscCall(DMRestoreWorkArray(field->dm, N * dimC, mpitype, &qD)); 6929566063dSJacob Faibussowitsch if (H) PetscCall(DMRestoreWorkArray(field->dm, N * dimC * dimC, mpitype, &qH)); 6939566063dSJacob Faibussowitsch PetscCall(PetscFEGeomDestroy(&geom)); 6949566063dSJacob Faibussowitsch PetscCall(PetscQuadratureDestroy(&quad)); 695805e7170SToby Isaac PetscFunctionReturn(0); 696805e7170SToby Isaac } 697805e7170SToby Isaac 698b7260050SToby Isaac static PetscErrorCode DMFieldGetDegree_DS(DMField field, IS pointIS, PetscInt *minDegree, PetscInt *maxDegree) 69951a454edSToby Isaac { 70051a454edSToby Isaac DMField_DS *dsfield; 70151a454edSToby Isaac PetscObject disc; 702741db25dSToby Isaac PetscInt h, imin, imax; 70351a454edSToby Isaac PetscClassId id; 70451a454edSToby Isaac 70551a454edSToby Isaac PetscFunctionBegin; 70651a454edSToby Isaac dsfield = (DMField_DS *) field->data; 7079566063dSJacob Faibussowitsch PetscCall(ISGetMinMax(pointIS,&imin,&imax)); 708741db25dSToby Isaac if (imin >= imax) { 70951aa0bf7SToby Isaac h = 0; 71051aa0bf7SToby Isaac } else { 711f99c8401SToby Isaac for (h = 0; h < dsfield->height; h++) { 71251a454edSToby Isaac PetscInt hEnd; 71351a454edSToby Isaac 7149566063dSJacob Faibussowitsch PetscCall(DMPlexGetHeightStratum(field->dm,h,NULL,&hEnd)); 71551a454edSToby Isaac if (imin < hEnd) break; 71651a454edSToby Isaac } 71751aa0bf7SToby Isaac } 718*6858538eSMatthew G. Knepley PetscCall(DMFieldDSGetHeightDisc(field, h, dsfield->disc, &disc)); 7199566063dSJacob Faibussowitsch PetscCall(PetscObjectGetClassId(disc,&id)); 72051a454edSToby Isaac if (id == PETSCFE_CLASSID) { 72151a454edSToby Isaac PetscFE fe = (PetscFE) disc; 72251a454edSToby Isaac PetscSpace sp; 72351a454edSToby Isaac 7249566063dSJacob Faibussowitsch PetscCall(PetscFEGetBasisSpace(fe, &sp)); 7259566063dSJacob Faibussowitsch PetscCall(PetscSpaceGetDegree(sp, minDegree, maxDegree)); 72651a454edSToby Isaac } 72751a454edSToby Isaac PetscFunctionReturn(0); 72851a454edSToby Isaac } 72951a454edSToby Isaac 730a2aba86cSMatthew G. Knepley PetscErrorCode DMFieldGetFVQuadrature_Internal(DMField field, IS pointIS, PetscQuadrature *quad) 731a2aba86cSMatthew G. Knepley { 732a2aba86cSMatthew G. Knepley DM dm = field->dm; 733a2aba86cSMatthew G. Knepley const PetscInt *points; 734a2aba86cSMatthew G. Knepley DMPolytopeType ct; 735a2aba86cSMatthew G. Knepley PetscInt dim, n; 736a2aba86cSMatthew G. Knepley PetscBool isplex; 737a2aba86cSMatthew G. Knepley 738a2aba86cSMatthew G. Knepley PetscFunctionBegin; 7399566063dSJacob Faibussowitsch PetscCall(PetscObjectTypeCompare((PetscObject) dm, DMPLEX, &isplex)); 7409566063dSJacob Faibussowitsch PetscCall(ISGetLocalSize(pointIS, &n)); 741a2aba86cSMatthew G. Knepley if (isplex && n) { 7429566063dSJacob Faibussowitsch PetscCall(DMGetDimension(dm, &dim)); 7439566063dSJacob Faibussowitsch PetscCall(ISGetIndices(pointIS, &points)); 7449566063dSJacob Faibussowitsch PetscCall(DMPlexGetCellType(dm, points[0], &ct)); 745a2aba86cSMatthew G. Knepley switch (ct) { 746a2aba86cSMatthew G. Knepley case DM_POLYTOPE_TRIANGLE: 747a2aba86cSMatthew G. Knepley case DM_POLYTOPE_TETRAHEDRON: 7489566063dSJacob Faibussowitsch PetscCall(PetscDTStroudConicalQuadrature(dim, 1, 1, -1.0, 1.0, quad));break; 7499566063dSJacob Faibussowitsch default: PetscCall(PetscDTGaussTensorQuadrature(dim, 1, 1, -1.0, 1.0, quad)); 750a2aba86cSMatthew G. Knepley } 7519566063dSJacob Faibussowitsch PetscCall(ISRestoreIndices(pointIS, &points)); 7521baa6e33SBarry Smith } else PetscCall(DMFieldCreateDefaultQuadrature(field, pointIS, quad)); 753a2aba86cSMatthew G. Knepley PetscFunctionReturn(0); 754a2aba86cSMatthew G. Knepley } 755a2aba86cSMatthew G. Knepley 75651a454edSToby Isaac static PetscErrorCode DMFieldCreateDefaultQuadrature_DS(DMField field, IS pointIS, PetscQuadrature *quad) 75751a454edSToby Isaac { 7581fdf1f07SMatthew G. Knepley PetscInt h, dim, imax, imin, cellHeight; 75951a454edSToby Isaac DM dm; 76051a454edSToby Isaac DMField_DS *dsfield; 76151a454edSToby Isaac PetscObject disc; 76251a454edSToby Isaac PetscFE fe; 76351a454edSToby Isaac PetscClassId id; 76451a454edSToby Isaac 76551a454edSToby Isaac PetscFunctionBegin; 76651a454edSToby Isaac dm = field->dm; 76751a454edSToby Isaac dsfield = (DMField_DS *) field->data; 7689566063dSJacob Faibussowitsch PetscCall(ISGetMinMax(pointIS,&imin,&imax)); 7699566063dSJacob Faibussowitsch PetscCall(DMGetDimension(dm,&dim)); 77051a454edSToby Isaac for (h = 0; h <= dim; h++) { 77151a454edSToby Isaac PetscInt hStart, hEnd; 77251a454edSToby Isaac 7739566063dSJacob Faibussowitsch PetscCall(DMPlexGetHeightStratum(dm,h,&hStart,&hEnd)); 7746c041b70SSatish Balay if (imax >= hStart && imin < hEnd) break; 77551a454edSToby Isaac } 7769566063dSJacob Faibussowitsch PetscCall(DMPlexGetVTKCellHeight(dm, &cellHeight)); 7771fdf1f07SMatthew G. Knepley h -= cellHeight; 77851a454edSToby Isaac *quad = NULL; 779f99c8401SToby Isaac if (h < dsfield->height) { 780*6858538eSMatthew G. Knepley PetscCall(DMFieldDSGetHeightDisc(field, h, dsfield->disc, &disc)); 7819566063dSJacob Faibussowitsch PetscCall(PetscObjectGetClassId(disc,&id)); 78251a454edSToby Isaac if (id != PETSCFE_CLASSID) PetscFunctionReturn(0); 78351a454edSToby Isaac fe = (PetscFE) disc; 7849566063dSJacob Faibussowitsch PetscCall(PetscFEGetQuadrature(fe,quad)); 7859566063dSJacob Faibussowitsch PetscCall(PetscObjectReference((PetscObject)*quad)); 78651a454edSToby Isaac } 78751a454edSToby Isaac PetscFunctionReturn(0); 78851a454edSToby Isaac } 78951a454edSToby Isaac 7900145028aSToby Isaac static PetscErrorCode DMFieldComputeFaceData_DS(DMField field, IS pointIS, PetscQuadrature quad, PetscFEGeom *geom) 7910145028aSToby Isaac { 7920145028aSToby Isaac const PetscInt *points; 7930145028aSToby Isaac PetscInt p, dim, dE, numFaces, Nq; 794b7260050SToby Isaac PetscInt maxDegree; 7950145028aSToby Isaac DMLabel depthLabel; 7960145028aSToby Isaac IS cellIS; 7970145028aSToby Isaac DM dm = field->dm; 7980145028aSToby Isaac 7990145028aSToby Isaac PetscFunctionBegin; 8000145028aSToby Isaac dim = geom->dim; 8010145028aSToby Isaac dE = geom->dimEmbed; 8029566063dSJacob Faibussowitsch PetscCall(DMPlexGetDepthLabel(dm, &depthLabel)); 8039566063dSJacob Faibussowitsch PetscCall(DMLabelGetStratumIS(depthLabel, dim + 1, &cellIS)); 8049566063dSJacob Faibussowitsch PetscCall(DMFieldGetDegree(field,cellIS,NULL,&maxDegree)); 8059566063dSJacob Faibussowitsch PetscCall(ISGetIndices(pointIS, &points)); 8060145028aSToby Isaac numFaces = geom->numCells; 8070145028aSToby Isaac Nq = geom->numPoints; 808f15274beSMatthew Knepley /* First, set local faces and flip normals so that they are outward for the first supporting cell */ 809f15274beSMatthew Knepley for (p = 0; p < numFaces; p++) { 810f15274beSMatthew Knepley PetscInt point = points[p]; 811f15274beSMatthew Knepley PetscInt suppSize, s, coneSize, c, numChildren; 812f15274beSMatthew Knepley const PetscInt *supp, *cone, *ornt; 813f15274beSMatthew Knepley 8149566063dSJacob Faibussowitsch PetscCall(DMPlexGetTreeChildren(dm, point, &numChildren, NULL)); 81528b400f6SJacob Faibussowitsch PetscCheck(!numChildren,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Face data not valid for facets with children"); 8169566063dSJacob Faibussowitsch PetscCall(DMPlexGetSupportSize(dm, point, &suppSize)); 81763a3b9bcSJacob Faibussowitsch PetscCheck(suppSize <= 2,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Point %" PetscInt_FMT " has %" PetscInt_FMT " support, expected at most 2", point, suppSize); 818f15274beSMatthew Knepley if (!suppSize) continue; 8199566063dSJacob Faibussowitsch PetscCall(DMPlexGetSupport(dm, point, &supp)); 820f15274beSMatthew Knepley for (s = 0; s < suppSize; ++s) { 8219566063dSJacob Faibussowitsch PetscCall(DMPlexGetConeSize(dm, supp[s], &coneSize)); 8229566063dSJacob Faibussowitsch PetscCall(DMPlexGetCone(dm, supp[s], &cone)); 823f15274beSMatthew Knepley for (c = 0; c < coneSize; ++c) if (cone[c] == point) break; 82463a3b9bcSJacob Faibussowitsch PetscCheck(c != coneSize,PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Invalid connectivity: point %" PetscInt_FMT " not found in cone of support point %" PetscInt_FMT, point, supp[s]); 825f15274beSMatthew Knepley geom->face[p][s] = c; 826f15274beSMatthew Knepley } 8279566063dSJacob Faibussowitsch PetscCall(DMPlexGetConeOrientation(dm, supp[0], &ornt)); 828f15274beSMatthew Knepley if (ornt[geom->face[p][0]] < 0) { 829f15274beSMatthew Knepley PetscInt Np = geom->numPoints, q, dE = geom->dimEmbed, d; 830f15274beSMatthew Knepley 831f15274beSMatthew Knepley for (q = 0; q < Np; ++q) for (d = 0; d < dE; ++d) geom->n[(p*Np + q)*dE + d] = -geom->n[(p*Np + q)*dE + d]; 832f15274beSMatthew Knepley } 833f15274beSMatthew Knepley } 834b7260050SToby Isaac if (maxDegree <= 1) { 8350145028aSToby Isaac PetscInt numCells, offset, *cells; 8360145028aSToby Isaac PetscFEGeom *cellGeom; 8370145028aSToby Isaac IS suppIS; 8380145028aSToby Isaac 8390145028aSToby Isaac for (p = 0, numCells = 0; p < numFaces; p++) { 8400145028aSToby Isaac PetscInt point = points[p]; 8410145028aSToby Isaac PetscInt numSupp, numChildren; 8420145028aSToby Isaac 8439566063dSJacob Faibussowitsch PetscCall(DMPlexGetTreeChildren(dm, point, &numChildren, NULL)); 84428b400f6SJacob Faibussowitsch PetscCheck(!numChildren,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Face data not valid for facets with children"); 8459566063dSJacob Faibussowitsch PetscCall(DMPlexGetSupportSize(dm, point,&numSupp)); 84663a3b9bcSJacob Faibussowitsch PetscCheck(numSupp <= 2,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Point %" PetscInt_FMT " has %" PetscInt_FMT " support, expected at most 2", point, numSupp); 8470145028aSToby Isaac numCells += numSupp; 8480145028aSToby Isaac } 8499566063dSJacob Faibussowitsch PetscCall(PetscMalloc1(numCells, &cells)); 8500145028aSToby Isaac for (p = 0, offset = 0; p < numFaces; p++) { 8510145028aSToby Isaac PetscInt point = points[p]; 8520145028aSToby Isaac PetscInt numSupp, s; 8530145028aSToby Isaac const PetscInt *supp; 8540145028aSToby Isaac 8559566063dSJacob Faibussowitsch PetscCall(DMPlexGetSupportSize(dm, point,&numSupp)); 8569566063dSJacob Faibussowitsch PetscCall(DMPlexGetSupport(dm, point, &supp)); 8570145028aSToby Isaac for (s = 0; s < numSupp; s++, offset++) { 8580145028aSToby Isaac cells[offset] = supp[s]; 8590145028aSToby Isaac } 8600145028aSToby Isaac } 8619566063dSJacob Faibussowitsch PetscCall(ISCreateGeneral(PETSC_COMM_SELF,numCells,cells,PETSC_USE_POINTER, &suppIS)); 8629566063dSJacob Faibussowitsch PetscCall(DMFieldCreateFEGeom(field,suppIS,quad,PETSC_FALSE,&cellGeom)); 8630145028aSToby Isaac for (p = 0, offset = 0; p < numFaces; p++) { 8640145028aSToby Isaac PetscInt point = points[p]; 8650145028aSToby Isaac PetscInt numSupp, s, q; 8660145028aSToby Isaac const PetscInt *supp; 8670145028aSToby Isaac 8689566063dSJacob Faibussowitsch PetscCall(DMPlexGetSupportSize(dm, point,&numSupp)); 8699566063dSJacob Faibussowitsch PetscCall(DMPlexGetSupport(dm, point, &supp)); 8700145028aSToby Isaac for (s = 0; s < numSupp; s++, offset++) { 8710145028aSToby Isaac for (q = 0; q < Nq * dE * dE; q++) { 87241418987SMatthew G. Knepley geom->suppJ[s][p * Nq * dE * dE + q] = cellGeom->J[offset * Nq * dE * dE + q]; 8730145028aSToby Isaac geom->suppInvJ[s][p * Nq * dE * dE + q] = cellGeom->invJ[offset * Nq * dE * dE + q]; 8740145028aSToby Isaac } 87541418987SMatthew G. Knepley for (q = 0; q < Nq; q++) geom->suppDetJ[s][p * Nq + q] = cellGeom->detJ[offset * Nq + q]; 8760145028aSToby Isaac } 8770145028aSToby Isaac } 8789566063dSJacob Faibussowitsch PetscCall(PetscFEGeomDestroy(&cellGeom)); 8799566063dSJacob Faibussowitsch PetscCall(ISDestroy(&suppIS)); 8809566063dSJacob Faibussowitsch PetscCall(PetscFree(cells)); 8810145028aSToby Isaac } else { 882*6858538eSMatthew G. Knepley DMField_DS *dsfield = (DMField_DS *) field->data; 8830145028aSToby Isaac PetscObject faceDisc, cellDisc; 8840145028aSToby Isaac PetscClassId faceId, cellId; 8850145028aSToby Isaac PetscDualSpace dsp; 8860145028aSToby Isaac DM K; 887ba2698f1SMatthew G. Knepley DMPolytopeType ct; 8880145028aSToby Isaac PetscInt (*co)[2][3]; 8890145028aSToby Isaac PetscInt coneSize; 8900145028aSToby Isaac PetscInt **counts; 8910145028aSToby Isaac PetscInt f, i, o, q, s; 8920145028aSToby Isaac const PetscInt *coneK; 893ba2698f1SMatthew G. Knepley PetscInt eStart, minOrient, maxOrient, numOrient; 8940145028aSToby Isaac PetscInt *orients; 8950145028aSToby Isaac PetscReal **orientPoints; 8960145028aSToby Isaac PetscReal *cellPoints; 8970145028aSToby Isaac PetscReal *dummyWeights; 8980145028aSToby Isaac PetscQuadrature cellQuad = NULL; 8990145028aSToby Isaac 900*6858538eSMatthew G. Knepley PetscCall(DMFieldDSGetHeightDisc(field, 1, dsfield->disc, &faceDisc)); 901*6858538eSMatthew G. Knepley PetscCall(DMFieldDSGetHeightDisc(field, 0, dsfield->disc, &cellDisc)); 9029566063dSJacob Faibussowitsch PetscCall(PetscObjectGetClassId(faceDisc,&faceId)); 9039566063dSJacob Faibussowitsch PetscCall(PetscObjectGetClassId(cellDisc,&cellId)); 9041dca8a05SBarry Smith PetscCheck(faceId == PETSCFE_CLASSID && cellId == PETSCFE_CLASSID,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Not supported"); 9059566063dSJacob Faibussowitsch PetscCall(PetscFEGetDualSpace((PetscFE)cellDisc, &dsp)); 9069566063dSJacob Faibussowitsch PetscCall(PetscDualSpaceGetDM(dsp, &K)); 9079566063dSJacob Faibussowitsch PetscCall(DMPlexGetHeightStratum(K, 1, &eStart, NULL)); 9089566063dSJacob Faibussowitsch PetscCall(DMPlexGetCellType(K, eStart, &ct)); 9099566063dSJacob Faibussowitsch PetscCall(DMPlexGetConeSize(K,0,&coneSize)); 9109566063dSJacob Faibussowitsch PetscCall(DMPlexGetCone(K,0,&coneK)); 9119566063dSJacob Faibussowitsch PetscCall(PetscMalloc2(numFaces, &co, coneSize, &counts)); 9129566063dSJacob Faibussowitsch PetscCall(PetscMalloc1(dE*Nq, &cellPoints)); 9139566063dSJacob Faibussowitsch PetscCall(PetscMalloc1(Nq, &dummyWeights)); 9149566063dSJacob Faibussowitsch PetscCall(PetscQuadratureCreate(PETSC_COMM_SELF, &cellQuad)); 9159566063dSJacob Faibussowitsch PetscCall(PetscQuadratureSetData(cellQuad, dE, 1, Nq, cellPoints, dummyWeights)); 9160145028aSToby Isaac minOrient = PETSC_MAX_INT; 9170145028aSToby Isaac maxOrient = PETSC_MIN_INT; 9180145028aSToby Isaac for (p = 0; p < numFaces; p++) { /* record the orientation of the facet wrt the support cells */ 9190145028aSToby Isaac PetscInt point = points[p]; 9200145028aSToby Isaac PetscInt numSupp, numChildren; 9210145028aSToby Isaac const PetscInt *supp; 9220145028aSToby Isaac 9239566063dSJacob Faibussowitsch PetscCall(DMPlexGetTreeChildren(dm, point, &numChildren, NULL)); 92428b400f6SJacob Faibussowitsch PetscCheck(!numChildren,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Face data not valid for facets with children"); 9259566063dSJacob Faibussowitsch PetscCall(DMPlexGetSupportSize(dm, point,&numSupp)); 92663a3b9bcSJacob Faibussowitsch PetscCheck(numSupp <= 2,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Point %" PetscInt_FMT " has %" PetscInt_FMT " support, expected at most 2", point, numSupp); 9279566063dSJacob Faibussowitsch PetscCall(DMPlexGetSupport(dm, point, &supp)); 9280145028aSToby Isaac for (s = 0; s < numSupp; s++) { 9290145028aSToby Isaac PetscInt cell = supp[s]; 9300145028aSToby Isaac PetscInt numCone; 9310145028aSToby Isaac const PetscInt *cone, *orient; 9320145028aSToby Isaac 9339566063dSJacob Faibussowitsch PetscCall(DMPlexGetConeSize(dm, cell, &numCone)); 93408401ef6SPierre Jolivet PetscCheck(numCone == coneSize,PETSC_COMM_SELF, PETSC_ERR_PLIB, "Support point does not match reference element"); 9359566063dSJacob Faibussowitsch PetscCall(DMPlexGetCone(dm, cell, &cone)); 9369566063dSJacob Faibussowitsch PetscCall(DMPlexGetConeOrientation(dm, cell, &orient)); 9370145028aSToby Isaac for (f = 0; f < coneSize; f++) { 9380145028aSToby Isaac if (cone[f] == point) break; 9390145028aSToby Isaac } 9400145028aSToby Isaac co[p][s][0] = f; 9410145028aSToby Isaac co[p][s][1] = orient[f]; 9420145028aSToby Isaac co[p][s][2] = cell; 9430145028aSToby Isaac minOrient = PetscMin(minOrient, orient[f]); 944cd93b0e1SMatthew G. Knepley maxOrient = PetscMax(maxOrient, orient[f]); 9450145028aSToby Isaac } 9460145028aSToby Isaac for (; s < 2; s++) { 9470145028aSToby Isaac co[p][s][0] = -1; 9480145028aSToby Isaac co[p][s][1] = -1; 9490145028aSToby Isaac co[p][s][2] = -1; 9500145028aSToby Isaac } 9510145028aSToby Isaac } 9520145028aSToby Isaac numOrient = maxOrient + 1 - minOrient; 9539566063dSJacob Faibussowitsch PetscCall(DMPlexGetCone(K,0,&coneK)); 9540145028aSToby Isaac /* count all (face,orientation) doubles that appear */ 9559566063dSJacob Faibussowitsch PetscCall(PetscCalloc2(numOrient,&orients,numOrient,&orientPoints)); 9569566063dSJacob Faibussowitsch for (f = 0; f < coneSize; f++) PetscCall(PetscCalloc1(numOrient+1, &counts[f])); 9570145028aSToby Isaac for (p = 0; p < numFaces; p++) { 9580145028aSToby Isaac for (s = 0; s < 2; s++) { 9590145028aSToby Isaac if (co[p][s][0] >= 0) { 9600145028aSToby Isaac counts[co[p][s][0]][co[p][s][1] - minOrient]++; 9610145028aSToby Isaac orients[co[p][s][1] - minOrient]++; 9620145028aSToby Isaac } 9630145028aSToby Isaac } 9640145028aSToby Isaac } 9650145028aSToby Isaac for (o = 0; o < numOrient; o++) { 9660145028aSToby Isaac if (orients[o]) { 9670145028aSToby Isaac PetscInt orient = o + minOrient; 9680145028aSToby Isaac PetscInt q; 9690145028aSToby Isaac 9709566063dSJacob Faibussowitsch PetscCall(PetscMalloc1(Nq * dim, &orientPoints[o])); 9710145028aSToby Isaac /* rotate the quadrature points appropriately */ 972ba2698f1SMatthew G. Knepley switch (ct) { 973ba2698f1SMatthew G. Knepley case DM_POLYTOPE_POINT: break; 974ba2698f1SMatthew G. Knepley case DM_POLYTOPE_SEGMENT: 9750145028aSToby Isaac if (orient == -2 || orient == 1) { 9760145028aSToby Isaac for (q = 0; q < Nq; q++) { 9770145028aSToby Isaac orientPoints[o][q] = -geom->xi[q]; 9780145028aSToby Isaac } 9790145028aSToby Isaac } else { 9800145028aSToby Isaac for (q = 0; q < Nq; q++) { 9810145028aSToby Isaac orientPoints[o][q] = geom->xi[q]; 9820145028aSToby Isaac } 9830145028aSToby Isaac } 9840145028aSToby Isaac break; 985ba2698f1SMatthew G. Knepley case DM_POLYTOPE_TRIANGLE: 9860145028aSToby Isaac for (q = 0; q < Nq; q++) { 9870145028aSToby Isaac PetscReal lambda[3]; 9880145028aSToby Isaac PetscReal lambdao[3]; 9890145028aSToby Isaac 9900145028aSToby Isaac /* convert to barycentric */ 9910145028aSToby Isaac lambda[0] = - (geom->xi[2 * q] + geom->xi[2 * q + 1]) / 2.; 9920145028aSToby Isaac lambda[1] = (geom->xi[2 * q] + 1.) / 2.; 9930145028aSToby Isaac lambda[2] = (geom->xi[2 * q + 1] + 1.) / 2.; 9940145028aSToby Isaac if (orient >= 0) { 9950145028aSToby Isaac for (i = 0; i < 3; i++) { 9960145028aSToby Isaac lambdao[i] = lambda[(orient + i) % 3]; 9970145028aSToby Isaac } 9980145028aSToby Isaac } else { 9990145028aSToby Isaac for (i = 0; i < 3; i++) { 10000145028aSToby Isaac lambdao[i] = lambda[(-(orient + i) + 3) % 3]; 10010145028aSToby Isaac } 10020145028aSToby Isaac } 10030145028aSToby Isaac /* convert to coordinates */ 10040145028aSToby Isaac orientPoints[o][2 * q + 0] = -(lambdao[0] + lambdao[2]) + lambdao[1]; 10050145028aSToby Isaac orientPoints[o][2 * q + 1] = -(lambdao[0] + lambdao[1]) + lambdao[2]; 10060145028aSToby Isaac } 10070145028aSToby Isaac break; 1008ba2698f1SMatthew G. Knepley case DM_POLYTOPE_QUADRILATERAL: 10090145028aSToby Isaac for (q = 0; q < Nq; q++) { 10100145028aSToby Isaac PetscReal xi[2], xio[2]; 10110145028aSToby Isaac PetscInt oabs = (orient >= 0) ? orient : -(orient + 1); 10120145028aSToby Isaac 10130145028aSToby Isaac xi[0] = geom->xi[2 * q]; 10140145028aSToby Isaac xi[1] = geom->xi[2 * q + 1]; 10150145028aSToby Isaac switch (oabs) { 10160145028aSToby Isaac case 1: 10170145028aSToby Isaac xio[0] = xi[1]; 10180145028aSToby Isaac xio[1] = -xi[0]; 10190145028aSToby Isaac break; 10200145028aSToby Isaac case 2: 10210145028aSToby Isaac xio[0] = -xi[0]; 10220145028aSToby Isaac xio[1] = -xi[1]; 10230145028aSToby Isaac case 3: 10240145028aSToby Isaac xio[0] = -xi[1]; 10250145028aSToby Isaac xio[1] = xi[0]; 1026aa1371cbSToby Isaac case 0: 1027aa1371cbSToby Isaac default: 1028aa1371cbSToby Isaac xio[0] = xi[0]; 1029aa1371cbSToby Isaac xio[1] = xi[1]; 1030aa1371cbSToby Isaac break; 10310145028aSToby Isaac } 10320145028aSToby Isaac if (orient < 0) { 10330145028aSToby Isaac xio[0] = -xio[0]; 10340145028aSToby Isaac } 10350145028aSToby Isaac orientPoints[o][2 * q + 0] = xio[0]; 10360145028aSToby Isaac orientPoints[o][2 * q + 1] = xio[1]; 10370145028aSToby Isaac } 10380145028aSToby Isaac break; 103998921bdaSJacob Faibussowitsch default: SETERRQ(PETSC_COMM_SELF,PETSC_ERR_SUP,"Cell type %s not yet supported", DMPolytopeTypes[ct]); 10400145028aSToby Isaac } 10410145028aSToby Isaac } 10420145028aSToby Isaac } 10430145028aSToby Isaac for (f = 0; f < coneSize; f++) { 10440145028aSToby Isaac PetscInt face = coneK[f]; 10454d1a973fSToby Isaac PetscReal v0[3]; 10462d89661fSMatthew G. Knepley PetscReal J[9], detJ; 10470145028aSToby Isaac PetscInt numCells, offset; 10480145028aSToby Isaac PetscInt *cells; 10490145028aSToby Isaac IS suppIS; 10500145028aSToby Isaac 10519566063dSJacob Faibussowitsch PetscCall(DMPlexComputeCellGeometryFEM(K, face, NULL, v0, J, NULL, &detJ)); 10520145028aSToby Isaac for (o = 0; o <= numOrient; o++) { 10530145028aSToby Isaac PetscFEGeom *cellGeom; 10540145028aSToby Isaac 10550145028aSToby Isaac if (!counts[f][o]) continue; 10560145028aSToby Isaac /* If this (face,orientation) double appears, 10570145028aSToby Isaac * convert the face quadrature points into volume quadrature points */ 10580145028aSToby Isaac for (q = 0; q < Nq; q++) { 10590145028aSToby Isaac PetscReal xi0[3] = {-1., -1., -1.}; 10600145028aSToby Isaac 10610145028aSToby Isaac CoordinatesRefToReal(dE, dim, xi0, v0, J, &orientPoints[o][dim * q + 0], &cellPoints[dE * q + 0]); 10620145028aSToby Isaac } 10630145028aSToby Isaac for (p = 0, numCells = 0; p < numFaces; p++) { 10640145028aSToby Isaac for (s = 0; s < 2; s++) { 10650145028aSToby Isaac if (co[p][s][0] == f && co[p][s][1] == o + minOrient) numCells++; 10660145028aSToby Isaac } 10670145028aSToby Isaac } 10689566063dSJacob Faibussowitsch PetscCall(PetscMalloc1(numCells, &cells)); 10690145028aSToby Isaac for (p = 0, offset = 0; p < numFaces; p++) { 10700145028aSToby Isaac for (s = 0; s < 2; s++) { 10710145028aSToby Isaac if (co[p][s][0] == f && co[p][s][1] == o + minOrient) { 10720145028aSToby Isaac cells[offset++] = co[p][s][2]; 10730145028aSToby Isaac } 10740145028aSToby Isaac } 10750145028aSToby Isaac } 10769566063dSJacob Faibussowitsch PetscCall(ISCreateGeneral(PETSC_COMM_SELF,numCells,cells,PETSC_USE_POINTER, &suppIS)); 10779566063dSJacob Faibussowitsch PetscCall(DMFieldCreateFEGeom(field,suppIS,cellQuad,PETSC_FALSE,&cellGeom)); 10780145028aSToby Isaac for (p = 0, offset = 0; p < numFaces; p++) { 10790145028aSToby Isaac for (s = 0; s < 2; s++) { 10800145028aSToby Isaac if (co[p][s][0] == f && co[p][s][1] == o + minOrient) { 10810145028aSToby Isaac for (q = 0; q < Nq * dE * dE; q++) { 108241418987SMatthew G. Knepley geom->suppJ[s][p * Nq * dE * dE + q] = cellGeom->J[offset * Nq * dE * dE + q]; 10830145028aSToby Isaac geom->suppInvJ[s][p * Nq * dE * dE + q] = cellGeom->invJ[offset * Nq * dE * dE + q]; 10840145028aSToby Isaac } 108541418987SMatthew G. Knepley for (q = 0; q < Nq; q++) geom->suppDetJ[s][p * Nq + q] = cellGeom->detJ[offset * Nq + q]; 10860145028aSToby Isaac offset++; 10870145028aSToby Isaac } 10880145028aSToby Isaac } 10890145028aSToby Isaac } 10909566063dSJacob Faibussowitsch PetscCall(PetscFEGeomDestroy(&cellGeom)); 10919566063dSJacob Faibussowitsch PetscCall(ISDestroy(&suppIS)); 10929566063dSJacob Faibussowitsch PetscCall(PetscFree(cells)); 10930145028aSToby Isaac } 10940145028aSToby Isaac } 10950145028aSToby Isaac for (o = 0; o < numOrient; o++) { 10960145028aSToby Isaac if (orients[o]) { 10979566063dSJacob Faibussowitsch PetscCall(PetscFree(orientPoints[o])); 10980145028aSToby Isaac } 10990145028aSToby Isaac } 11009566063dSJacob Faibussowitsch PetscCall(PetscFree2(orients,orientPoints)); 11019566063dSJacob Faibussowitsch PetscCall(PetscQuadratureDestroy(&cellQuad)); 11029566063dSJacob Faibussowitsch for (f = 0; f < coneSize; f++) PetscCall(PetscFree(counts[f])); 11039566063dSJacob Faibussowitsch PetscCall(PetscFree2(co,counts)); 11040145028aSToby Isaac } 11059566063dSJacob Faibussowitsch PetscCall(ISRestoreIndices(pointIS, &points)); 11069566063dSJacob Faibussowitsch PetscCall(ISDestroy(&cellIS)); 11070145028aSToby Isaac PetscFunctionReturn(0); 11080145028aSToby Isaac } 11090145028aSToby Isaac 111051a454edSToby Isaac static PetscErrorCode DMFieldInitialize_DS(DMField field) 111151a454edSToby Isaac { 111251a454edSToby Isaac PetscFunctionBegin; 111351a454edSToby Isaac field->ops->destroy = DMFieldDestroy_DS; 111451a454edSToby Isaac field->ops->evaluate = DMFieldEvaluate_DS; 111551a454edSToby Isaac field->ops->evaluateFE = DMFieldEvaluateFE_DS; 1116805e7170SToby Isaac field->ops->evaluateFV = DMFieldEvaluateFV_DS; 1117b7260050SToby Isaac field->ops->getDegree = DMFieldGetDegree_DS; 111851a454edSToby Isaac field->ops->createDefaultQuadrature = DMFieldCreateDefaultQuadrature_DS; 111951a454edSToby Isaac field->ops->view = DMFieldView_DS; 11200145028aSToby Isaac field->ops->computeFaceData = DMFieldComputeFaceData_DS; 112151a454edSToby Isaac PetscFunctionReturn(0); 112251a454edSToby Isaac } 112351a454edSToby Isaac 112451a454edSToby Isaac PETSC_INTERN PetscErrorCode DMFieldCreate_DS(DMField field) 112551a454edSToby Isaac { 112651a454edSToby Isaac DMField_DS *dsfield; 112751a454edSToby Isaac 112851a454edSToby Isaac PetscFunctionBegin; 11299566063dSJacob Faibussowitsch PetscCall(PetscNewLog(field,&dsfield)); 113051a454edSToby Isaac field->data = dsfield; 11319566063dSJacob Faibussowitsch PetscCall(DMFieldInitialize_DS(field)); 113251a454edSToby Isaac PetscFunctionReturn(0); 113351a454edSToby Isaac } 113451a454edSToby Isaac 1135*6858538eSMatthew G. Knepley PetscErrorCode DMFieldCreateDSWithDG(DM dm, DM dmDG, PetscInt fieldNum, Vec vec, Vec vecDG, DMField *field) 113651a454edSToby Isaac { 113751a454edSToby Isaac DMField b; 113851a454edSToby Isaac DMField_DS *dsfield; 1139*6858538eSMatthew G. Knepley PetscObject disc = NULL, discDG = NULL; 1140*6858538eSMatthew G. Knepley PetscSection section; 114151a454edSToby Isaac PetscBool isContainer = PETSC_FALSE; 114251a454edSToby Isaac PetscClassId id = -1; 114351a454edSToby Isaac PetscInt numComponents = -1, dsNumFields; 114451a454edSToby Isaac 114551a454edSToby Isaac PetscFunctionBegin; 11469566063dSJacob Faibussowitsch PetscCall(DMGetLocalSection(dm, §ion)); 11479566063dSJacob Faibussowitsch PetscCall(PetscSectionGetFieldComponents(section, fieldNum, &numComponents)); 11489566063dSJacob Faibussowitsch PetscCall(DMGetNumFields(dm, &dsNumFields)); 11499566063dSJacob Faibussowitsch if (dsNumFields) PetscCall(DMGetField(dm, fieldNum, NULL, &disc)); 1150*6858538eSMatthew G. Knepley if (dsNumFields && dmDG) { 1151*6858538eSMatthew G. Knepley PetscCall(DMGetField(dmDG, fieldNum, NULL, &discDG)); 1152*6858538eSMatthew G. Knepley PetscCall(PetscObjectReference(discDG)); 1153*6858538eSMatthew G. Knepley } 115451a454edSToby Isaac if (disc) { 11559566063dSJacob Faibussowitsch PetscCall(PetscObjectGetClassId(disc, &id)); 115651a454edSToby Isaac isContainer = (id == PETSC_CONTAINER_CLASSID) ? PETSC_TRUE : PETSC_FALSE; 115751a454edSToby Isaac } 115851a454edSToby Isaac if (!disc || isContainer) { 115951a454edSToby Isaac MPI_Comm comm = PetscObjectComm((PetscObject) dm); 116051a454edSToby Isaac PetscFE fe; 11612df84da0SMatthew G. Knepley DMPolytopeType ct, locct = DM_POLYTOPE_UNKNOWN; 11622df84da0SMatthew G. Knepley PetscInt dim, cStart, cEnd, cellHeight; 116351a454edSToby Isaac 11649566063dSJacob Faibussowitsch PetscCall(DMPlexGetVTKCellHeight(dm, &cellHeight)); 11659566063dSJacob Faibussowitsch PetscCall(DMGetDimension(dm, &dim)); 11669566063dSJacob Faibussowitsch PetscCall(DMPlexGetHeightStratum(dm, cellHeight, &cStart, &cEnd)); 11679566063dSJacob Faibussowitsch if (cEnd > cStart) PetscCall(DMPlexGetCellType(dm, cStart, &locct)); 11689566063dSJacob Faibussowitsch PetscCallMPI(MPI_Allreduce(&locct, &ct, 1, MPI_INT, MPI_MIN, comm)); 11699566063dSJacob Faibussowitsch PetscCall(PetscFECreateLagrangeByCell(PETSC_COMM_SELF, dim, numComponents, ct, 1, PETSC_DETERMINE, &fe)); 11709566063dSJacob Faibussowitsch PetscCall(PetscFEViewFromOptions(fe, NULL, "-field_fe_view")); 117151a454edSToby Isaac disc = (PetscObject) fe; 11721baa6e33SBarry Smith } else PetscCall(PetscObjectReference(disc)); 11739566063dSJacob Faibussowitsch PetscCall(PetscObjectGetClassId(disc, &id)); 1174*6858538eSMatthew G. Knepley if (id == PETSCFE_CLASSID) PetscCall(PetscFEGetNumComponents((PetscFE) disc, &numComponents)); 1175*6858538eSMatthew G. Knepley else SETERRQ(PetscObjectComm((PetscObject) dm), PETSC_ERR_SUP, "Cannot determine number of discretization components"); 11769566063dSJacob Faibussowitsch PetscCall(DMFieldCreate(dm, numComponents, DMFIELD_VERTEX, &b)); 11779566063dSJacob Faibussowitsch PetscCall(DMFieldSetType(b, DMFIELDDS)); 117851a454edSToby Isaac dsfield = (DMField_DS *) b->data; 117951a454edSToby Isaac dsfield->fieldNum = fieldNum; 11809566063dSJacob Faibussowitsch PetscCall(DMGetDimension(dm, &dsfield->height)); 1181f99c8401SToby Isaac dsfield->height++; 11829566063dSJacob Faibussowitsch PetscCall(PetscCalloc1(dsfield->height, &dsfield->disc)); 118351a454edSToby Isaac dsfield->disc[0] = disc; 11849566063dSJacob Faibussowitsch PetscCall(PetscObjectReference((PetscObject) vec)); 118551a454edSToby Isaac dsfield->vec = vec; 1186*6858538eSMatthew G. Knepley if (dmDG) { 1187*6858538eSMatthew G. Knepley dsfield->dmDG = dmDG; 1188*6858538eSMatthew G. Knepley PetscCall(PetscCalloc1(dsfield->height, &dsfield->discDG)); 1189*6858538eSMatthew G. Knepley dsfield->discDG[0] = discDG; 1190*6858538eSMatthew G. Knepley PetscCall(PetscObjectReference((PetscObject) vecDG)); 1191*6858538eSMatthew G. Knepley dsfield->vecDG = vecDG; 1192*6858538eSMatthew G. Knepley } 119351a454edSToby Isaac *field = b; 1194*6858538eSMatthew G. Knepley PetscFunctionReturn(0); 1195*6858538eSMatthew G. Knepley } 119651a454edSToby Isaac 1197*6858538eSMatthew G. Knepley PetscErrorCode DMFieldCreateDS(DM dm, PetscInt fieldNum, Vec vec, DMField *field) 1198*6858538eSMatthew G. Knepley { 1199*6858538eSMatthew G. Knepley PetscFunctionBegin; 1200*6858538eSMatthew G. Knepley PetscCall(DMFieldCreateDSWithDG(dm, NULL, fieldNum, vec, NULL, field)); 120151a454edSToby Isaac PetscFunctionReturn(0); 120251a454edSToby Isaac } 1203