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 PetscInt fieldNum; 1051a454edSToby Isaac Vec vec; 1151a454edSToby Isaac PetscInt height; 1251a454edSToby Isaac PetscObject *disc; 1351a454edSToby Isaac PetscBool multifieldVec; 1451a454edSToby Isaac } 1551a454edSToby Isaac DMField_DS; 1651a454edSToby Isaac 1751a454edSToby Isaac static PetscErrorCode DMFieldDestroy_DS(DMField field) 1851a454edSToby Isaac { 1951a454edSToby Isaac DMField_DS *dsfield; 2051a454edSToby Isaac PetscInt i; 2151a454edSToby Isaac PetscErrorCode ierr; 2251a454edSToby Isaac 2351a454edSToby Isaac PetscFunctionBegin; 2451a454edSToby Isaac dsfield = (DMField_DS *) field->data; 2551a454edSToby Isaac ierr = VecDestroy(&dsfield->vec);CHKERRQ(ierr); 2651a454edSToby Isaac for (i = 0; i < dsfield->height; i++) { 2751a454edSToby Isaac ierr = PetscObjectDereference(dsfield->disc[i]);CHKERRQ(ierr); 2851a454edSToby Isaac } 2951a454edSToby Isaac ierr = PetscFree(dsfield->disc);CHKERRQ(ierr); 3051a454edSToby Isaac ierr = PetscFree(dsfield);CHKERRQ(ierr); 3151a454edSToby Isaac PetscFunctionReturn(0); 3251a454edSToby Isaac } 3351a454edSToby Isaac 3451a454edSToby Isaac static PetscErrorCode DMFieldView_DS(DMField field,PetscViewer viewer) 3551a454edSToby Isaac { 3651a454edSToby Isaac DMField_DS *dsfield = (DMField_DS *) field->data; 3751a454edSToby Isaac PetscBool iascii; 3851a454edSToby Isaac PetscObject disc; 3951a454edSToby Isaac PetscErrorCode ierr; 4051a454edSToby Isaac 4151a454edSToby Isaac PetscFunctionBegin; 4251a454edSToby Isaac ierr = PetscObjectTypeCompare((PetscObject)viewer,PETSCVIEWERASCII,&iascii);CHKERRQ(ierr); 4351a454edSToby Isaac disc = dsfield->disc[0]; 4451a454edSToby Isaac if (iascii) { 4551a454edSToby Isaac PetscViewerASCIIPrintf(viewer, "PetscDS field %D\n",dsfield->fieldNum);CHKERRQ(ierr); 4651a454edSToby Isaac ierr = PetscViewerASCIIPushTab(viewer);CHKERRQ(ierr); 4751a454edSToby Isaac ierr = PetscObjectView(disc,viewer);CHKERRQ(ierr); 4851a454edSToby Isaac ierr = PetscViewerASCIIPopTab(viewer);CHKERRQ(ierr); 4951a454edSToby Isaac } 5051a454edSToby Isaac ierr = PetscViewerASCIIPushTab(viewer);CHKERRQ(ierr); 5151a454edSToby Isaac if (dsfield->multifieldVec) { 5251a454edSToby Isaac SETERRQ(PetscObjectComm((PetscObject)field),PETSC_ERR_SUP,"View of subfield not implemented yet"); 5351a454edSToby Isaac } else { 5451a454edSToby Isaac ierr = VecView(dsfield->vec,viewer);CHKERRQ(ierr); 5551a454edSToby Isaac } 5651a454edSToby Isaac ierr = PetscViewerASCIIPopTab(viewer);CHKERRQ(ierr); 5751a454edSToby Isaac PetscFunctionReturn(0); 5851a454edSToby Isaac } 5951a454edSToby Isaac 6051a454edSToby Isaac static PetscErrorCode DMFieldDSGetHeightDisc(DMField field, PetscInt height, PetscObject *disc) 6151a454edSToby Isaac { 6251a454edSToby Isaac DMField_DS *dsfield = (DMField_DS *) field->data; 6351a454edSToby Isaac PetscErrorCode ierr; 6451a454edSToby Isaac 6551a454edSToby Isaac PetscFunctionBegin; 6651a454edSToby Isaac if (!dsfield->disc[height]) { 6751a454edSToby Isaac PetscClassId id; 6851a454edSToby Isaac 6951a454edSToby Isaac ierr = PetscObjectGetClassId(dsfield->disc[0],&id);CHKERRQ(ierr); 7051a454edSToby Isaac if (id == PETSCFE_CLASSID) { 7151a454edSToby Isaac PetscFE fe = (PetscFE) dsfield->disc[0]; 7251a454edSToby Isaac 7351a454edSToby Isaac ierr = PetscFECreateHeightTrace(fe,height,(PetscFE *)&dsfield->disc[height]);CHKERRQ(ierr); 7451a454edSToby Isaac } 7551a454edSToby Isaac } 7651a454edSToby Isaac *disc = dsfield->disc[height]; 7751a454edSToby Isaac PetscFunctionReturn(0); 7851a454edSToby Isaac } 7951a454edSToby Isaac 8062bd480fSMatthew G. Knepley /* y[m,c] = A[m,n,c] . b[n] */ 8151a454edSToby Isaac #define DMFieldDSdot(y,A,b,m,n,c,cast) \ 8251a454edSToby Isaac do { \ 8351a454edSToby Isaac PetscInt _i, _j, _k; \ 8451a454edSToby Isaac for (_i = 0; _i < (m); _i++) { \ 8551a454edSToby Isaac for (_k = 0; _k < (c); _k++) { \ 8651a454edSToby Isaac (y)[_i * (c) + _k] = 0.; \ 8751a454edSToby Isaac } \ 8851a454edSToby Isaac for (_j = 0; _j < (n); _j++) { \ 8951a454edSToby Isaac for (_k = 0; _k < (c); _k++) { \ 9051a454edSToby Isaac (y)[_i * (c) + _k] += (A)[(_i * (n) + _j) * (c) + _k] * cast((b)[_j]); \ 9151a454edSToby Isaac } \ 9251a454edSToby Isaac } \ 9351a454edSToby Isaac } \ 9451a454edSToby Isaac } while (0) 9551a454edSToby Isaac 96ef0bb6c7SMatthew G. Knepley /* TODO: Reorganize interface so that I can reuse a tabulation rather than mallocing each time */ 9751a454edSToby Isaac static PetscErrorCode DMFieldEvaluateFE_DS(DMField field, IS pointIS, PetscQuadrature quad, PetscDataType type, void *B, void *D, void *H) 9851a454edSToby Isaac { 9951a454edSToby Isaac DMField_DS *dsfield = (DMField_DS *) field->data; 10051a454edSToby Isaac DM dm; 10151a454edSToby Isaac PetscObject disc; 10251a454edSToby Isaac PetscClassId classid; 10351a454edSToby Isaac PetscInt nq, nc, dim, meshDim, numCells; 10451a454edSToby Isaac PetscSection section; 10551a454edSToby Isaac const PetscReal *qpoints; 10651a454edSToby Isaac PetscBool isStride; 10751a454edSToby Isaac const PetscInt *points = NULL; 10851a454edSToby Isaac PetscInt sfirst = -1, stride = -1; 10951a454edSToby Isaac PetscErrorCode ierr; 11051a454edSToby Isaac 11151a454edSToby Isaac PetscFunctionBeginHot; 11251a454edSToby Isaac dm = field->dm; 11351a454edSToby Isaac nc = field->numComponents; 11451a454edSToby Isaac ierr = PetscQuadratureGetData(quad,&dim,NULL,&nq,&qpoints,NULL);CHKERRQ(ierr); 115f99c8401SToby Isaac ierr = DMFieldDSGetHeightDisc(field,dsfield->height - 1 - dim,&disc);CHKERRQ(ierr); 11651a454edSToby Isaac ierr = DMGetDimension(dm,&meshDim);CHKERRQ(ierr); 11792fd8e1eSJed Brown ierr = DMGetLocalSection(dm,§ion);CHKERRQ(ierr); 11851a454edSToby Isaac ierr = PetscSectionGetField(section,dsfield->fieldNum,§ion);CHKERRQ(ierr); 11951a454edSToby Isaac ierr = PetscObjectGetClassId(disc,&classid);CHKERRQ(ierr); 12051a454edSToby Isaac /* TODO: batch */ 12151a454edSToby Isaac ierr = PetscObjectTypeCompare((PetscObject)pointIS,ISSTRIDE,&isStride);CHKERRQ(ierr); 12251a454edSToby Isaac ierr = ISGetLocalSize(pointIS,&numCells);CHKERRQ(ierr); 12351a454edSToby Isaac if (isStride) { 12451a454edSToby Isaac ierr = ISStrideGetInfo(pointIS,&sfirst,&stride);CHKERRQ(ierr); 12551a454edSToby Isaac } else { 12651a454edSToby Isaac ierr = ISGetIndices(pointIS,&points);CHKERRQ(ierr); 12751a454edSToby Isaac } 12851a454edSToby Isaac if (classid == PETSCFE_CLASSID) { 12951a454edSToby Isaac PetscFE fe = (PetscFE) disc; 13051a454edSToby Isaac PetscInt feDim, i; 131ef0bb6c7SMatthew G. Knepley PetscInt K = H ? 2 : (D ? 1 : (B ? 0 : -1)); 132ef0bb6c7SMatthew G. Knepley PetscTabulation T; 13351a454edSToby Isaac 13451a454edSToby Isaac ierr = PetscFEGetDimension(fe,&feDim);CHKERRQ(ierr); 135ef0bb6c7SMatthew G. Knepley ierr = PetscFECreateTabulation(fe,1,nq,qpoints,K,&T);CHKERRQ(ierr); 13651a454edSToby Isaac for (i = 0; i < numCells; i++) { 13751a454edSToby Isaac PetscInt c = isStride ? (sfirst + i * stride) : points[i]; 1382710589cSToby Isaac PetscInt closureSize; 1392710589cSToby Isaac PetscScalar *elem = NULL; 14051a454edSToby Isaac 14151a454edSToby Isaac ierr = DMPlexVecGetClosure(dm,section,dsfield->vec,c,&closureSize,&elem);CHKERRQ(ierr); 14251a454edSToby Isaac if (B) { 14362bd480fSMatthew G. Knepley /* field[c] = T[q,b,c] . coef[b], so v[c] = T[q,b,c] . coords[b] */ 14451a454edSToby Isaac if (type == PETSC_SCALAR) { 14551a454edSToby Isaac PetscScalar *cB = &((PetscScalar *) B)[nc * nq * i]; 14651a454edSToby Isaac 147ef0bb6c7SMatthew G. Knepley DMFieldDSdot(cB,T->T[0],elem,nq,feDim,nc,(PetscScalar)); 14851a454edSToby Isaac } else { 14951a454edSToby Isaac PetscReal *cB = &((PetscReal *) B)[nc * nq * i]; 15051a454edSToby Isaac 151ef0bb6c7SMatthew G. Knepley DMFieldDSdot(cB,T->T[0],elem,nq,feDim,nc,PetscRealPart); 15251a454edSToby Isaac } 15351a454edSToby Isaac } 15451a454edSToby Isaac if (D) { 15551a454edSToby Isaac if (type == PETSC_SCALAR) { 15651a454edSToby Isaac PetscScalar *cD = &((PetscScalar *) D)[nc * nq * dim * i]; 15751a454edSToby Isaac 158ef0bb6c7SMatthew G. Knepley DMFieldDSdot(cD,T->T[1],elem,nq,feDim,(nc * dim),(PetscScalar)); 15951a454edSToby Isaac } else { 16051a454edSToby Isaac PetscReal *cD = &((PetscReal *) D)[nc * nq * dim * i]; 16151a454edSToby Isaac 162ef0bb6c7SMatthew G. Knepley DMFieldDSdot(cD,T->T[1],elem,nq,feDim,(nc * dim),PetscRealPart); 16351a454edSToby Isaac } 16451a454edSToby Isaac } 16551a454edSToby Isaac if (H) { 16651a454edSToby Isaac if (type == PETSC_SCALAR) { 16751a454edSToby Isaac PetscScalar *cH = &((PetscScalar *) H)[nc * nq * dim * dim * i]; 16851a454edSToby Isaac 169ef0bb6c7SMatthew G. Knepley DMFieldDSdot(cH,T->T[2],elem,nq,feDim,(nc * dim * dim),(PetscScalar)); 17051a454edSToby Isaac } else { 17151a454edSToby Isaac PetscReal *cH = &((PetscReal *) H)[nc * nq * dim * dim * i]; 17251a454edSToby Isaac 173ef0bb6c7SMatthew G. Knepley DMFieldDSdot(cH,T->T[2],elem,nq,feDim,(nc * dim * dim),PetscRealPart); 17451a454edSToby Isaac } 17551a454edSToby Isaac } 1762710589cSToby Isaac ierr = DMPlexVecRestoreClosure(dm,section,dsfield->vec,c,&closureSize,&elem);CHKERRQ(ierr); 17751a454edSToby Isaac } 178ef0bb6c7SMatthew G. Knepley ierr = PetscTabulationDestroy(&T);CHKERRQ(ierr); 1792da392ccSBarry Smith } else SETERRQ(PetscObjectComm((PetscObject)field),PETSC_ERR_SUP,"Not implemented"); 18051a454edSToby Isaac if (!isStride) { 18151a454edSToby Isaac ierr = ISRestoreIndices(pointIS,&points);CHKERRQ(ierr); 18251a454edSToby Isaac } 18351a454edSToby Isaac PetscFunctionReturn(0); 18451a454edSToby Isaac } 18551a454edSToby Isaac 186a6216909SToby Isaac static PetscErrorCode DMFieldEvaluate_DS(DMField field, Vec points, PetscDataType datatype, void *B, void *D, void *H) 187a6216909SToby Isaac { 188a6216909SToby Isaac DMField_DS *dsfield = (DMField_DS *) field->data; 189a6216909SToby Isaac PetscSF cellSF = NULL; 190a6216909SToby Isaac const PetscSFNode *cells; 191a6216909SToby Isaac PetscInt c, nFound, numCells, feDim, nc; 192a6216909SToby Isaac const PetscInt *cellDegrees; 193a6216909SToby Isaac const PetscScalar *pointsArray; 194a6216909SToby Isaac PetscScalar *cellPoints; 195a6216909SToby Isaac PetscInt gatherSize, gatherMax; 196a6216909SToby Isaac PetscInt dim, dimR, offset; 197a6216909SToby Isaac MPI_Datatype pointType; 198a6216909SToby Isaac PetscObject cellDisc; 199a6216909SToby Isaac PetscFE cellFE; 200a6216909SToby Isaac PetscClassId discID; 201a6216909SToby Isaac PetscReal *coordsReal, *coordsRef; 202a6216909SToby Isaac PetscSection section; 203a6216909SToby Isaac PetscScalar *cellBs = NULL, *cellDs = NULL, *cellHs = NULL; 204a6216909SToby Isaac PetscReal *cellBr = NULL, *cellDr = NULL, *cellHr = NULL; 2054cbe5319SToby Isaac PetscReal *v, *J, *invJ, *detJ; 206a6216909SToby Isaac PetscErrorCode ierr; 207a6216909SToby Isaac 208a6216909SToby Isaac PetscFunctionBegin; 209a6216909SToby Isaac nc = field->numComponents; 21092fd8e1eSJed Brown ierr = DMGetLocalSection(field->dm,§ion);CHKERRQ(ierr); 211a6216909SToby Isaac ierr = DMFieldDSGetHeightDisc(field,0,&cellDisc);CHKERRQ(ierr); 212a6216909SToby Isaac ierr = PetscObjectGetClassId(cellDisc, &discID);CHKERRQ(ierr); 213a6216909SToby Isaac if (discID != PETSCFE_CLASSID) SETERRQ(PETSC_COMM_SELF,PETSC_ERR_PLIB, "Discretization type not supported\n"); 214a6216909SToby Isaac cellFE = (PetscFE) cellDisc; 215a6216909SToby Isaac ierr = PetscFEGetDimension(cellFE,&feDim);CHKERRQ(ierr); 216a6216909SToby Isaac ierr = DMGetCoordinateDim(field->dm, &dim);CHKERRQ(ierr); 217a6216909SToby Isaac ierr = DMGetDimension(field->dm, &dimR);CHKERRQ(ierr); 218a6216909SToby Isaac ierr = DMLocatePoints(field->dm, points, DM_POINTLOCATION_NONE, &cellSF);CHKERRQ(ierr); 219a6216909SToby Isaac ierr = PetscSFGetGraph(cellSF, &numCells, &nFound, NULL, &cells);CHKERRQ(ierr); 220a6216909SToby Isaac for (c = 0; c < nFound; c++) { 221a6216909SToby Isaac if (cells[c].index < 0) SETERRQ1(PetscObjectComm((PetscObject)points),PETSC_ERR_ARG_WRONG, "Point %D could not be located\n", c); 222a6216909SToby Isaac } 223a6216909SToby Isaac ierr = PetscSFComputeDegreeBegin(cellSF,&cellDegrees);CHKERRQ(ierr); 224a6216909SToby Isaac ierr = PetscSFComputeDegreeEnd(cellSF,&cellDegrees);CHKERRQ(ierr); 225a6216909SToby Isaac for (c = 0, gatherSize = 0, gatherMax = 0; c < numCells; c++) { 226a6216909SToby Isaac gatherMax = PetscMax(gatherMax,cellDegrees[c]); 227a6216909SToby Isaac gatherSize += cellDegrees[c]; 228a6216909SToby Isaac } 229a6216909SToby Isaac ierr = PetscMalloc3(gatherSize*dim,&cellPoints,gatherMax*dim,&coordsReal,gatherMax*dimR,&coordsRef);CHKERRQ(ierr); 2304cbe5319SToby Isaac ierr = PetscMalloc4(gatherMax*dimR,&v,gatherMax*dimR*dimR,&J,gatherMax*dimR*dimR,&invJ,gatherMax,&detJ);CHKERRQ(ierr); 231a6216909SToby Isaac if (datatype == PETSC_SCALAR) { 232a6216909SToby Isaac ierr = PetscMalloc3(B ? nc * gatherSize : 0, &cellBs, D ? nc * dim * gatherSize : 0, &cellDs, H ? nc * dim * dim * gatherSize : 0, &cellHs);CHKERRQ(ierr); 233a6216909SToby Isaac } else { 234a6216909SToby Isaac ierr = PetscMalloc3(B ? nc * gatherSize : 0, &cellBr, D ? nc * dim * gatherSize : 0, &cellDr, H ? nc * dim * dim * gatherSize : 0, &cellHr);CHKERRQ(ierr); 235a6216909SToby Isaac } 236a6216909SToby Isaac 237ffc4695bSBarry Smith ierr = MPI_Type_contiguous(dim,MPIU_SCALAR,&pointType);CHKERRMPI(ierr); 238ffc4695bSBarry Smith ierr = MPI_Type_commit(&pointType);CHKERRMPI(ierr); 239a6216909SToby Isaac ierr = VecGetArrayRead(points,&pointsArray);CHKERRQ(ierr); 240a6216909SToby Isaac ierr = PetscSFGatherBegin(cellSF, pointType, pointsArray, cellPoints);CHKERRQ(ierr); 241a6216909SToby Isaac ierr = PetscSFGatherEnd(cellSF, pointType, pointsArray, cellPoints);CHKERRQ(ierr); 242a6216909SToby Isaac ierr = VecRestoreArrayRead(points,&pointsArray);CHKERRQ(ierr); 243a6216909SToby Isaac for (c = 0, offset = 0; c < numCells; c++) { 244a6216909SToby Isaac PetscInt nq = cellDegrees[c], p; 245a6216909SToby Isaac 246a6216909SToby Isaac if (nq) { 247ef0bb6c7SMatthew G. Knepley PetscInt K = H ? 2 : (D ? 1 : (B ? 0 : -1)); 248ef0bb6c7SMatthew G. Knepley PetscTabulation T; 249a6216909SToby Isaac PetscInt closureSize; 250a6216909SToby Isaac PetscScalar *elem = NULL; 2514cbe5319SToby Isaac PetscReal *quadPoints; 2524cbe5319SToby Isaac PetscQuadrature quad; 2534cbe5319SToby Isaac PetscInt d, e, f, g; 254a6216909SToby Isaac 2554d1a973fSToby Isaac for (p = 0; p < dim * nq; p++) coordsReal[p] = PetscRealPart(cellPoints[dim * offset + p]); 256a6216909SToby Isaac ierr = DMPlexCoordinatesToReference(field->dm, c, nq, coordsReal, coordsRef);CHKERRQ(ierr); 257ef0bb6c7SMatthew G. Knepley ierr = PetscFECreateTabulation(cellFE,1,nq,coordsRef,K,&T);CHKERRQ(ierr); 2584cbe5319SToby Isaac ierr = PetscQuadratureCreate(PETSC_COMM_SELF, &quad);CHKERRQ(ierr); 2594cbe5319SToby Isaac ierr = PetscMalloc1(dimR * nq, &quadPoints);CHKERRQ(ierr); 2604cbe5319SToby Isaac for (p = 0; p < dimR * nq; p++) quadPoints[p] = coordsRef[p]; 2614cbe5319SToby Isaac ierr = PetscQuadratureSetData(quad, dimR, 0, nq, quadPoints, NULL);CHKERRQ(ierr); 2624cbe5319SToby Isaac ierr = DMPlexComputeCellGeometryFEM(field->dm, c, quad, v, J, invJ, detJ);CHKERRQ(ierr); 2634cbe5319SToby Isaac ierr = PetscQuadratureDestroy(&quad);CHKERRQ(ierr); 264a6216909SToby Isaac ierr = DMPlexVecGetClosure(field->dm,section,dsfield->vec,c,&closureSize,&elem);CHKERRQ(ierr); 265a6216909SToby Isaac if (B) { 266a6216909SToby Isaac if (datatype == PETSC_SCALAR) { 267a6216909SToby Isaac PetscScalar *cB = &cellBs[nc * offset]; 268a6216909SToby Isaac 269ef0bb6c7SMatthew G. Knepley DMFieldDSdot(cB,T->T[0],elem,nq,feDim,nc,(PetscScalar)); 270a6216909SToby Isaac } else { 271a6216909SToby Isaac PetscReal *cB = &cellBr[nc * offset]; 272a6216909SToby Isaac 273ef0bb6c7SMatthew G. Knepley DMFieldDSdot(cB,T->T[0],elem,nq,feDim,nc,PetscRealPart); 274a6216909SToby Isaac } 275a6216909SToby Isaac } 276a6216909SToby Isaac if (D) { 277a6216909SToby Isaac if (datatype == PETSC_SCALAR) { 278a6216909SToby Isaac PetscScalar *cD = &cellDs[nc * dim * offset]; 279a6216909SToby Isaac 280ef0bb6c7SMatthew G. Knepley DMFieldDSdot(cD,T->T[1],elem,nq,feDim,(nc * dim),(PetscScalar)); 2814cbe5319SToby Isaac for (p = 0; p < nq; p++) { 2824cbe5319SToby Isaac for (g = 0; g < nc; g++) { 2834d1a973fSToby Isaac PetscScalar vs[3]; 2844d1a973fSToby Isaac 2854cbe5319SToby Isaac for (d = 0; d < dimR; d++) { 2864d1a973fSToby Isaac vs[d] = 0.; 2874cbe5319SToby Isaac for (e = 0; e < dimR; e++) { 2884d1a973fSToby Isaac vs[d] += invJ[dimR * dimR * p + e * dimR + d] * cD[(nc * p + g) * dimR + e]; 2894cbe5319SToby Isaac } 2904cbe5319SToby Isaac } 2914cbe5319SToby Isaac for (d = 0; d < dimR; d++) { 2924d1a973fSToby Isaac cD[(nc * p + g) * dimR + d] = vs[d]; 2934cbe5319SToby Isaac } 2944cbe5319SToby Isaac } 2954cbe5319SToby Isaac } 296a6216909SToby Isaac } else { 297a6216909SToby Isaac PetscReal *cD = &cellDr[nc * dim * offset]; 298a6216909SToby Isaac 299ef0bb6c7SMatthew G. Knepley DMFieldDSdot(cD,T->T[1],elem,nq,feDim,(nc * dim),PetscRealPart); 3004cbe5319SToby Isaac for (p = 0; p < nq; p++) { 3014cbe5319SToby Isaac for (g = 0; g < nc; g++) { 3024cbe5319SToby Isaac for (d = 0; d < dimR; d++) { 3034cbe5319SToby Isaac v[d] = 0.; 3044cbe5319SToby Isaac for (e = 0; e < dimR; e++) { 3054cbe5319SToby Isaac v[d] += invJ[dimR * dimR * p + e * dimR + d] * cD[(nc * p + g) * dimR + e]; 3064cbe5319SToby Isaac } 3074cbe5319SToby Isaac } 3084cbe5319SToby Isaac for (d = 0; d < dimR; d++) { 3094cbe5319SToby Isaac cD[(nc * p + g) * dimR + d] = v[d]; 3104cbe5319SToby Isaac } 3114cbe5319SToby Isaac } 3124cbe5319SToby Isaac } 313a6216909SToby Isaac } 314a6216909SToby Isaac } 315a6216909SToby Isaac if (H) { 316a6216909SToby Isaac if (datatype == PETSC_SCALAR) { 317a6216909SToby Isaac PetscScalar *cH = &cellHs[nc * dim * dim * offset]; 318a6216909SToby Isaac 319ef0bb6c7SMatthew G. Knepley DMFieldDSdot(cH,T->T[2],elem,nq,feDim,(nc * dim * dim),(PetscScalar)); 3204cbe5319SToby Isaac for (p = 0; p < nq; p++) { 3214cbe5319SToby Isaac for (g = 0; g < nc * dimR; g++) { 3224d1a973fSToby Isaac PetscScalar vs[3]; 3234d1a973fSToby Isaac 3244cbe5319SToby Isaac for (d = 0; d < dimR; d++) { 3254d1a973fSToby Isaac vs[d] = 0.; 3264cbe5319SToby Isaac for (e = 0; e < dimR; e++) { 3274d1a973fSToby Isaac vs[d] += invJ[dimR * dimR * p + e * dimR + d] * cH[(nc * dimR * p + g) * dimR + e]; 3284cbe5319SToby Isaac } 3294cbe5319SToby Isaac } 3304cbe5319SToby Isaac for (d = 0; d < dimR; d++) { 3314d1a973fSToby Isaac cH[(nc * dimR * p + g) * dimR + d] = vs[d]; 3324cbe5319SToby Isaac } 3334cbe5319SToby Isaac } 3344cbe5319SToby Isaac for (g = 0; g < nc; g++) { 3354cbe5319SToby Isaac for (f = 0; f < dimR; f++) { 3364d1a973fSToby Isaac PetscScalar vs[3]; 3374d1a973fSToby Isaac 3384cbe5319SToby Isaac for (d = 0; d < dimR; d++) { 3394d1a973fSToby Isaac vs[d] = 0.; 3404cbe5319SToby Isaac for (e = 0; e < dimR; e++) { 3414d1a973fSToby Isaac vs[d] += invJ[dimR * dimR * p + e * dimR + d] * cH[((nc * p + g) * dimR + e) * dimR + f]; 3424cbe5319SToby Isaac } 3434cbe5319SToby Isaac } 3444cbe5319SToby Isaac for (d = 0; d < dimR; d++) { 3454d1a973fSToby Isaac cH[((nc * p + g) * dimR + d) * dimR + f] = vs[d]; 3464cbe5319SToby Isaac } 3474cbe5319SToby Isaac } 3484cbe5319SToby Isaac } 3494cbe5319SToby Isaac } 350a6216909SToby Isaac } else { 351a6216909SToby Isaac PetscReal *cH = &cellHr[nc * dim * dim * offset]; 352a6216909SToby Isaac 353ef0bb6c7SMatthew G. Knepley DMFieldDSdot(cH,T->T[2],elem,nq,feDim,(nc * dim * dim),PetscRealPart); 3544cbe5319SToby Isaac for (p = 0; p < nq; p++) { 3554cbe5319SToby Isaac for (g = 0; g < nc * dimR; g++) { 3564cbe5319SToby Isaac for (d = 0; d < dimR; d++) { 3574cbe5319SToby Isaac v[d] = 0.; 3584cbe5319SToby Isaac for (e = 0; e < dimR; e++) { 3594cbe5319SToby Isaac v[d] += invJ[dimR * dimR * p + e * dimR + d] * cH[(nc * dimR * p + g) * dimR + e]; 3604cbe5319SToby Isaac } 3614cbe5319SToby Isaac } 3624cbe5319SToby Isaac for (d = 0; d < dimR; d++) { 3634cbe5319SToby Isaac cH[(nc * dimR * p + g) * dimR + d] = v[d]; 3644cbe5319SToby Isaac } 3654cbe5319SToby Isaac } 3664cbe5319SToby Isaac for (g = 0; g < nc; g++) { 3674cbe5319SToby Isaac for (f = 0; f < dimR; f++) { 3684cbe5319SToby Isaac for (d = 0; d < dimR; d++) { 3694cbe5319SToby Isaac v[d] = 0.; 3704cbe5319SToby Isaac for (e = 0; e < dimR; e++) { 3714cbe5319SToby Isaac v[d] += invJ[dimR * dimR * p + e * dimR + d] * cH[((nc * p + g) * dimR + e) * dimR + f]; 3724cbe5319SToby Isaac } 3734cbe5319SToby Isaac } 3744cbe5319SToby Isaac for (d = 0; d < dimR; d++) { 3754cbe5319SToby Isaac cH[((nc * p + g) * dimR + d) * dimR + f] = v[d]; 3764cbe5319SToby Isaac } 3774cbe5319SToby Isaac } 3784cbe5319SToby Isaac } 3794cbe5319SToby Isaac } 380a6216909SToby Isaac } 381a6216909SToby Isaac } 382a6216909SToby Isaac ierr = DMPlexVecRestoreClosure(field->dm,section,dsfield->vec,c,&closureSize,&elem);CHKERRQ(ierr); 383ef0bb6c7SMatthew G. Knepley ierr = PetscTabulationDestroy(&T);CHKERRQ(ierr); 384a6216909SToby Isaac } 385a6216909SToby Isaac offset += nq; 386a6216909SToby Isaac } 387a6216909SToby Isaac { 388a6216909SToby Isaac MPI_Datatype origtype; 3894cbe5319SToby Isaac 390a6216909SToby Isaac if (datatype == PETSC_SCALAR) { 391a6216909SToby Isaac origtype = MPIU_SCALAR; 392a6216909SToby Isaac } else { 393a6216909SToby Isaac origtype = MPIU_REAL; 394a6216909SToby Isaac } 395a6216909SToby Isaac if (B) { 396a6216909SToby Isaac MPI_Datatype Btype; 397a6216909SToby Isaac 398ffc4695bSBarry Smith ierr = MPI_Type_contiguous(nc, origtype, &Btype);CHKERRMPI(ierr); 399ffc4695bSBarry Smith ierr = MPI_Type_commit(&Btype);CHKERRMPI(ierr); 4004d1a973fSToby Isaac ierr = PetscSFScatterBegin(cellSF,Btype,(datatype == PETSC_SCALAR) ? (void *) cellBs : (void *) cellBr, B);CHKERRQ(ierr); 4014d1a973fSToby Isaac ierr = PetscSFScatterEnd(cellSF,Btype,(datatype == PETSC_SCALAR) ? (void *) cellBs : (void *) cellBr, B);CHKERRQ(ierr); 402ffc4695bSBarry Smith ierr = MPI_Type_free(&Btype);CHKERRMPI(ierr); 403a6216909SToby Isaac } 404a6216909SToby Isaac if (D) { 405a6216909SToby Isaac MPI_Datatype Dtype; 406a6216909SToby Isaac 407ffc4695bSBarry Smith ierr = MPI_Type_contiguous(nc * dim, origtype, &Dtype);CHKERRMPI(ierr); 408ffc4695bSBarry Smith ierr = MPI_Type_commit(&Dtype);CHKERRMPI(ierr); 4094d1a973fSToby Isaac ierr = PetscSFScatterBegin(cellSF,Dtype,(datatype == PETSC_SCALAR) ? (void *) cellDs : (void *) cellDr, D);CHKERRQ(ierr); 4104d1a973fSToby Isaac ierr = PetscSFScatterEnd(cellSF,Dtype,(datatype == PETSC_SCALAR) ? (void *) cellDs : (void *) cellDr, D);CHKERRQ(ierr); 411ffc4695bSBarry Smith ierr = MPI_Type_free(&Dtype);CHKERRMPI(ierr); 412a6216909SToby Isaac } 413a6216909SToby Isaac if (H) { 414a6216909SToby Isaac MPI_Datatype Htype; 415a6216909SToby Isaac 416ffc4695bSBarry Smith ierr = MPI_Type_contiguous(nc * dim * dim, origtype, &Htype);CHKERRMPI(ierr); 417ffc4695bSBarry Smith ierr = MPI_Type_commit(&Htype);CHKERRMPI(ierr); 4184d1a973fSToby Isaac ierr = PetscSFScatterBegin(cellSF,Htype,(datatype == PETSC_SCALAR) ? (void *) cellHs : (void *) cellHr, H);CHKERRQ(ierr); 4194d1a973fSToby Isaac ierr = PetscSFScatterEnd(cellSF,Htype,(datatype == PETSC_SCALAR) ? (void *) cellHs : (void *) cellHr, H);CHKERRQ(ierr); 420ffc4695bSBarry Smith ierr = MPI_Type_free(&Htype);CHKERRMPI(ierr); 421a6216909SToby Isaac } 422a6216909SToby Isaac } 4234cbe5319SToby Isaac ierr = PetscFree4(v,J,invJ,detJ);CHKERRQ(ierr); 424a6216909SToby Isaac ierr = PetscFree3(cellBr, cellDr, cellHr);CHKERRQ(ierr); 425a6216909SToby Isaac ierr = PetscFree3(cellBs, cellDs, cellHs);CHKERRQ(ierr); 426a6216909SToby Isaac ierr = PetscFree3(cellPoints,coordsReal,coordsRef);CHKERRQ(ierr); 427ffc4695bSBarry Smith ierr = MPI_Type_free(&pointType);CHKERRMPI(ierr); 428a6216909SToby Isaac ierr = PetscSFDestroy(&cellSF);CHKERRQ(ierr); 429a6216909SToby Isaac PetscFunctionReturn(0); 430a6216909SToby Isaac } 431a6216909SToby Isaac 432805e7170SToby Isaac static PetscErrorCode DMFieldEvaluateFV_DS(DMField field, IS pointIS, PetscDataType type, void *B, void *D, void *H) 433805e7170SToby Isaac { 434805e7170SToby Isaac DMField_DS *dsfield = (DMField_DS *) field->data; 435805e7170SToby Isaac PetscInt h, imin; 436805e7170SToby Isaac PetscInt dim; 437805e7170SToby Isaac PetscClassId id; 438805e7170SToby Isaac PetscQuadrature quad = NULL; 439b7260050SToby Isaac PetscInt maxDegree; 440805e7170SToby Isaac PetscFEGeom *geom; 441805e7170SToby Isaac PetscInt Nq, Nc, dimC, qNc, N; 442805e7170SToby Isaac PetscInt numPoints; 443805e7170SToby Isaac void *qB = NULL, *qD = NULL, *qH = NULL; 444805e7170SToby Isaac const PetscReal *weights; 445805e7170SToby Isaac MPI_Datatype mpitype = type == PETSC_SCALAR ? MPIU_SCALAR : MPIU_REAL; 446805e7170SToby Isaac PetscObject disc; 447805e7170SToby Isaac DMField coordField; 448805e7170SToby Isaac PetscErrorCode ierr; 449805e7170SToby Isaac 450805e7170SToby Isaac PetscFunctionBegin; 451805e7170SToby Isaac Nc = field->numComponents; 452805e7170SToby Isaac ierr = DMGetCoordinateDim(field->dm, &dimC);CHKERRQ(ierr); 453805e7170SToby Isaac ierr = DMGetDimension(field->dm, &dim);CHKERRQ(ierr); 454c4e6da2cSBarry Smith ierr = ISGetLocalSize(pointIS, &numPoints);CHKERRQ(ierr); 455805e7170SToby Isaac ierr = ISGetMinMax(pointIS,&imin,NULL);CHKERRQ(ierr); 456805e7170SToby Isaac for (h = 0; h < dsfield->height; h++) { 457805e7170SToby Isaac PetscInt hEnd; 458805e7170SToby Isaac 459805e7170SToby Isaac ierr = DMPlexGetHeightStratum(field->dm,h,NULL,&hEnd);CHKERRQ(ierr); 460805e7170SToby Isaac if (imin < hEnd) break; 461805e7170SToby Isaac } 462805e7170SToby Isaac dim -= h; 463805e7170SToby Isaac ierr = DMFieldDSGetHeightDisc(field,h,&disc);CHKERRQ(ierr); 464805e7170SToby Isaac ierr = PetscObjectGetClassId(disc,&id);CHKERRQ(ierr); 465805e7170SToby Isaac if (id != PETSCFE_CLASSID) SETERRQ(PETSC_COMM_SELF, PETSC_ERR_PLIB, "Discretization not supported\n"); 466805e7170SToby Isaac ierr = DMGetCoordinateField(field->dm, &coordField);CHKERRQ(ierr); 467b7260050SToby Isaac ierr = DMFieldGetDegree(coordField, pointIS, NULL, &maxDegree);CHKERRQ(ierr); 468b7260050SToby Isaac if (maxDegree <= 1) { 469805e7170SToby Isaac ierr = DMFieldCreateDefaultQuadrature(coordField, pointIS, &quad);CHKERRQ(ierr); 470805e7170SToby Isaac } 471805e7170SToby Isaac if (!quad) {ierr = DMFieldCreateDefaultQuadrature(field, pointIS, &quad);CHKERRQ(ierr);} 472805e7170SToby Isaac if (!quad) SETERRQ(PETSC_COMM_SELF, PETSC_ERR_PLIB, "Could not determine quadrature for cell averages\n"); 473805e7170SToby Isaac ierr = DMFieldCreateFEGeom(coordField,pointIS,quad,PETSC_FALSE,&geom);CHKERRQ(ierr); 474805e7170SToby Isaac ierr = PetscQuadratureGetData(quad, NULL, &qNc, &Nq, NULL, &weights);CHKERRQ(ierr); 475805e7170SToby Isaac if (qNc != 1) SETERRQ(PETSC_COMM_SELF, PETSC_ERR_PLIB, "Expected scalar quadrature components\n"); 476805e7170SToby Isaac N = numPoints * Nq * Nc; 477*60d4fc61SSatish Balay if (B) {ierr = DMGetWorkArray(field->dm, N, mpitype, &qB);CHKERRQ(ierr);} 478*60d4fc61SSatish Balay if (D) {ierr = DMGetWorkArray(field->dm, N * dimC, mpitype, &qD);CHKERRQ(ierr);} 479*60d4fc61SSatish Balay if (H) {ierr = DMGetWorkArray(field->dm, N * dimC * dimC, mpitype, &qH);CHKERRQ(ierr);} 480805e7170SToby Isaac ierr = DMFieldEvaluateFE(field,pointIS,quad,type,qB,qD,qH);CHKERRQ(ierr); 481805e7170SToby Isaac if (B) { 482805e7170SToby Isaac PetscInt i, j, k; 483805e7170SToby Isaac 484805e7170SToby Isaac if (type == PETSC_SCALAR) { 485805e7170SToby Isaac PetscScalar * sB = (PetscScalar *) B; 486805e7170SToby Isaac PetscScalar * sqB = (PetscScalar *) qB; 487805e7170SToby Isaac 488805e7170SToby Isaac for (i = 0; i < numPoints; i++) { 489805e7170SToby Isaac PetscReal vol = 0.; 490805e7170SToby Isaac 491805e7170SToby Isaac for (j = 0; j < Nc; j++) {sB[i * Nc + j] = 0.;} 492805e7170SToby Isaac for (k = 0; k < Nq; k++) { 493805e7170SToby Isaac vol += geom->detJ[i * Nq + k] * weights[k]; 494805e7170SToby Isaac for (j = 0; j < Nc; j++) { 495805e7170SToby Isaac sB[i * Nc + j] += geom->detJ[i * Nq + k] * weights[k] * sqB[ (i * Nq + k) * Nc + j]; 496805e7170SToby Isaac } 497805e7170SToby Isaac } 49862bd480fSMatthew G. Knepley for (k = 0; k < Nc; k++) sB[i * Nc + k] /= vol; 499805e7170SToby Isaac } 500805e7170SToby Isaac } else { 501805e7170SToby Isaac PetscReal * rB = (PetscReal *) B; 502805e7170SToby Isaac PetscReal * rqB = (PetscReal *) qB; 503805e7170SToby Isaac 504805e7170SToby Isaac for (i = 0; i < numPoints; i++) { 505805e7170SToby Isaac PetscReal vol = 0.; 506805e7170SToby Isaac 507805e7170SToby Isaac for (j = 0; j < Nc; j++) {rB[i * Nc + j] = 0.;} 508805e7170SToby Isaac for (k = 0; k < Nq; k++) { 509805e7170SToby Isaac vol += geom->detJ[i * Nq + k] * weights[k]; 510805e7170SToby Isaac for (j = 0; j < Nc; j++) { 511805e7170SToby Isaac rB[i * Nc + j] += weights[k] * rqB[ (i * Nq + k) * Nc + j]; 512805e7170SToby Isaac } 513805e7170SToby Isaac } 514805e7170SToby Isaac for (k = 0; k < Nc; k++) rB[i * Nc + k] /= vol; 515805e7170SToby Isaac } 516805e7170SToby Isaac } 517805e7170SToby Isaac } 518805e7170SToby Isaac if (D) { 519805e7170SToby Isaac PetscInt i, j, k, l, m; 520805e7170SToby Isaac 521805e7170SToby Isaac if (type == PETSC_SCALAR) { 522805e7170SToby Isaac PetscScalar * sD = (PetscScalar *) D; 523805e7170SToby Isaac PetscScalar * sqD = (PetscScalar *) qD; 524805e7170SToby Isaac 525805e7170SToby Isaac for (i = 0; i < numPoints; i++) { 526805e7170SToby Isaac PetscReal vol = 0.; 527805e7170SToby Isaac 528805e7170SToby Isaac for (j = 0; j < Nc * dimC; j++) {sD[i * Nc * dimC + j] = 0.;} 529805e7170SToby Isaac for (k = 0; k < Nq; k++) { 530805e7170SToby Isaac vol += geom->detJ[i * Nq + k] * weights[k]; 531805e7170SToby Isaac for (j = 0; j < Nc; j++) { 532805e7170SToby Isaac PetscScalar pD[3] = {0.,0.,0.}; 533805e7170SToby Isaac 534805e7170SToby Isaac for (l = 0; l < dimC; l++) { 535805e7170SToby Isaac for (m = 0; m < dim; m++) { 536805e7170SToby Isaac pD[l] += geom->invJ[((i * Nq + k) * dimC + m) * dimC + l] * sqD[((i * Nq + k) * Nc + j) * dim + m]; 537805e7170SToby Isaac } 538805e7170SToby Isaac } 539805e7170SToby Isaac for (l = 0; l < dimC; l++) { 540805e7170SToby Isaac sD[(i * Nc + j) * dimC + l] += geom->detJ[i * Nq + k] * weights[k] * pD[l]; 541805e7170SToby Isaac } 542805e7170SToby Isaac } 543805e7170SToby Isaac } 544805e7170SToby Isaac for (k = 0; k < Nc * dimC; k++) sD[i * Nc * dimC + k] /= vol; 545805e7170SToby Isaac } 546805e7170SToby Isaac } else { 547805e7170SToby Isaac PetscReal * rD = (PetscReal *) D; 548805e7170SToby Isaac PetscReal * rqD = (PetscReal *) qD; 549805e7170SToby Isaac 550805e7170SToby Isaac for (i = 0; i < numPoints; i++) { 551805e7170SToby Isaac PetscReal vol = 0.; 552805e7170SToby Isaac 553805e7170SToby Isaac for (j = 0; j < Nc * dimC; j++) {rD[i * Nc * dimC + j] = 0.;} 554805e7170SToby Isaac for (k = 0; k < Nq; k++) { 555805e7170SToby Isaac vol += geom->detJ[i * Nq + k] * weights[k]; 556805e7170SToby Isaac for (j = 0; j < Nc; j++) { 557805e7170SToby Isaac PetscReal pD[3] = {0.,0.,0.}; 558805e7170SToby Isaac 559805e7170SToby Isaac for (l = 0; l < dimC; l++) { 560805e7170SToby Isaac for (m = 0; m < dim; m++) { 561805e7170SToby Isaac pD[l] += geom->invJ[((i * Nq + k) * dimC + m) * dimC + l] * rqD[((i * Nq + k) * Nc + j) * dim + m]; 562805e7170SToby Isaac } 563805e7170SToby Isaac } 564805e7170SToby Isaac for (l = 0; l < dimC; l++) { 565805e7170SToby Isaac rD[(i * Nc + j) * dimC + l] += geom->detJ[i * Nq + k] * weights[k] * pD[l]; 566805e7170SToby Isaac } 567805e7170SToby Isaac } 568805e7170SToby Isaac } 569805e7170SToby Isaac for (k = 0; k < Nc * dimC; k++) rD[i * Nc * dimC + k] /= vol; 570805e7170SToby Isaac } 571805e7170SToby Isaac } 572805e7170SToby Isaac } 573805e7170SToby Isaac if (H) { 574805e7170SToby Isaac PetscInt i, j, k, l, m, q, r; 575805e7170SToby Isaac 576805e7170SToby Isaac if (type == PETSC_SCALAR) { 577805e7170SToby Isaac PetscScalar * sH = (PetscScalar *) H; 578805e7170SToby Isaac PetscScalar * sqH = (PetscScalar *) qH; 579805e7170SToby Isaac 580805e7170SToby Isaac for (i = 0; i < numPoints; i++) { 581805e7170SToby Isaac PetscReal vol = 0.; 582805e7170SToby Isaac 583805e7170SToby Isaac for (j = 0; j < Nc * dimC * dimC; j++) {sH[i * Nc * dimC * dimC + j] = 0.;} 584805e7170SToby Isaac for (k = 0; k < Nq; k++) { 5854d1a973fSToby Isaac const PetscReal *invJ = &geom->invJ[(i * Nq + k) * dimC * dimC]; 586805e7170SToby Isaac 587805e7170SToby Isaac vol += geom->detJ[i * Nq + k] * weights[k]; 588805e7170SToby Isaac for (j = 0; j < Nc; j++) { 589805e7170SToby Isaac PetscScalar pH[3][3] = {{0.,0.,0.},{0.,0.,0.},{0.,0.,0.}}; 590805e7170SToby Isaac const PetscScalar *spH = &sqH[((i * Nq + k) * Nc + j) * dimC * dimC]; 591805e7170SToby Isaac 592805e7170SToby Isaac for (l = 0; l < dimC; l++) { 593805e7170SToby Isaac for (m = 0; m < dimC; m++) { 594805e7170SToby Isaac for (q = 0; q < dim; q++) { 595805e7170SToby Isaac for (r = 0; r < dim; r++) { 596805e7170SToby Isaac pH[l][m] += invJ[q * dimC + l] * invJ[r * dimC + m] * spH[q * dim + r]; 597805e7170SToby Isaac } 598805e7170SToby Isaac } 599805e7170SToby Isaac } 600805e7170SToby Isaac } 601805e7170SToby Isaac for (l = 0; l < dimC; l++) { 602805e7170SToby Isaac for (m = 0; m < dimC; m++) { 603805e7170SToby Isaac sH[(i * Nc + j) * dimC * dimC + l * dimC + m] += geom->detJ[i * Nq + k] * weights[k] * pH[l][m]; 604805e7170SToby Isaac } 605805e7170SToby Isaac } 606805e7170SToby Isaac } 607805e7170SToby Isaac } 608805e7170SToby Isaac for (k = 0; k < Nc * dimC * dimC; k++) sH[i * Nc * dimC * dimC + k] /= vol; 609805e7170SToby Isaac } 610805e7170SToby Isaac } else { 611805e7170SToby Isaac PetscReal * rH = (PetscReal *) H; 612805e7170SToby Isaac PetscReal * rqH = (PetscReal *) qH; 613805e7170SToby Isaac 614805e7170SToby Isaac for (i = 0; i < numPoints; i++) { 615805e7170SToby Isaac PetscReal vol = 0.; 616805e7170SToby Isaac 617805e7170SToby Isaac for (j = 0; j < Nc * dimC * dimC; j++) {rH[i * Nc * dimC * dimC + j] = 0.;} 618805e7170SToby Isaac for (k = 0; k < Nq; k++) { 619805e7170SToby Isaac const PetscReal *invJ = &geom->invJ[(i * Nq + k) * dimC * dimC]; 620805e7170SToby Isaac 621805e7170SToby Isaac vol += geom->detJ[i * Nq + k] * weights[k]; 622805e7170SToby Isaac for (j = 0; j < Nc; j++) { 623805e7170SToby Isaac PetscReal pH[3][3] = {{0.,0.,0.},{0.,0.,0.},{0.,0.,0.}}; 624805e7170SToby Isaac const PetscReal *rpH = &rqH[((i * Nq + k) * Nc + j) * dimC * dimC]; 625805e7170SToby Isaac 626805e7170SToby Isaac for (l = 0; l < dimC; l++) { 627805e7170SToby Isaac for (m = 0; m < dimC; m++) { 628805e7170SToby Isaac for (q = 0; q < dim; q++) { 629805e7170SToby Isaac for (r = 0; r < dim; r++) { 630805e7170SToby Isaac pH[l][m] += invJ[q * dimC + l] * invJ[r * dimC + m] * rpH[q * dim + r]; 631805e7170SToby Isaac } 632805e7170SToby Isaac } 633805e7170SToby Isaac } 634805e7170SToby Isaac } 635805e7170SToby Isaac for (l = 0; l < dimC; l++) { 636805e7170SToby Isaac for (m = 0; m < dimC; m++) { 637805e7170SToby Isaac rH[(i * Nc + j) * dimC * dimC + l * dimC + m] += geom->detJ[i * Nq + k] * weights[k] * pH[l][m]; 638805e7170SToby Isaac } 639805e7170SToby Isaac } 640805e7170SToby Isaac } 641805e7170SToby Isaac } 642805e7170SToby Isaac for (k = 0; k < Nc * dimC * dimC; k++) rH[i * Nc * dimC * dimC + k] /= vol; 643805e7170SToby Isaac } 644805e7170SToby Isaac } 645805e7170SToby Isaac } 646*60d4fc61SSatish Balay if (B) {ierr = DMRestoreWorkArray(field->dm, N, mpitype, &qB);CHKERRQ(ierr);} 647*60d4fc61SSatish Balay if (D) {ierr = DMRestoreWorkArray(field->dm, N * dimC, mpitype, &qD);CHKERRQ(ierr);} 648*60d4fc61SSatish Balay if (H) {ierr = DMRestoreWorkArray(field->dm, N * dimC * dimC, mpitype, &qH);CHKERRQ(ierr);} 649805e7170SToby Isaac ierr = PetscFEGeomDestroy(&geom);CHKERRQ(ierr); 650805e7170SToby Isaac ierr = PetscQuadratureDestroy(&quad);CHKERRQ(ierr); 651805e7170SToby Isaac PetscFunctionReturn(0); 652805e7170SToby Isaac } 653805e7170SToby Isaac 654b7260050SToby Isaac static PetscErrorCode DMFieldGetDegree_DS(DMField field, IS pointIS, PetscInt *minDegree, PetscInt *maxDegree) 65551a454edSToby Isaac { 65651a454edSToby Isaac DMField_DS *dsfield; 65751a454edSToby Isaac PetscObject disc; 658741db25dSToby Isaac PetscInt h, imin, imax; 65951a454edSToby Isaac PetscClassId id; 66051a454edSToby Isaac PetscErrorCode ierr; 66151a454edSToby Isaac 66251a454edSToby Isaac PetscFunctionBegin; 66351a454edSToby Isaac dsfield = (DMField_DS *) field->data; 664741db25dSToby Isaac ierr = ISGetMinMax(pointIS,&imin,&imax);CHKERRQ(ierr); 665741db25dSToby Isaac if (imin >= imax) { 66651aa0bf7SToby Isaac h = 0; 66751aa0bf7SToby Isaac } else { 668f99c8401SToby Isaac for (h = 0; h < dsfield->height; h++) { 66951a454edSToby Isaac PetscInt hEnd; 67051a454edSToby Isaac 67151a454edSToby Isaac ierr = DMPlexGetHeightStratum(field->dm,h,NULL,&hEnd);CHKERRQ(ierr); 67251a454edSToby Isaac if (imin < hEnd) break; 67351a454edSToby Isaac } 67451aa0bf7SToby Isaac } 67551a454edSToby Isaac ierr = DMFieldDSGetHeightDisc(field,h,&disc);CHKERRQ(ierr); 67651a454edSToby Isaac ierr = PetscObjectGetClassId(disc,&id);CHKERRQ(ierr); 67751a454edSToby Isaac if (id == PETSCFE_CLASSID) { 67851a454edSToby Isaac PetscFE fe = (PetscFE) disc; 67951a454edSToby Isaac PetscSpace sp; 68051a454edSToby Isaac 68151a454edSToby Isaac ierr = PetscFEGetBasisSpace(fe, &sp);CHKERRQ(ierr); 682b7260050SToby Isaac ierr = PetscSpaceGetDegree(sp, minDegree, maxDegree);CHKERRQ(ierr); 68351a454edSToby Isaac } 68451a454edSToby Isaac PetscFunctionReturn(0); 68551a454edSToby Isaac } 68651a454edSToby Isaac 68751a454edSToby Isaac static PetscErrorCode DMFieldCreateDefaultQuadrature_DS(DMField field, IS pointIS, PetscQuadrature *quad) 68851a454edSToby Isaac { 6891fdf1f07SMatthew G. Knepley PetscInt h, dim, imax, imin, cellHeight; 69051a454edSToby Isaac DM dm; 69151a454edSToby Isaac DMField_DS *dsfield; 69251a454edSToby Isaac PetscObject disc; 69351a454edSToby Isaac PetscFE fe; 69451a454edSToby Isaac PetscClassId id; 69551a454edSToby Isaac PetscErrorCode ierr; 69651a454edSToby Isaac 69751a454edSToby Isaac PetscFunctionBegin; 69851a454edSToby Isaac dm = field->dm; 69951a454edSToby Isaac dsfield = (DMField_DS *) field->data; 700cd93b0e1SMatthew G. Knepley ierr = ISGetMinMax(pointIS,&imin,&imax);CHKERRQ(ierr); 70151a454edSToby Isaac ierr = DMGetDimension(dm,&dim);CHKERRQ(ierr); 70251a454edSToby Isaac for (h = 0; h <= dim; h++) { 70351a454edSToby Isaac PetscInt hStart, hEnd; 70451a454edSToby Isaac 70551a454edSToby Isaac ierr = DMPlexGetHeightStratum(dm,h,&hStart,&hEnd);CHKERRQ(ierr); 7066c041b70SSatish Balay if (imax >= hStart && imin < hEnd) break; 70751a454edSToby Isaac } 7081fdf1f07SMatthew G. Knepley ierr = DMPlexGetVTKCellHeight(dm, &cellHeight);CHKERRQ(ierr); 7091fdf1f07SMatthew G. Knepley h -= cellHeight; 71051a454edSToby Isaac *quad = NULL; 711f99c8401SToby Isaac if (h < dsfield->height) { 71251a454edSToby Isaac ierr = DMFieldDSGetHeightDisc(field,h,&disc);CHKERRQ(ierr); 71351a454edSToby Isaac ierr = PetscObjectGetClassId(disc,&id);CHKERRQ(ierr); 71451a454edSToby Isaac if (id != PETSCFE_CLASSID) PetscFunctionReturn(0); 71551a454edSToby Isaac fe = (PetscFE) disc; 71651a454edSToby Isaac ierr = PetscFEGetQuadrature(fe,quad);CHKERRQ(ierr); 71751a454edSToby Isaac ierr = PetscObjectReference((PetscObject)*quad);CHKERRQ(ierr); 71851a454edSToby Isaac } 71951a454edSToby Isaac PetscFunctionReturn(0); 72051a454edSToby Isaac } 72151a454edSToby Isaac 7220145028aSToby Isaac static PetscErrorCode DMFieldComputeFaceData_DS(DMField field, IS pointIS, PetscQuadrature quad, PetscFEGeom *geom) 7230145028aSToby Isaac { 7240145028aSToby Isaac const PetscInt *points; 7250145028aSToby Isaac PetscInt p, dim, dE, numFaces, Nq; 726b7260050SToby Isaac PetscInt maxDegree; 7270145028aSToby Isaac DMLabel depthLabel; 7280145028aSToby Isaac IS cellIS; 7290145028aSToby Isaac DM dm = field->dm; 7300145028aSToby Isaac PetscErrorCode ierr; 7310145028aSToby Isaac 7320145028aSToby Isaac PetscFunctionBegin; 7330145028aSToby Isaac dim = geom->dim; 7340145028aSToby Isaac dE = geom->dimEmbed; 7350145028aSToby Isaac ierr = DMPlexGetDepthLabel(dm, &depthLabel);CHKERRQ(ierr); 7360145028aSToby Isaac ierr = DMLabelGetStratumIS(depthLabel, dim + 1, &cellIS);CHKERRQ(ierr); 737b7260050SToby Isaac ierr = DMFieldGetDegree(field,cellIS,NULL,&maxDegree);CHKERRQ(ierr); 7380145028aSToby Isaac ierr = ISGetIndices(pointIS, &points);CHKERRQ(ierr); 7390145028aSToby Isaac numFaces = geom->numCells; 7400145028aSToby Isaac Nq = geom->numPoints; 741f15274beSMatthew Knepley /* First, set local faces and flip normals so that they are outward for the first supporting cell */ 742f15274beSMatthew Knepley for (p = 0; p < numFaces; p++) { 743f15274beSMatthew Knepley PetscInt point = points[p]; 744f15274beSMatthew Knepley PetscInt suppSize, s, coneSize, c, numChildren; 745f15274beSMatthew Knepley const PetscInt *supp, *cone, *ornt; 746f15274beSMatthew Knepley 747f15274beSMatthew Knepley ierr = DMPlexGetTreeChildren(dm, point, &numChildren, NULL);CHKERRQ(ierr); 748f15274beSMatthew Knepley if (numChildren) SETERRQ(PETSC_COMM_SELF, PETSC_ERR_PLIB, "Face data not valid for facets with children"); 749f15274beSMatthew Knepley ierr = DMPlexGetSupportSize(dm, point, &suppSize);CHKERRQ(ierr); 750f15274beSMatthew Knepley if (suppSize > 2) SETERRQ2(PETSC_COMM_SELF, PETSC_ERR_PLIB, "Point %D has %D support, expected at most 2\n", point, suppSize); 751f15274beSMatthew Knepley if (!suppSize) continue; 752f15274beSMatthew Knepley ierr = DMPlexGetSupport(dm, point, &supp);CHKERRQ(ierr); 753f15274beSMatthew Knepley for (s = 0; s < suppSize; ++s) { 754f15274beSMatthew Knepley ierr = DMPlexGetConeSize(dm, supp[s], &coneSize);CHKERRQ(ierr); 755f15274beSMatthew Knepley ierr = DMPlexGetCone(dm, supp[s], &cone);CHKERRQ(ierr); 756f15274beSMatthew Knepley for (c = 0; c < coneSize; ++c) if (cone[c] == point) break; 757f15274beSMatthew Knepley if (c == coneSize) SETERRQ2(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Invalid connectivity: point %D not found in cone of support point %D", point, supp[s]); 758f15274beSMatthew Knepley geom->face[p][s] = c; 759f15274beSMatthew Knepley } 760f15274beSMatthew Knepley ierr = DMPlexGetConeOrientation(dm, supp[0], &ornt);CHKERRQ(ierr); 761f15274beSMatthew Knepley if (ornt[geom->face[p][0]] < 0) { 762f15274beSMatthew Knepley PetscInt Np = geom->numPoints, q, dE = geom->dimEmbed, d; 763f15274beSMatthew Knepley 764f15274beSMatthew 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]; 765f15274beSMatthew Knepley } 766f15274beSMatthew Knepley } 767b7260050SToby Isaac if (maxDegree <= 1) { 7680145028aSToby Isaac PetscInt numCells, offset, *cells; 7690145028aSToby Isaac PetscFEGeom *cellGeom; 7700145028aSToby Isaac IS suppIS; 7710145028aSToby Isaac 7720145028aSToby Isaac for (p = 0, numCells = 0; p < numFaces; p++) { 7730145028aSToby Isaac PetscInt point = points[p]; 7740145028aSToby Isaac PetscInt numSupp, numChildren; 7750145028aSToby Isaac 7760145028aSToby Isaac ierr = DMPlexGetTreeChildren(dm, point, &numChildren, NULL);CHKERRQ(ierr); 7770145028aSToby Isaac if (numChildren) SETERRQ(PETSC_COMM_SELF, PETSC_ERR_PLIB, "Face data not valid for facets with children"); 7780145028aSToby Isaac ierr = DMPlexGetSupportSize(dm, point,&numSupp);CHKERRQ(ierr); 7790145028aSToby Isaac if (numSupp > 2) SETERRQ2(PETSC_COMM_SELF, PETSC_ERR_PLIB, "Point %D has %D support, expected at most 2\n", point, numSupp); 7800145028aSToby Isaac numCells += numSupp; 7810145028aSToby Isaac } 7820145028aSToby Isaac ierr = PetscMalloc1(numCells, &cells);CHKERRQ(ierr); 7830145028aSToby Isaac for (p = 0, offset = 0; p < numFaces; p++) { 7840145028aSToby Isaac PetscInt point = points[p]; 7850145028aSToby Isaac PetscInt numSupp, s; 7860145028aSToby Isaac const PetscInt *supp; 7870145028aSToby Isaac 7880145028aSToby Isaac ierr = DMPlexGetSupportSize(dm, point,&numSupp);CHKERRQ(ierr); 7890145028aSToby Isaac ierr = DMPlexGetSupport(dm, point, &supp);CHKERRQ(ierr); 7900145028aSToby Isaac for (s = 0; s < numSupp; s++, offset++) { 7910145028aSToby Isaac cells[offset] = supp[s]; 7920145028aSToby Isaac } 7930145028aSToby Isaac } 7940145028aSToby Isaac ierr = ISCreateGeneral(PETSC_COMM_SELF,numCells,cells,PETSC_USE_POINTER, &suppIS);CHKERRQ(ierr); 79562bd480fSMatthew G. Knepley ierr = DMFieldCreateFEGeom(field,suppIS,quad,PETSC_FALSE,&cellGeom);CHKERRQ(ierr); 7960145028aSToby Isaac for (p = 0, offset = 0; p < numFaces; p++) { 7970145028aSToby Isaac PetscInt point = points[p]; 7980145028aSToby Isaac PetscInt numSupp, s, q; 7990145028aSToby Isaac const PetscInt *supp; 8000145028aSToby Isaac 8010145028aSToby Isaac ierr = DMPlexGetSupportSize(dm, point,&numSupp);CHKERRQ(ierr); 8020145028aSToby Isaac ierr = DMPlexGetSupport(dm, point, &supp);CHKERRQ(ierr); 8030145028aSToby Isaac for (s = 0; s < numSupp; s++, offset++) { 8040145028aSToby Isaac for (q = 0; q < Nq * dE * dE; q++) { 80541418987SMatthew G. Knepley geom->suppJ[s][p * Nq * dE * dE + q] = cellGeom->J[offset * Nq * dE * dE + q]; 8060145028aSToby Isaac geom->suppInvJ[s][p * Nq * dE * dE + q] = cellGeom->invJ[offset * Nq * dE * dE + q]; 8070145028aSToby Isaac } 80841418987SMatthew G. Knepley for (q = 0; q < Nq; q++) geom->suppDetJ[s][p * Nq + q] = cellGeom->detJ[offset * Nq + q]; 8090145028aSToby Isaac } 8100145028aSToby Isaac } 8110145028aSToby Isaac ierr = PetscFEGeomDestroy(&cellGeom);CHKERRQ(ierr); 8120145028aSToby Isaac ierr = ISDestroy(&suppIS);CHKERRQ(ierr); 8130145028aSToby Isaac ierr = PetscFree(cells);CHKERRQ(ierr); 8140145028aSToby Isaac } else { 8150145028aSToby Isaac PetscObject faceDisc, cellDisc; 8160145028aSToby Isaac PetscClassId faceId, cellId; 8170145028aSToby Isaac PetscDualSpace dsp; 8180145028aSToby Isaac DM K; 819ba2698f1SMatthew G. Knepley DMPolytopeType ct; 8200145028aSToby Isaac PetscInt (*co)[2][3]; 8210145028aSToby Isaac PetscInt coneSize; 8220145028aSToby Isaac PetscInt **counts; 8230145028aSToby Isaac PetscInt f, i, o, q, s; 8240145028aSToby Isaac const PetscInt *coneK; 825ba2698f1SMatthew G. Knepley PetscInt eStart, minOrient, maxOrient, numOrient; 8260145028aSToby Isaac PetscInt *orients; 8270145028aSToby Isaac PetscReal **orientPoints; 8280145028aSToby Isaac PetscReal *cellPoints; 8290145028aSToby Isaac PetscReal *dummyWeights; 8300145028aSToby Isaac PetscQuadrature cellQuad = NULL; 8310145028aSToby Isaac 8320145028aSToby Isaac ierr = DMFieldDSGetHeightDisc(field, 1, &faceDisc);CHKERRQ(ierr); 8330145028aSToby Isaac ierr = DMFieldDSGetHeightDisc(field, 0, &cellDisc);CHKERRQ(ierr); 8340145028aSToby Isaac ierr = PetscObjectGetClassId(faceDisc,&faceId);CHKERRQ(ierr); 8350145028aSToby Isaac ierr = PetscObjectGetClassId(cellDisc,&cellId);CHKERRQ(ierr); 8360145028aSToby Isaac if (faceId != PETSCFE_CLASSID || cellId != PETSCFE_CLASSID) SETERRQ(PETSC_COMM_SELF, PETSC_ERR_PLIB, "Not supported\n"); 8370145028aSToby Isaac ierr = PetscFEGetDualSpace((PetscFE)cellDisc, &dsp);CHKERRQ(ierr); 8380145028aSToby Isaac ierr = PetscDualSpaceGetDM(dsp, &K);CHKERRQ(ierr); 839ba2698f1SMatthew G. Knepley ierr = DMPlexGetHeightStratum(K, 1, &eStart, NULL);CHKERRQ(ierr); 840ba2698f1SMatthew G. Knepley ierr = DMPlexGetCellType(K, eStart, &ct);CHKERRQ(ierr); 8410145028aSToby Isaac ierr = DMPlexGetConeSize(K,0,&coneSize);CHKERRQ(ierr); 8420145028aSToby Isaac ierr = DMPlexGetCone(K,0,&coneK);CHKERRQ(ierr); 843c99e0549SMatthew G. Knepley ierr = PetscMalloc2(numFaces, &co, coneSize, &counts);CHKERRQ(ierr); 844c99e0549SMatthew G. Knepley ierr = PetscMalloc1(dE*Nq, &cellPoints);CHKERRQ(ierr); 845c99e0549SMatthew G. Knepley ierr = PetscMalloc1(Nq, &dummyWeights);CHKERRQ(ierr); 846360cf244SMatthew G. Knepley ierr = PetscQuadratureCreate(PETSC_COMM_SELF, &cellQuad);CHKERRQ(ierr); 8470145028aSToby Isaac ierr = PetscQuadratureSetData(cellQuad, dE, 1, Nq, cellPoints, dummyWeights);CHKERRQ(ierr); 8480145028aSToby Isaac minOrient = PETSC_MAX_INT; 8490145028aSToby Isaac maxOrient = PETSC_MIN_INT; 8500145028aSToby Isaac for (p = 0; p < numFaces; p++) { /* record the orientation of the facet wrt the support cells */ 8510145028aSToby Isaac PetscInt point = points[p]; 8520145028aSToby Isaac PetscInt numSupp, numChildren; 8530145028aSToby Isaac const PetscInt *supp; 8540145028aSToby Isaac 8550145028aSToby Isaac ierr = DMPlexGetTreeChildren(dm, point, &numChildren, NULL);CHKERRQ(ierr); 8560145028aSToby Isaac if (numChildren) SETERRQ(PETSC_COMM_SELF, PETSC_ERR_PLIB, "Face data not valid for facets with children"); 8570145028aSToby Isaac ierr = DMPlexGetSupportSize(dm, point,&numSupp);CHKERRQ(ierr); 8580145028aSToby Isaac if (numSupp > 2) SETERRQ2(PETSC_COMM_SELF, PETSC_ERR_PLIB, "Point %D has %D support, expected at most 2\n", point, numSupp); 8590145028aSToby Isaac ierr = DMPlexGetSupport(dm, point, &supp);CHKERRQ(ierr); 8600145028aSToby Isaac for (s = 0; s < numSupp; s++) { 8610145028aSToby Isaac PetscInt cell = supp[s]; 8620145028aSToby Isaac PetscInt numCone; 8630145028aSToby Isaac const PetscInt *cone, *orient; 8640145028aSToby Isaac 8650145028aSToby Isaac ierr = DMPlexGetConeSize(dm, cell, &numCone);CHKERRQ(ierr); 8660145028aSToby Isaac if (numCone != coneSize) SETERRQ(PETSC_COMM_SELF, PETSC_ERR_PLIB, "Support point does not match reference element"); 8670145028aSToby Isaac ierr = DMPlexGetCone(dm, cell, &cone);CHKERRQ(ierr); 8680145028aSToby Isaac ierr = DMPlexGetConeOrientation(dm, cell, &orient);CHKERRQ(ierr); 8690145028aSToby Isaac for (f = 0; f < coneSize; f++) { 8700145028aSToby Isaac if (cone[f] == point) break; 8710145028aSToby Isaac } 8720145028aSToby Isaac co[p][s][0] = f; 8730145028aSToby Isaac co[p][s][1] = orient[f]; 8740145028aSToby Isaac co[p][s][2] = cell; 8750145028aSToby Isaac minOrient = PetscMin(minOrient, orient[f]); 876cd93b0e1SMatthew G. Knepley maxOrient = PetscMax(maxOrient, orient[f]); 8770145028aSToby Isaac } 8780145028aSToby Isaac for (; s < 2; s++) { 8790145028aSToby Isaac co[p][s][0] = -1; 8800145028aSToby Isaac co[p][s][1] = -1; 8810145028aSToby Isaac co[p][s][2] = -1; 8820145028aSToby Isaac } 8830145028aSToby Isaac } 8840145028aSToby Isaac numOrient = maxOrient + 1 - minOrient; 8850145028aSToby Isaac ierr = DMPlexGetCone(K,0,&coneK);CHKERRQ(ierr); 8860145028aSToby Isaac /* count all (face,orientation) doubles that appear */ 8870145028aSToby Isaac ierr = PetscCalloc2(numOrient,&orients,numOrient,&orientPoints);CHKERRQ(ierr); 888c99e0549SMatthew G. Knepley for (f = 0; f < coneSize; f++) {ierr = PetscCalloc1(numOrient+1, &counts[f]);CHKERRQ(ierr);} 8890145028aSToby Isaac for (p = 0; p < numFaces; p++) { 8900145028aSToby Isaac for (s = 0; s < 2; s++) { 8910145028aSToby Isaac if (co[p][s][0] >= 0) { 8920145028aSToby Isaac counts[co[p][s][0]][co[p][s][1] - minOrient]++; 8930145028aSToby Isaac orients[co[p][s][1] - minOrient]++; 8940145028aSToby Isaac } 8950145028aSToby Isaac } 8960145028aSToby Isaac } 8970145028aSToby Isaac for (o = 0; o < numOrient; o++) { 8980145028aSToby Isaac if (orients[o]) { 8990145028aSToby Isaac PetscInt orient = o + minOrient; 9000145028aSToby Isaac PetscInt q; 9010145028aSToby Isaac 9020145028aSToby Isaac ierr = PetscMalloc1(Nq * dim, &orientPoints[o]);CHKERRQ(ierr); 9030145028aSToby Isaac /* rotate the quadrature points appropriately */ 904ba2698f1SMatthew G. Knepley switch (ct) { 905ba2698f1SMatthew G. Knepley case DM_POLYTOPE_POINT: break; 906ba2698f1SMatthew G. Knepley case DM_POLYTOPE_SEGMENT: 9070145028aSToby Isaac if (orient == -2 || orient == 1) { 9080145028aSToby Isaac for (q = 0; q < Nq; q++) { 9090145028aSToby Isaac orientPoints[o][q] = -geom->xi[q]; 9100145028aSToby Isaac } 9110145028aSToby Isaac } else { 9120145028aSToby Isaac for (q = 0; q < Nq; q++) { 9130145028aSToby Isaac orientPoints[o][q] = geom->xi[q]; 9140145028aSToby Isaac } 9150145028aSToby Isaac } 9160145028aSToby Isaac break; 917ba2698f1SMatthew G. Knepley case DM_POLYTOPE_TRIANGLE: 9180145028aSToby Isaac for (q = 0; q < Nq; q++) { 9190145028aSToby Isaac PetscReal lambda[3]; 9200145028aSToby Isaac PetscReal lambdao[3]; 9210145028aSToby Isaac 9220145028aSToby Isaac /* convert to barycentric */ 9230145028aSToby Isaac lambda[0] = - (geom->xi[2 * q] + geom->xi[2 * q + 1]) / 2.; 9240145028aSToby Isaac lambda[1] = (geom->xi[2 * q] + 1.) / 2.; 9250145028aSToby Isaac lambda[2] = (geom->xi[2 * q + 1] + 1.) / 2.; 9260145028aSToby Isaac if (orient >= 0) { 9270145028aSToby Isaac for (i = 0; i < 3; i++) { 9280145028aSToby Isaac lambdao[i] = lambda[(orient + i) % 3]; 9290145028aSToby Isaac } 9300145028aSToby Isaac } else { 9310145028aSToby Isaac for (i = 0; i < 3; i++) { 9320145028aSToby Isaac lambdao[i] = lambda[(-(orient + i) + 3) % 3]; 9330145028aSToby Isaac } 9340145028aSToby Isaac } 9350145028aSToby Isaac /* convert to coordinates */ 9360145028aSToby Isaac orientPoints[o][2 * q + 0] = -(lambdao[0] + lambdao[2]) + lambdao[1]; 9370145028aSToby Isaac orientPoints[o][2 * q + 1] = -(lambdao[0] + lambdao[1]) + lambdao[2]; 9380145028aSToby Isaac } 9390145028aSToby Isaac break; 940ba2698f1SMatthew G. Knepley case DM_POLYTOPE_QUADRILATERAL: 9410145028aSToby Isaac for (q = 0; q < Nq; q++) { 9420145028aSToby Isaac PetscReal xi[2], xio[2]; 9430145028aSToby Isaac PetscInt oabs = (orient >= 0) ? orient : -(orient + 1); 9440145028aSToby Isaac 9450145028aSToby Isaac xi[0] = geom->xi[2 * q]; 9460145028aSToby Isaac xi[1] = geom->xi[2 * q + 1]; 9470145028aSToby Isaac switch (oabs) { 9480145028aSToby Isaac case 1: 9490145028aSToby Isaac xio[0] = xi[1]; 9500145028aSToby Isaac xio[1] = -xi[0]; 9510145028aSToby Isaac break; 9520145028aSToby Isaac case 2: 9530145028aSToby Isaac xio[0] = -xi[0]; 9540145028aSToby Isaac xio[1] = -xi[1]; 9550145028aSToby Isaac case 3: 9560145028aSToby Isaac xio[0] = -xi[1]; 9570145028aSToby Isaac xio[1] = xi[0]; 958aa1371cbSToby Isaac case 0: 959aa1371cbSToby Isaac default: 960aa1371cbSToby Isaac xio[0] = xi[0]; 961aa1371cbSToby Isaac xio[1] = xi[1]; 962aa1371cbSToby Isaac break; 9630145028aSToby Isaac } 9640145028aSToby Isaac if (orient < 0) { 9650145028aSToby Isaac xio[0] = -xio[0]; 9660145028aSToby Isaac } 9670145028aSToby Isaac orientPoints[o][2 * q + 0] = xio[0]; 9680145028aSToby Isaac orientPoints[o][2 * q + 1] = xio[1]; 9690145028aSToby Isaac } 9700145028aSToby Isaac break; 971ba2698f1SMatthew G. Knepley default: SETERRQ1(PETSC_COMM_SELF,PETSC_ERR_SUP,"Cell type %s not yet supported\n", DMPolytopeTypes[ct]); 9720145028aSToby Isaac } 9730145028aSToby Isaac } 9740145028aSToby Isaac } 9750145028aSToby Isaac for (f = 0; f < coneSize; f++) { 9760145028aSToby Isaac PetscInt face = coneK[f]; 9774d1a973fSToby Isaac PetscReal v0[3]; 9782d89661fSMatthew G. Knepley PetscReal J[9], detJ; 9790145028aSToby Isaac PetscInt numCells, offset; 9800145028aSToby Isaac PetscInt *cells; 9810145028aSToby Isaac IS suppIS; 9820145028aSToby Isaac 9832d89661fSMatthew G. Knepley ierr = DMPlexComputeCellGeometryFEM(K, face, NULL, v0, J, NULL, &detJ);CHKERRQ(ierr); 9840145028aSToby Isaac for (o = 0; o <= numOrient; o++) { 9850145028aSToby Isaac PetscFEGeom *cellGeom; 9860145028aSToby Isaac 9870145028aSToby Isaac if (!counts[f][o]) continue; 9880145028aSToby Isaac /* If this (face,orientation) double appears, 9890145028aSToby Isaac * convert the face quadrature points into volume quadrature points */ 9900145028aSToby Isaac for (q = 0; q < Nq; q++) { 9910145028aSToby Isaac PetscReal xi0[3] = {-1., -1., -1.}; 9920145028aSToby Isaac 9930145028aSToby Isaac CoordinatesRefToReal(dE, dim, xi0, v0, J, &orientPoints[o][dim * q + 0], &cellPoints[dE * q + 0]); 9940145028aSToby Isaac } 9950145028aSToby Isaac for (p = 0, numCells = 0; p < numFaces; p++) { 9960145028aSToby Isaac for (s = 0; s < 2; s++) { 9970145028aSToby Isaac if (co[p][s][0] == f && co[p][s][1] == o + minOrient) numCells++; 9980145028aSToby Isaac } 9990145028aSToby Isaac } 10000145028aSToby Isaac ierr = PetscMalloc1(numCells, &cells);CHKERRQ(ierr); 10010145028aSToby Isaac for (p = 0, offset = 0; p < numFaces; p++) { 10020145028aSToby Isaac for (s = 0; s < 2; s++) { 10030145028aSToby Isaac if (co[p][s][0] == f && co[p][s][1] == o + minOrient) { 10040145028aSToby Isaac cells[offset++] = co[p][s][2]; 10050145028aSToby Isaac } 10060145028aSToby Isaac } 10070145028aSToby Isaac } 10080145028aSToby Isaac ierr = ISCreateGeneral(PETSC_COMM_SELF,numCells,cells,PETSC_USE_POINTER, &suppIS);CHKERRQ(ierr); 10090145028aSToby Isaac ierr = DMFieldCreateFEGeom(field,suppIS,cellQuad,PETSC_FALSE,&cellGeom);CHKERRQ(ierr); 10100145028aSToby Isaac for (p = 0, offset = 0; p < numFaces; p++) { 10110145028aSToby Isaac for (s = 0; s < 2; s++) { 10120145028aSToby Isaac if (co[p][s][0] == f && co[p][s][1] == o + minOrient) { 10130145028aSToby Isaac for (q = 0; q < Nq * dE * dE; q++) { 101441418987SMatthew G. Knepley geom->suppJ[s][p * Nq * dE * dE + q] = cellGeom->J[offset * Nq * dE * dE + q]; 10150145028aSToby Isaac geom->suppInvJ[s][p * Nq * dE * dE + q] = cellGeom->invJ[offset * Nq * dE * dE + q]; 10160145028aSToby Isaac } 101741418987SMatthew G. Knepley for (q = 0; q < Nq; q++) geom->suppDetJ[s][p * Nq + q] = cellGeom->detJ[offset * Nq + q]; 10180145028aSToby Isaac offset++; 10190145028aSToby Isaac } 10200145028aSToby Isaac } 10210145028aSToby Isaac } 10220145028aSToby Isaac ierr = PetscFEGeomDestroy(&cellGeom);CHKERRQ(ierr); 10230145028aSToby Isaac ierr = ISDestroy(&suppIS);CHKERRQ(ierr); 10240145028aSToby Isaac ierr = PetscFree(cells);CHKERRQ(ierr); 10250145028aSToby Isaac } 10260145028aSToby Isaac } 10270145028aSToby Isaac for (o = 0; o < numOrient; o++) { 10280145028aSToby Isaac if (orients[o]) { 10290145028aSToby Isaac ierr = PetscFree(orientPoints[o]);CHKERRQ(ierr); 10300145028aSToby Isaac } 10310145028aSToby Isaac } 10320145028aSToby Isaac ierr = PetscFree2(orients,orientPoints);CHKERRQ(ierr); 10330145028aSToby Isaac ierr = PetscQuadratureDestroy(&cellQuad);CHKERRQ(ierr); 10345b0eceaeSMatthew G. Knepley for (f = 0; f < coneSize; f++) {ierr = PetscFree(counts[f]);CHKERRQ(ierr);} 1035c99e0549SMatthew G. Knepley ierr = PetscFree2(co,counts);CHKERRQ(ierr); 10360145028aSToby Isaac } 10370145028aSToby Isaac ierr = ISRestoreIndices(pointIS, &points);CHKERRQ(ierr); 10380145028aSToby Isaac ierr = ISDestroy(&cellIS);CHKERRQ(ierr); 10390145028aSToby Isaac PetscFunctionReturn(0); 10400145028aSToby Isaac } 10410145028aSToby Isaac 104251a454edSToby Isaac static PetscErrorCode DMFieldInitialize_DS(DMField field) 104351a454edSToby Isaac { 104451a454edSToby Isaac PetscFunctionBegin; 104551a454edSToby Isaac field->ops->destroy = DMFieldDestroy_DS; 104651a454edSToby Isaac field->ops->evaluate = DMFieldEvaluate_DS; 104751a454edSToby Isaac field->ops->evaluateFE = DMFieldEvaluateFE_DS; 1048805e7170SToby Isaac field->ops->evaluateFV = DMFieldEvaluateFV_DS; 1049b7260050SToby Isaac field->ops->getDegree = DMFieldGetDegree_DS; 105051a454edSToby Isaac field->ops->createDefaultQuadrature = DMFieldCreateDefaultQuadrature_DS; 105151a454edSToby Isaac field->ops->view = DMFieldView_DS; 10520145028aSToby Isaac field->ops->computeFaceData = DMFieldComputeFaceData_DS; 105351a454edSToby Isaac PetscFunctionReturn(0); 105451a454edSToby Isaac } 105551a454edSToby Isaac 105651a454edSToby Isaac PETSC_INTERN PetscErrorCode DMFieldCreate_DS(DMField field) 105751a454edSToby Isaac { 105851a454edSToby Isaac DMField_DS *dsfield; 105951a454edSToby Isaac PetscErrorCode ierr; 106051a454edSToby Isaac 106151a454edSToby Isaac PetscFunctionBegin; 106251a454edSToby Isaac ierr = PetscNewLog(field,&dsfield);CHKERRQ(ierr); 106351a454edSToby Isaac field->data = dsfield; 106451a454edSToby Isaac ierr = DMFieldInitialize_DS(field);CHKERRQ(ierr); 106551a454edSToby Isaac PetscFunctionReturn(0); 106651a454edSToby Isaac } 106751a454edSToby Isaac 106851a454edSToby Isaac PetscErrorCode DMFieldCreateDS(DM dm, PetscInt fieldNum, Vec vec,DMField *field) 106951a454edSToby Isaac { 107051a454edSToby Isaac DMField b; 107151a454edSToby Isaac DMField_DS *dsfield; 107251a454edSToby Isaac PetscObject disc = NULL; 107351a454edSToby Isaac PetscBool isContainer = PETSC_FALSE; 107451a454edSToby Isaac PetscClassId id = -1; 107551a454edSToby Isaac PetscInt numComponents = -1, dsNumFields; 107651a454edSToby Isaac PetscSection section; 107751a454edSToby Isaac PetscErrorCode ierr; 107851a454edSToby Isaac 107951a454edSToby Isaac PetscFunctionBegin; 108092fd8e1eSJed Brown ierr = DMGetLocalSection(dm,§ion);CHKERRQ(ierr); 108151a454edSToby Isaac ierr = PetscSectionGetFieldComponents(section,fieldNum,&numComponents);CHKERRQ(ierr); 108251a454edSToby Isaac ierr = DMGetNumFields(dm,&dsNumFields);CHKERRQ(ierr); 108344a7f3ddSMatthew G. Knepley if (dsNumFields) {ierr = DMGetField(dm,fieldNum,NULL,&disc);CHKERRQ(ierr);} 108451a454edSToby Isaac if (disc) { 108551a454edSToby Isaac ierr = PetscObjectGetClassId(disc,&id);CHKERRQ(ierr); 108651a454edSToby Isaac isContainer = (id == PETSC_CONTAINER_CLASSID) ? PETSC_TRUE : PETSC_FALSE; 108751a454edSToby Isaac } 108851a454edSToby Isaac if (!disc || isContainer) { 108951a454edSToby Isaac MPI_Comm comm = PetscObjectComm((PetscObject) dm); 10901fdf1f07SMatthew G. Knepley PetscInt cStart, cEnd, dim, cellHeight; 109151a454edSToby Isaac PetscInt localConeSize = 0, coneSize; 109251a454edSToby Isaac PetscFE fe; 109351a454edSToby Isaac PetscDualSpace Q; 109451a454edSToby Isaac PetscSpace P; 109551a454edSToby Isaac DM K; 109651a454edSToby Isaac PetscQuadrature quad, fquad; 109751a454edSToby Isaac PetscBool isSimplex; 109851a454edSToby Isaac 10991fdf1f07SMatthew G. Knepley ierr = DMPlexGetVTKCellHeight(dm, &cellHeight);CHKERRQ(ierr); 11001fdf1f07SMatthew G. Knepley ierr = DMPlexGetHeightStratum(dm, cellHeight, &cStart, &cEnd);CHKERRQ(ierr); 110151a454edSToby Isaac ierr = DMGetDimension(dm, &dim);CHKERRQ(ierr); 110251a454edSToby Isaac if (cEnd > cStart) { 110351a454edSToby Isaac ierr = DMPlexGetConeSize(dm, cStart, &localConeSize);CHKERRQ(ierr); 110451a454edSToby Isaac } 1105ffc4695bSBarry Smith ierr = MPI_Allreduce(&localConeSize,&coneSize,1,MPIU_INT,MPI_MAX,comm);CHKERRMPI(ierr); 110651a454edSToby Isaac isSimplex = (coneSize == (dim + 1)) ? PETSC_TRUE : PETSC_FALSE; 1107360cf244SMatthew G. Knepley ierr = PetscSpaceCreate(PETSC_COMM_SELF, &P);CHKERRQ(ierr); 110851a454edSToby Isaac ierr = PetscSpaceSetType(P,PETSCSPACEPOLYNOMIAL);CHKERRQ(ierr); 1109d39dd5f5SToby Isaac ierr = PetscSpaceSetDegree(P, 1, PETSC_DETERMINE);CHKERRQ(ierr); 1110d39dd5f5SToby Isaac ierr = PetscSpaceSetNumComponents(P, numComponents);CHKERRQ(ierr); 111151a454edSToby Isaac ierr = PetscSpaceSetNumVariables(P, dim);CHKERRQ(ierr); 111251a454edSToby Isaac ierr = PetscSpacePolynomialSetTensor(P, isSimplex ? PETSC_FALSE : PETSC_TRUE);CHKERRQ(ierr); 111351a454edSToby Isaac ierr = PetscSpaceSetUp(P);CHKERRQ(ierr); 1114360cf244SMatthew G. Knepley ierr = PetscDualSpaceCreate(PETSC_COMM_SELF, &Q);CHKERRQ(ierr); 111551a454edSToby Isaac ierr = PetscDualSpaceSetType(Q,PETSCDUALSPACELAGRANGE);CHKERRQ(ierr); 111651a454edSToby Isaac ierr = PetscDualSpaceCreateReferenceCell(Q, dim, isSimplex, &K);CHKERRQ(ierr); 111751a454edSToby Isaac ierr = PetscDualSpaceSetDM(Q, K);CHKERRQ(ierr); 111851a454edSToby Isaac ierr = DMDestroy(&K);CHKERRQ(ierr); 111951a454edSToby Isaac ierr = PetscDualSpaceSetNumComponents(Q, numComponents);CHKERRQ(ierr); 112051a454edSToby Isaac ierr = PetscDualSpaceSetOrder(Q, 1);CHKERRQ(ierr); 112151a454edSToby Isaac ierr = PetscDualSpaceLagrangeSetTensor(Q, isSimplex ? PETSC_FALSE : PETSC_TRUE);CHKERRQ(ierr); 112251a454edSToby Isaac ierr = PetscDualSpaceSetUp(Q);CHKERRQ(ierr); 1123360cf244SMatthew G. Knepley ierr = PetscFECreate(PETSC_COMM_SELF, &fe);CHKERRQ(ierr); 112451a454edSToby Isaac ierr = PetscFESetType(fe,PETSCFEBASIC);CHKERRQ(ierr); 112551a454edSToby Isaac ierr = PetscFESetBasisSpace(fe, P);CHKERRQ(ierr); 112651a454edSToby Isaac ierr = PetscFESetDualSpace(fe, Q);CHKERRQ(ierr); 112751a454edSToby Isaac ierr = PetscFESetNumComponents(fe, numComponents);CHKERRQ(ierr); 112851a454edSToby Isaac ierr = PetscFESetUp(fe);CHKERRQ(ierr); 112951a454edSToby Isaac ierr = PetscSpaceDestroy(&P);CHKERRQ(ierr); 113051a454edSToby Isaac ierr = PetscDualSpaceDestroy(&Q);CHKERRQ(ierr); 113151a454edSToby Isaac if (isSimplex) { 1132e6a796c3SToby Isaac ierr = PetscDTStroudConicalQuadrature(dim, 1, 1, -1.0, 1.0, &quad);CHKERRQ(ierr); 1133e6a796c3SToby Isaac ierr = PetscDTStroudConicalQuadrature(dim-1, 1, 1, -1.0, 1.0, &fquad);CHKERRQ(ierr); 113451a454edSToby Isaac } 113551a454edSToby Isaac else { 113651a454edSToby Isaac ierr = PetscDTGaussTensorQuadrature(dim, 1, 1, -1.0, 1.0, &quad);CHKERRQ(ierr); 113751a454edSToby Isaac ierr = PetscDTGaussTensorQuadrature(dim-1, 1, 1, -1.0, 1.0, &fquad);CHKERRQ(ierr); 113851a454edSToby Isaac } 113951a454edSToby Isaac ierr = PetscFESetQuadrature(fe, quad);CHKERRQ(ierr); 114051a454edSToby Isaac ierr = PetscFESetFaceQuadrature(fe, fquad);CHKERRQ(ierr); 114151a454edSToby Isaac ierr = PetscQuadratureDestroy(&quad);CHKERRQ(ierr); 114251a454edSToby Isaac ierr = PetscQuadratureDestroy(&fquad);CHKERRQ(ierr); 114351a454edSToby Isaac disc = (PetscObject) fe; 114451a454edSToby Isaac } else { 114551a454edSToby Isaac ierr = PetscObjectReference(disc);CHKERRQ(ierr); 114651a454edSToby Isaac } 114751a454edSToby Isaac ierr = PetscObjectGetClassId(disc,&id);CHKERRQ(ierr); 114851a454edSToby Isaac if (id == PETSCFE_CLASSID) { 114951a454edSToby Isaac PetscFE fe = (PetscFE) disc; 115051a454edSToby Isaac 115151a454edSToby Isaac ierr = PetscFEGetNumComponents(fe,&numComponents);CHKERRQ(ierr); 11522da392ccSBarry Smith } else SETERRQ(PetscObjectComm((PetscObject)dm),PETSC_ERR_SUP,"Not implemented"); 115351a454edSToby Isaac ierr = DMFieldCreate(dm,numComponents,DMFIELD_VERTEX,&b);CHKERRQ(ierr); 115451a454edSToby Isaac ierr = DMFieldSetType(b,DMFIELDDS);CHKERRQ(ierr); 115551a454edSToby Isaac dsfield = (DMField_DS *) b->data; 115651a454edSToby Isaac dsfield->fieldNum = fieldNum; 115751a454edSToby Isaac ierr = DMGetDimension(dm,&dsfield->height);CHKERRQ(ierr); 1158f99c8401SToby Isaac dsfield->height++; 115951a454edSToby Isaac ierr = PetscCalloc1(dsfield->height,&dsfield->disc);CHKERRQ(ierr); 116051a454edSToby Isaac dsfield->disc[0] = disc; 116151a454edSToby Isaac ierr = PetscObjectReference((PetscObject)vec);CHKERRQ(ierr); 116251a454edSToby Isaac dsfield->vec = vec; 116351a454edSToby Isaac *field = b; 116451a454edSToby Isaac 116551a454edSToby Isaac PetscFunctionReturn(0); 116651a454edSToby Isaac } 1167