1 #include <petsc-private/dmpleximpl.h> /*I "petscdmplex.h" I*/ 2 #include <../src/sys/utils/hash.h> 3 4 #undef __FUNCT__ 5 #define __FUNCT__ "DMPlexGetFaces_Internal" 6 /* 7 DMPlexGetFaces_Internal - Gets groups of vertices that correspond to faces for the given cell 8 */ 9 static PetscErrorCode DMPlexGetFaces_Internal(DM dm, PetscInt dim, PetscInt p, PetscInt *numFaces, PetscInt *faceSize, const PetscInt *faces[]) 10 { 11 const PetscInt *cone = NULL; 12 PetscInt *facesTmp; 13 PetscInt maxConeSize, maxSupportSize, coneSize; 14 PetscErrorCode ierr; 15 16 PetscFunctionBegin; 17 PetscValidHeaderSpecific(dm, DM_CLASSID, 1); 18 ierr = DMPlexGetMaxSizes(dm, &maxConeSize, &maxSupportSize);CHKERRQ(ierr); 19 ierr = DMGetWorkArray(dm, PetscSqr(PetscMax(maxConeSize, maxSupportSize)), PETSC_INT, &facesTmp);CHKERRQ(ierr); 20 ierr = DMPlexGetConeSize(dm, p, &coneSize);CHKERRQ(ierr); 21 ierr = DMPlexGetCone(dm, p, &cone);CHKERRQ(ierr); 22 switch (dim) { 23 case 2: 24 switch (coneSize) { 25 case 3: 26 if (faces) { 27 facesTmp[0] = cone[0]; facesTmp[1] = cone[1]; 28 facesTmp[2] = cone[1]; facesTmp[3] = cone[2]; 29 facesTmp[4] = cone[2]; facesTmp[5] = cone[0]; 30 *faces = facesTmp; 31 } 32 if (numFaces) *numFaces = 3; 33 if (faceSize) *faceSize = 2; 34 break; 35 case 4: 36 /* Vertices follow right hand rule */ 37 if (faces) { 38 facesTmp[0] = cone[0]; facesTmp[1] = cone[1]; 39 facesTmp[2] = cone[1]; facesTmp[3] = cone[2]; 40 facesTmp[4] = cone[2]; facesTmp[5] = cone[3]; 41 facesTmp[6] = cone[3]; facesTmp[7] = cone[0]; 42 *faces = facesTmp; 43 } 44 if (numFaces) *numFaces = 4; 45 if (faceSize) *faceSize = 2; 46 if (faces) *faces = facesTmp; 47 break; 48 default: 49 SETERRQ2(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_OUTOFRANGE, "Cone size %D not supported for dimension %D", coneSize, dim); 50 } 51 break; 52 case 3: 53 switch (coneSize) { 54 case 3: 55 if (faces) { 56 facesTmp[0] = cone[0]; facesTmp[1] = cone[1]; 57 facesTmp[2] = cone[1]; facesTmp[3] = cone[2]; 58 facesTmp[4] = cone[2]; facesTmp[5] = cone[0]; 59 *faces = facesTmp; 60 } 61 if (numFaces) *numFaces = 3; 62 if (faceSize) *faceSize = 2; 63 if (faces) *faces = facesTmp; 64 break; 65 case 4: 66 /* Vertices of first face follow right hand rule and normal points towards last vertex */ 67 if (faces) { 68 facesTmp[0] = cone[0]; facesTmp[1] = cone[2]; facesTmp[2] = cone[1]; 69 facesTmp[3] = cone[0]; facesTmp[4] = cone[1]; facesTmp[5] = cone[3]; 70 facesTmp[6] = cone[0]; facesTmp[7] = cone[3]; facesTmp[8] = cone[2]; 71 facesTmp[9] = cone[1]; facesTmp[10] = cone[2]; facesTmp[11] = cone[3]; 72 *faces = facesTmp; 73 } 74 if (numFaces) *numFaces = 4; 75 if (faceSize) *faceSize = 3; 76 if (faces) *faces = facesTmp; 77 break; 78 case 8: 79 if (faces) { 80 facesTmp[0] = cone[0]; facesTmp[1] = cone[3]; facesTmp[2] = cone[2]; facesTmp[3] = cone[1]; 81 facesTmp[4] = cone[4]; facesTmp[5] = cone[5]; facesTmp[6] = cone[3]; facesTmp[7] = cone[7]; 82 facesTmp[8] = cone[0]; facesTmp[9] = cone[1]; facesTmp[10] = cone[5]; facesTmp[11] = cone[4]; 83 facesTmp[12] = cone[2]; facesTmp[13] = cone[3]; facesTmp[14] = cone[7]; facesTmp[15] = cone[6]; 84 facesTmp[16] = cone[1]; facesTmp[17] = cone[2]; facesTmp[18] = cone[6]; facesTmp[19] = cone[5]; 85 facesTmp[20] = cone[0]; facesTmp[21] = cone[4]; facesTmp[22] = cone[7]; facesTmp[23] = cone[3]; 86 *faces = facesTmp; 87 } 88 if (numFaces) *numFaces = 6; 89 if (faceSize) *faceSize = 4; 90 break; 91 default: 92 SETERRQ2(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_OUTOFRANGE, "Cone size %D not supported for dimension %D", coneSize, dim); 93 } 94 break; 95 default: 96 SETERRQ1(PetscObjectComm((PetscObject)dm), PETSC_ERR_ARG_OUTOFRANGE, "Dimension %D not supported", dim); 97 } 98 ierr = DMRestoreWorkArray(dm, 0, PETSC_INT, &facesTmp);CHKERRQ(ierr); 99 PetscFunctionReturn(0); 100 } 101 102 #undef __FUNCT__ 103 #define __FUNCT__ "DMPlexInterpolateFaces_Internal" 104 /* This interpolates faces for cells at some stratum */ 105 static PetscErrorCode DMPlexInterpolateFaces_Internal(DM dm, PetscInt cellDepth, DM idm) 106 { 107 PetscHashIJKL faceTable; 108 PetscInt *pStart, *pEnd; 109 PetscInt cellDim, depth, faceDepth = cellDepth, numPoints = 0, faceSizeAll = 0, face, c, d; 110 PetscErrorCode ierr; 111 112 PetscFunctionBegin; 113 ierr = DMPlexGetDimension(dm, &cellDim);CHKERRQ(ierr); 114 ierr = DMPlexGetDepth(dm, &depth);CHKERRQ(ierr); 115 ++depth; 116 ++cellDepth; 117 cellDim -= depth - cellDepth; 118 ierr = PetscMalloc2(depth+1,PetscInt,&pStart,depth+1,PetscInt,&pEnd);CHKERRQ(ierr); 119 for (d = depth-1; d >= faceDepth; --d) { 120 ierr = DMPlexGetDepthStratum(dm, d, &pStart[d+1], &pEnd[d+1]);CHKERRQ(ierr); 121 } 122 ierr = DMPlexGetDepthStratum(dm, -1, NULL, &pStart[faceDepth]);CHKERRQ(ierr); 123 pEnd[faceDepth] = pStart[faceDepth]; 124 for (d = faceDepth-1; d >= 0; --d) { 125 ierr = DMPlexGetDepthStratum(dm, d, &pStart[d], &pEnd[d]);CHKERRQ(ierr); 126 } 127 if (pEnd[cellDepth] > pStart[cellDepth]) {ierr = DMPlexGetFaces_Internal(dm, cellDim, pStart[cellDepth], NULL, &faceSizeAll, NULL);CHKERRQ(ierr);} 128 if (faceSizeAll > 4) SETERRQ1(PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_WRONG, "Do not support interpolation of meshes with faces of %D vertices", faceSizeAll); 129 ierr = PetscHashIJKLCreate(&faceTable);CHKERRQ(ierr); 130 ierr = PetscHashIJKLSetMultivalued(faceTable, PETSC_FALSE);CHKERRQ(ierr); 131 for (c = pStart[cellDepth], face = pStart[faceDepth]; c < pEnd[cellDepth]; ++c) { 132 const PetscInt *cellFaces; 133 PetscInt numCellFaces, faceSize, cf, f; 134 135 ierr = DMPlexGetFaces_Internal(dm, cellDim, c, &numCellFaces, &faceSize, &cellFaces);CHKERRQ(ierr); 136 if (faceSize != faceSizeAll) SETERRQ3(PETSC_COMM_SELF, PETSC_ERR_PLIB, "Inconsistent face for cell %D of size %D != %D", c, faceSize, faceSizeAll); 137 for (cf = 0; cf < numCellFaces; ++cf) { 138 const PetscInt *cellFace = &cellFaces[cf*faceSize]; 139 PetscHashIJKLKey key; 140 141 if (faceSize == 2) { 142 key.i = PetscMin(cellFace[0], cellFace[1]); 143 key.j = PetscMax(cellFace[0], cellFace[1]); 144 } else { 145 key.i = cellFace[0]; key.j = cellFace[1]; key.k = cellFace[2]; key.l = faceSize > 3 ? cellFace[3] : 0; 146 ierr = PetscSortInt(faceSize, (PetscInt *) &key); 147 } 148 ierr = PetscHashIJKLGet(faceTable, key, &f);CHKERRQ(ierr); 149 if (f < 0) { 150 ierr = PetscHashIJKLAdd(faceTable, key, face);CHKERRQ(ierr); 151 f = face++; 152 } 153 } 154 } 155 pEnd[faceDepth] = face; 156 ierr = PetscHashIJKLDestroy(&faceTable);CHKERRQ(ierr); 157 /* Count new points */ 158 for (d = 0; d <= depth; ++d) { 159 numPoints += pEnd[d]-pStart[d]; 160 } 161 ierr = DMPlexSetChart(idm, 0, numPoints);CHKERRQ(ierr); 162 /* Set cone sizes */ 163 for (d = 0; d <= depth; ++d) { 164 PetscInt coneSize, p; 165 166 if (d == faceDepth) { 167 for (p = pStart[d]; p < pEnd[d]; ++p) { 168 /* I see no way to do this if we admit faces of different shapes */ 169 ierr = DMPlexSetConeSize(idm, p, faceSizeAll);CHKERRQ(ierr); 170 } 171 } else { 172 for (p = pStart[d]; p < pEnd[d]; ++p) { 173 ierr = DMPlexGetConeSize(dm, p, &coneSize);CHKERRQ(ierr); 174 ierr = DMPlexSetConeSize(idm, p, coneSize);CHKERRQ(ierr); 175 } 176 } 177 } 178 ierr = DMSetUp(idm);CHKERRQ(ierr); 179 /* Get face cones from subsets of cell vertices */ 180 if (faceSizeAll > 4) SETERRQ1(PetscObjectComm((PetscObject) dm), PETSC_ERR_ARG_WRONG, "Do not support interpolation of meshes with faces of %D vertices", faceSizeAll); 181 ierr = PetscHashIJKLCreate(&faceTable);CHKERRQ(ierr); 182 ierr = PetscHashIJKLSetMultivalued(faceTable, PETSC_FALSE);CHKERRQ(ierr); 183 for (d = depth; d > cellDepth; --d) { 184 const PetscInt *cone; 185 PetscInt p; 186 187 for (p = pStart[d]; p < pEnd[d]; ++p) { 188 ierr = DMPlexGetCone(dm, p, &cone);CHKERRQ(ierr); 189 ierr = DMPlexSetCone(idm, p, cone);CHKERRQ(ierr); 190 ierr = DMPlexGetConeOrientation(dm, p, &cone);CHKERRQ(ierr); 191 ierr = DMPlexSetConeOrientation(idm, p, cone);CHKERRQ(ierr); 192 } 193 } 194 for (c = pStart[cellDepth], face = pStart[faceDepth]; c < pEnd[cellDepth]; ++c) { 195 const PetscInt *cellFaces; 196 PetscInt numCellFaces, faceSize, cf, f; 197 198 ierr = DMPlexGetFaces_Internal(dm, cellDim, c, &numCellFaces, &faceSize, &cellFaces);CHKERRQ(ierr); 199 if (faceSize != faceSizeAll) SETERRQ3(PETSC_COMM_SELF, PETSC_ERR_PLIB, "Inconsistent face for cell %D of size %D != %D", c, faceSize, faceSizeAll); 200 for (cf = 0; cf < numCellFaces; ++cf) { 201 const PetscInt *cellFace = &cellFaces[cf*faceSize]; 202 PetscHashIJKLKey key; 203 204 if (faceSize == 2) { 205 key.i = PetscMin(cellFace[0], cellFace[1]); 206 key.j = PetscMax(cellFace[0], cellFace[1]); 207 } else { 208 key.i = cellFace[0]; key.j = cellFace[1]; key.k = cellFace[2]; key.l = faceSize > 3 ? cellFace[3] : 0; 209 ierr = PetscSortInt(faceSize, (PetscInt *) &key); 210 } 211 ierr = PetscHashIJKLGet(faceTable, key, &f);CHKERRQ(ierr); 212 if (f < 0) { 213 ierr = DMPlexSetCone(idm, face, cellFace);CHKERRQ(ierr); 214 ierr = PetscHashIJKLAdd(faceTable, key, face);CHKERRQ(ierr); 215 f = face++; 216 ierr = DMPlexInsertCone(idm, c, cf, f);CHKERRQ(ierr); 217 } else { 218 const PetscInt *cone; 219 PetscInt coneSize, ornt, i, j; 220 221 ierr = DMPlexInsertCone(idm, c, cf, f);CHKERRQ(ierr); 222 /* Orient face */ 223 ierr = DMPlexGetConeSize(idm, f, &coneSize);CHKERRQ(ierr); 224 ierr = DMPlexGetCone(idm, f, &cone);CHKERRQ(ierr); 225 if (coneSize != faceSize) SETERRQ3(PETSC_COMM_SELF, PETSC_ERR_PLIB, "Invalid number of face vertices %D for face %D should be %D", coneSize, f, faceSize); 226 /* - First find the initial vertex */ 227 for (i = 0; i < faceSize; ++i) if (cellFace[0] == cone[i]) break; 228 /* - Try forward comparison */ 229 for (j = 0; j < faceSize; ++j) if (cellFace[j] != cone[(i+j)%faceSize]) break; 230 if (j == faceSize) { 231 if ((faceSize == 2) && (i == 1)) ornt = -2; 232 else ornt = i; 233 } else { 234 /* - Try backward comparison */ 235 for (j = 0; j < faceSize; ++j) if (cellFace[j] != cone[(i+faceSize-j)%faceSize]) break; 236 if (j == faceSize) ornt = -(i+1); 237 else SETERRQ(PETSC_COMM_SELF, PETSC_ERR_PLIB, "Could not determine face orientation"); 238 } 239 ierr = DMPlexInsertConeOrientation(idm, c, cf, ornt);CHKERRQ(ierr); 240 } 241 } 242 } 243 if (face != pEnd[faceDepth]) SETERRQ2(PetscObjectComm((PetscObject) dm), PETSC_ERR_PLIB, "Invalid number of faces %D should be %D", face-pStart[faceDepth], pEnd[faceDepth]-pStart[faceDepth]); 244 ierr = PetscHashIJKLDestroy(&faceTable);CHKERRQ(ierr); 245 ierr = DMPlexSymmetrize(idm);CHKERRQ(ierr); 246 ierr = DMPlexStratify(idm);CHKERRQ(ierr); 247 PetscFunctionReturn(0); 248 } 249 250 #undef __FUNCT__ 251 #define __FUNCT__ "DMPlexInterpolate" 252 PetscErrorCode DMPlexInterpolate(DM dm, DM *dmInt) 253 { 254 DM idm, odm = dm; 255 PetscInt dim, d; 256 PetscErrorCode ierr; 257 258 PetscFunctionBegin; 259 ierr = DMPlexGetDimension(dm, &dim);CHKERRQ(ierr); 260 for (d = 1; d < dim; ++d) { 261 /* Create interpolated mesh */ 262 ierr = DMCreate(PetscObjectComm((PetscObject)dm), &idm);CHKERRQ(ierr); 263 ierr = DMSetType(idm, DMPLEX);CHKERRQ(ierr); 264 ierr = DMPlexSetDimension(idm, dim);CHKERRQ(ierr); 265 ierr = DMPlexInterpolateFaces_Internal(odm, 1, idm);CHKERRQ(ierr); 266 if (dim == 3) {ierr = DMView(idm, PETSC_VIEWER_STDOUT_WORLD);CHKERRQ(ierr);} 267 if (odm != dm) {ierr = DMDestroy(&odm);CHKERRQ(ierr);} 268 odm = idm; 269 } 270 *dmInt = idm; 271 PetscFunctionReturn(0); 272 } 273 274 #undef __FUNCT__ 275 #define __FUNCT__ "DMPlexCopyCoordinates" 276 PetscErrorCode DMPlexCopyCoordinates(DM dmA, DM dmB) 277 { 278 Vec coordinatesA, coordinatesB; 279 PetscSection coordSectionA, coordSectionB; 280 PetscScalar *coordsA, *coordsB; 281 PetscInt spaceDim, vStartA, vStartB, vEndA, vEndB, coordSizeB, v, d; 282 PetscErrorCode ierr; 283 284 PetscFunctionBegin; 285 ierr = DMPlexGetDepthStratum(dmA, 0, &vStartA, &vEndA);CHKERRQ(ierr); 286 ierr = DMPlexGetDepthStratum(dmB, 0, &vStartB, &vEndB);CHKERRQ(ierr); 287 if ((vEndA-vStartA) != (vEndB-vStartB)) SETERRQ2(PETSC_COMM_SELF, PETSC_ERR_ARG_SIZ, "The number of vertices in first DM %d != %d in the second DM", vEndA-vStartA, vEndB-vStartB); 288 ierr = DMPlexGetCoordinateSection(dmA, &coordSectionA);CHKERRQ(ierr); 289 ierr = DMPlexGetCoordinateSection(dmB, &coordSectionB);CHKERRQ(ierr); 290 ierr = PetscSectionSetNumFields(coordSectionB, 1);CHKERRQ(ierr); 291 ierr = PetscSectionGetFieldComponents(coordSectionA, 0, &spaceDim);CHKERRQ(ierr); 292 ierr = PetscSectionSetFieldComponents(coordSectionB, 0, spaceDim);CHKERRQ(ierr); 293 ierr = PetscSectionSetChart(coordSectionB, vStartB, vEndB);CHKERRQ(ierr); 294 for (v = vStartB; v < vEndB; ++v) { 295 ierr = PetscSectionSetDof(coordSectionB, v, spaceDim);CHKERRQ(ierr); 296 ierr = PetscSectionSetFieldDof(coordSectionB, v, 0, spaceDim);CHKERRQ(ierr); 297 } 298 ierr = PetscSectionSetUp(coordSectionB);CHKERRQ(ierr); 299 ierr = PetscSectionGetStorageSize(coordSectionB, &coordSizeB);CHKERRQ(ierr); 300 ierr = DMGetCoordinatesLocal(dmA, &coordinatesA);CHKERRQ(ierr); 301 ierr = VecCreate(PetscObjectComm((PetscObject) dmB), &coordinatesB);CHKERRQ(ierr); 302 ierr = PetscObjectSetName((PetscObject) coordinatesB, "coordinates");CHKERRQ(ierr); 303 ierr = VecSetSizes(coordinatesB, coordSizeB, PETSC_DETERMINE);CHKERRQ(ierr); 304 ierr = VecSetFromOptions(coordinatesB);CHKERRQ(ierr); 305 ierr = VecGetArray(coordinatesA, &coordsA);CHKERRQ(ierr); 306 ierr = VecGetArray(coordinatesB, &coordsB);CHKERRQ(ierr); 307 for (v = 0; v < vEndB-vStartB; ++v) { 308 for (d = 0; d < spaceDim; ++d) { 309 coordsB[v*spaceDim+d] = coordsA[v*spaceDim+d]; 310 } 311 } 312 ierr = VecRestoreArray(coordinatesA, &coordsA);CHKERRQ(ierr); 313 ierr = VecRestoreArray(coordinatesB, &coordsB);CHKERRQ(ierr); 314 ierr = DMSetCoordinatesLocal(dmB, coordinatesB);CHKERRQ(ierr); 315 ierr = VecDestroy(&coordinatesB);CHKERRQ(ierr); 316 PetscFunctionReturn(0); 317 } 318