1 #include <petsc-private/dmpleximpl.h> /*I "petscdmplex.h" I*/ 2 3 #include <petscfe.h> 4 5 #undef __FUNCT__ 6 #define __FUNCT__ "DMPlexGetScale" 7 PetscErrorCode DMPlexGetScale(DM dm, PetscUnit unit, PetscReal *scale) 8 { 9 DM_Plex *mesh = (DM_Plex*) dm->data; 10 11 PetscFunctionBegin; 12 PetscValidHeaderSpecific(dm, DM_CLASSID, 1); 13 PetscValidPointer(scale, 3); 14 *scale = mesh->scale[unit]; 15 PetscFunctionReturn(0); 16 } 17 18 #undef __FUNCT__ 19 #define __FUNCT__ "DMPlexSetScale" 20 PetscErrorCode DMPlexSetScale(DM dm, PetscUnit unit, PetscReal scale) 21 { 22 DM_Plex *mesh = (DM_Plex*) dm->data; 23 24 PetscFunctionBegin; 25 PetscValidHeaderSpecific(dm, DM_CLASSID, 1); 26 mesh->scale[unit] = scale; 27 PetscFunctionReturn(0); 28 } 29 30 PETSC_STATIC_INLINE PetscInt epsilon(PetscInt i, PetscInt j, PetscInt k) 31 { 32 switch (i) { 33 case 0: 34 switch (j) { 35 case 0: return 0; 36 case 1: 37 switch (k) { 38 case 0: return 0; 39 case 1: return 0; 40 case 2: return 1; 41 } 42 case 2: 43 switch (k) { 44 case 0: return 0; 45 case 1: return -1; 46 case 2: return 0; 47 } 48 } 49 case 1: 50 switch (j) { 51 case 0: 52 switch (k) { 53 case 0: return 0; 54 case 1: return 0; 55 case 2: return -1; 56 } 57 case 1: return 0; 58 case 2: 59 switch (k) { 60 case 0: return 1; 61 case 1: return 0; 62 case 2: return 0; 63 } 64 } 65 case 2: 66 switch (j) { 67 case 0: 68 switch (k) { 69 case 0: return 0; 70 case 1: return 1; 71 case 2: return 0; 72 } 73 case 1: 74 switch (k) { 75 case 0: return -1; 76 case 1: return 0; 77 case 2: return 0; 78 } 79 case 2: return 0; 80 } 81 } 82 return 0; 83 } 84 85 #undef __FUNCT__ 86 #define __FUNCT__ "DMPlexCreateRigidBody" 87 /*@C 88 DMPlexCreateRigidBody - create rigid body modes from coordinates 89 90 Collective on DM 91 92 Input Arguments: 93 + dm - the DM 94 . section - the local section associated with the rigid field, or NULL for the default section 95 - globalSection - the global section associated with the rigid field, or NULL for the default section 96 97 Output Argument: 98 . sp - the null space 99 100 Note: This is necessary to take account of Dirichlet conditions on the displacements 101 102 Level: advanced 103 104 .seealso: MatNullSpaceCreate() 105 @*/ 106 PetscErrorCode DMPlexCreateRigidBody(DM dm, PetscSection section, PetscSection globalSection, MatNullSpace *sp) 107 { 108 MPI_Comm comm; 109 Vec coordinates, localMode, mode[6]; 110 PetscSection coordSection; 111 PetscScalar *coords; 112 PetscInt dim, vStart, vEnd, v, n, m, d, i, j; 113 PetscErrorCode ierr; 114 115 PetscFunctionBegin; 116 ierr = PetscObjectGetComm((PetscObject)dm,&comm);CHKERRQ(ierr); 117 ierr = DMPlexGetDimension(dm, &dim);CHKERRQ(ierr); 118 if (dim == 1) { 119 ierr = MatNullSpaceCreate(comm, PETSC_TRUE, 0, NULL, sp);CHKERRQ(ierr); 120 PetscFunctionReturn(0); 121 } 122 if (!section) {ierr = DMGetDefaultSection(dm, §ion);CHKERRQ(ierr);} 123 if (!globalSection) {ierr = DMGetDefaultGlobalSection(dm, &globalSection);CHKERRQ(ierr);} 124 ierr = PetscSectionGetConstrainedStorageSize(globalSection, &n);CHKERRQ(ierr); 125 ierr = DMPlexGetDepthStratum(dm, 0, &vStart, &vEnd);CHKERRQ(ierr); 126 ierr = DMGetCoordinateSection(dm, &coordSection);CHKERRQ(ierr); 127 ierr = DMGetCoordinatesLocal(dm, &coordinates);CHKERRQ(ierr); 128 m = (dim*(dim+1))/2; 129 ierr = VecCreate(comm, &mode[0]);CHKERRQ(ierr); 130 ierr = VecSetSizes(mode[0], n, PETSC_DETERMINE);CHKERRQ(ierr); 131 ierr = VecSetUp(mode[0]);CHKERRQ(ierr); 132 for (i = 1; i < m; ++i) {ierr = VecDuplicate(mode[0], &mode[i]);CHKERRQ(ierr);} 133 /* Assume P1 */ 134 ierr = DMGetLocalVector(dm, &localMode);CHKERRQ(ierr); 135 for (d = 0; d < dim; ++d) { 136 PetscScalar values[3] = {0.0, 0.0, 0.0}; 137 138 values[d] = 1.0; 139 ierr = VecSet(localMode, 0.0);CHKERRQ(ierr); 140 for (v = vStart; v < vEnd; ++v) { 141 ierr = DMPlexVecSetClosure(dm, section, localMode, v, values, INSERT_VALUES);CHKERRQ(ierr); 142 } 143 ierr = DMLocalToGlobalBegin(dm, localMode, INSERT_VALUES, mode[d]);CHKERRQ(ierr); 144 ierr = DMLocalToGlobalEnd(dm, localMode, INSERT_VALUES, mode[d]);CHKERRQ(ierr); 145 } 146 ierr = VecGetArray(coordinates, &coords);CHKERRQ(ierr); 147 for (d = dim; d < dim*(dim+1)/2; ++d) { 148 PetscInt i, j, k = dim > 2 ? d - dim : d; 149 150 ierr = VecSet(localMode, 0.0);CHKERRQ(ierr); 151 for (v = vStart; v < vEnd; ++v) { 152 PetscScalar values[3] = {0.0, 0.0, 0.0}; 153 PetscInt off; 154 155 ierr = PetscSectionGetOffset(coordSection, v, &off);CHKERRQ(ierr); 156 for (i = 0; i < dim; ++i) { 157 for (j = 0; j < dim; ++j) { 158 values[j] += epsilon(i, j, k)*PetscRealPart(coords[off+i]); 159 } 160 } 161 ierr = DMPlexVecSetClosure(dm, section, localMode, v, values, INSERT_VALUES);CHKERRQ(ierr); 162 } 163 ierr = DMLocalToGlobalBegin(dm, localMode, INSERT_VALUES, mode[d]);CHKERRQ(ierr); 164 ierr = DMLocalToGlobalEnd(dm, localMode, INSERT_VALUES, mode[d]);CHKERRQ(ierr); 165 } 166 ierr = VecRestoreArray(coordinates, &coords);CHKERRQ(ierr); 167 ierr = DMRestoreLocalVector(dm, &localMode);CHKERRQ(ierr); 168 for (i = 0; i < dim; ++i) {ierr = VecNormalize(mode[i], NULL);CHKERRQ(ierr);} 169 /* Orthonormalize system */ 170 for (i = dim; i < m; ++i) { 171 PetscScalar dots[6]; 172 173 ierr = VecMDot(mode[i], i, mode, dots);CHKERRQ(ierr); 174 for (j = 0; j < i; ++j) dots[j] *= -1.0; 175 ierr = VecMAXPY(mode[i], i, dots, mode);CHKERRQ(ierr); 176 ierr = VecNormalize(mode[i], NULL);CHKERRQ(ierr); 177 } 178 ierr = MatNullSpaceCreate(comm, PETSC_FALSE, m, mode, sp);CHKERRQ(ierr); 179 for (i = 0; i< m; ++i) {ierr = VecDestroy(&mode[i]);CHKERRQ(ierr);} 180 PetscFunctionReturn(0); 181 } 182 183 #undef __FUNCT__ 184 #define __FUNCT__ "DMPlexProjectFunctionLabelLocal" 185 PetscErrorCode DMPlexProjectFunctionLabelLocal(DM dm, DMLabel label, PetscInt numIds, const PetscInt ids[], PetscFE fe[], void (**funcs)(const PetscReal [], PetscScalar *, void *), void **ctxs, InsertMode mode, Vec localX) 186 { 187 PetscDualSpace *sp; 188 PetscSection section; 189 PetscScalar *values; 190 PetscReal *v0, *J, detJ; 191 PetscInt numFields, numComp, dim, spDim, totDim = 0, numValues, cStart, cEnd, f, d, v, i, comp; 192 PetscErrorCode ierr; 193 194 PetscFunctionBegin; 195 ierr = DMPlexGetDimension(dm, &dim);CHKERRQ(ierr); 196 ierr = DMGetDefaultSection(dm, §ion);CHKERRQ(ierr); 197 ierr = PetscSectionGetNumFields(section, &numFields);CHKERRQ(ierr); 198 ierr = PetscMalloc3(numFields,&sp,dim,&v0,dim*dim,&J);CHKERRQ(ierr); 199 for (f = 0; f < numFields; ++f) { 200 ierr = PetscFEGetDualSpace(fe[f], &sp[f]);CHKERRQ(ierr); 201 ierr = PetscFEGetNumComponents(fe[f], &numComp);CHKERRQ(ierr); 202 ierr = PetscDualSpaceGetDimension(sp[f], &spDim);CHKERRQ(ierr); 203 totDim += spDim*numComp; 204 } 205 ierr = DMPlexGetHeightStratum(dm, 0, &cStart, &cEnd);CHKERRQ(ierr); 206 ierr = DMPlexVecGetClosure(dm, section, localX, cStart, &numValues, NULL);CHKERRQ(ierr); 207 if (numValues != totDim) SETERRQ2(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "The section cell closure size %d != dual space dimension %d", numValues, totDim); 208 ierr = DMGetWorkArray(dm, numValues, PETSC_SCALAR, &values);CHKERRQ(ierr); 209 for (i = 0; i < numIds; ++i) { 210 IS pointIS; 211 const PetscInt *points; 212 PetscInt n, p; 213 214 ierr = DMLabelGetStratumIS(label, ids[i], &pointIS);CHKERRQ(ierr); 215 ierr = ISGetLocalSize(pointIS, &n);CHKERRQ(ierr); 216 ierr = ISGetIndices(pointIS, &points);CHKERRQ(ierr); 217 for (p = 0; p < n; ++p) { 218 const PetscInt point = points[p]; 219 PetscCellGeometry geom; 220 221 if ((point < cStart) || (point >= cEnd)) continue; 222 ierr = DMPlexComputeCellGeometry(dm, point, v0, J, NULL, &detJ);CHKERRQ(ierr); 223 geom.v0 = v0; 224 geom.J = J; 225 geom.detJ = &detJ; 226 for (f = 0, v = 0; f < numFields; ++f) { 227 void * const ctx = ctxs ? ctxs[f] : NULL; 228 ierr = PetscFEGetNumComponents(fe[f], &numComp);CHKERRQ(ierr); 229 ierr = PetscDualSpaceGetDimension(sp[f], &spDim);CHKERRQ(ierr); 230 for (d = 0; d < spDim; ++d) { 231 if (funcs[f]) { 232 ierr = PetscDualSpaceApply(sp[f], d, geom, numComp, funcs[f], ctx, &values[v]);CHKERRQ(ierr); 233 } else { 234 for (comp = 0; comp < numComp; ++comp) values[v+comp] = 0.0; 235 } 236 v += numComp; 237 } 238 } 239 ierr = DMPlexVecSetClosure(dm, section, localX, point, values, mode);CHKERRQ(ierr); 240 } 241 ierr = ISRestoreIndices(pointIS, &points);CHKERRQ(ierr); 242 ierr = ISDestroy(&pointIS);CHKERRQ(ierr); 243 } 244 ierr = DMRestoreWorkArray(dm, numValues, PETSC_SCALAR, &values);CHKERRQ(ierr); 245 ierr = PetscFree3(sp,v0,J);CHKERRQ(ierr); 246 PetscFunctionReturn(0); 247 } 248 249 #undef __FUNCT__ 250 #define __FUNCT__ "DMPlexProjectFunctionLocal" 251 PetscErrorCode DMPlexProjectFunctionLocal(DM dm, PetscFE fe[], void (**funcs)(const PetscReal [], PetscScalar *, void *), void **ctxs, InsertMode mode, Vec localX) 252 { 253 PetscDualSpace *sp; 254 PetscSection section; 255 PetscScalar *values; 256 PetscReal *v0, *J, detJ; 257 PetscInt numFields, numComp, dim, spDim, totDim = 0, numValues, cStart, cEnd, c, f, d, v, comp; 258 PetscErrorCode ierr; 259 260 PetscFunctionBegin; 261 ierr = DMGetDefaultSection(dm, §ion);CHKERRQ(ierr); 262 ierr = PetscSectionGetNumFields(section, &numFields);CHKERRQ(ierr); 263 ierr = PetscMalloc1(numFields, &sp);CHKERRQ(ierr); 264 for (f = 0; f < numFields; ++f) { 265 ierr = PetscFEGetDualSpace(fe[f], &sp[f]);CHKERRQ(ierr); 266 ierr = PetscFEGetNumComponents(fe[f], &numComp);CHKERRQ(ierr); 267 ierr = PetscDualSpaceGetDimension(sp[f], &spDim);CHKERRQ(ierr); 268 totDim += spDim*numComp; 269 } 270 ierr = DMPlexGetDimension(dm, &dim);CHKERRQ(ierr); 271 ierr = DMPlexGetHeightStratum(dm, 0, &cStart, &cEnd);CHKERRQ(ierr); 272 ierr = DMPlexVecGetClosure(dm, section, localX, cStart, &numValues, NULL);CHKERRQ(ierr); 273 if (numValues != totDim) SETERRQ2(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "The section cell closure size %d != dual space dimension %d", numValues, totDim); 274 ierr = DMGetWorkArray(dm, numValues, PETSC_SCALAR, &values);CHKERRQ(ierr); 275 ierr = PetscMalloc2(dim,&v0,dim*dim,&J);CHKERRQ(ierr); 276 for (c = cStart; c < cEnd; ++c) { 277 PetscCellGeometry geom; 278 279 ierr = DMPlexComputeCellGeometry(dm, c, v0, J, NULL, &detJ);CHKERRQ(ierr); 280 geom.v0 = v0; 281 geom.J = J; 282 geom.detJ = &detJ; 283 for (f = 0, v = 0; f < numFields; ++f) { 284 void * const ctx = ctxs ? ctxs[f] : NULL; 285 ierr = PetscFEGetNumComponents(fe[f], &numComp);CHKERRQ(ierr); 286 ierr = PetscDualSpaceGetDimension(sp[f], &spDim);CHKERRQ(ierr); 287 for (d = 0; d < spDim; ++d) { 288 if (funcs[f]) { 289 ierr = PetscDualSpaceApply(sp[f], d, geom, numComp, funcs[f], ctx, &values[v]);CHKERRQ(ierr); 290 } else { 291 for (comp = 0; comp < numComp; ++comp) values[v+comp] = 0.0; 292 } 293 v += numComp; 294 } 295 } 296 ierr = DMPlexVecSetClosure(dm, section, localX, c, values, mode);CHKERRQ(ierr); 297 } 298 ierr = DMRestoreWorkArray(dm, numValues, PETSC_SCALAR, &values);CHKERRQ(ierr); 299 ierr = PetscFree2(v0,J);CHKERRQ(ierr); 300 ierr = PetscFree(sp);CHKERRQ(ierr); 301 PetscFunctionReturn(0); 302 } 303 304 #undef __FUNCT__ 305 #define __FUNCT__ "DMPlexProjectFunction" 306 /*@C 307 DMPlexProjectFunction - This projects the given function into the function space provided. 308 309 Input Parameters: 310 + dm - The DM 311 . fe - The PetscFE associated with the field 312 . funcs - The coordinate functions to evaluate, one per field 313 . ctxs - Optional array of contexts to pass to each coordinate function. ctxs itself may be null. 314 - mode - The insertion mode for values 315 316 Output Parameter: 317 . X - vector 318 319 Level: developer 320 321 .seealso: DMPlexComputeL2Diff() 322 @*/ 323 PetscErrorCode DMPlexProjectFunction(DM dm, PetscFE fe[], void (**funcs)(const PetscReal [], PetscScalar *, void *), void **ctxs, InsertMode mode, Vec X) 324 { 325 Vec localX; 326 PetscErrorCode ierr; 327 328 PetscFunctionBegin; 329 PetscValidHeaderSpecific(dm, DM_CLASSID, 1); 330 ierr = DMGetLocalVector(dm, &localX);CHKERRQ(ierr); 331 ierr = DMPlexProjectFunctionLocal(dm, fe, funcs, ctxs, mode, localX);CHKERRQ(ierr); 332 ierr = DMLocalToGlobalBegin(dm, localX, mode, X);CHKERRQ(ierr); 333 ierr = DMLocalToGlobalEnd(dm, localX, mode, X);CHKERRQ(ierr); 334 ierr = DMRestoreLocalVector(dm, &localX);CHKERRQ(ierr); 335 PetscFunctionReturn(0); 336 } 337 338 339 #undef __FUNCT__ 340 #define __FUNCT__ "DMPlexInsertBoundaryValues" 341 PetscErrorCode DMPlexInsertBoundaryValues(DM dm, Vec localX) 342 { 343 void (**funcs)(const PetscReal x[], PetscScalar *u, void *ctx); 344 void **ctxs; 345 PetscFE *fe; 346 PetscInt numFields, f, numBd, b; 347 PetscErrorCode ierr; 348 349 PetscFunctionBegin; 350 PetscValidHeaderSpecific(dm, DM_CLASSID, 1); 351 PetscValidHeaderSpecific(localX, VEC_CLASSID, 2); 352 ierr = DMGetNumFields(dm, &numFields);CHKERRQ(ierr); 353 ierr = PetscMalloc3(numFields,&fe,numFields,&funcs,numFields,&ctxs);CHKERRQ(ierr); 354 for (f = 0; f < numFields; ++f) {ierr = DMGetField(dm, f, (PetscObject *) &fe[f]);CHKERRQ(ierr);} 355 /* OPT: Could attempt to do multiple BCs at once */ 356 ierr = DMPlexGetNumBoundary(dm, &numBd);CHKERRQ(ierr); 357 for (b = 0; b < numBd; ++b) { 358 DMLabel label; 359 const PetscInt *ids; 360 const char *name; 361 PetscInt numids, field; 362 PetscBool isEssential; 363 void (*func)(); 364 void *ctx; 365 366 /* TODO: We need to set only the part indicated by the ids */ 367 ierr = DMPlexGetBoundary(dm, b, &isEssential, &name, &field, &func, &numids, &ids, &ctx);CHKERRQ(ierr); 368 ierr = DMPlexGetLabel(dm, name, &label);CHKERRQ(ierr); 369 for (f = 0; f < numFields; ++f) { 370 funcs[f] = field == f ? (void (*)(const PetscReal[], PetscScalar *, void *)) func : NULL; 371 ctxs[f] = field == f ? ctx : NULL; 372 } 373 ierr = DMPlexProjectFunctionLabelLocal(dm, label, numids, ids, fe, funcs, ctxs, INSERT_BC_VALUES, localX);CHKERRQ(ierr); 374 } 375 ierr = PetscFree3(fe,funcs,ctxs);CHKERRQ(ierr); 376 PetscFunctionReturn(0); 377 } 378 379 #undef __FUNCT__ 380 #define __FUNCT__ "DMPlexComputeL2Diff" 381 /*@C 382 DMPlexComputeL2Diff - This function computes the L_2 difference between a function u and an FEM interpolant solution u_h. 383 384 Input Parameters: 385 + dm - The DM 386 . fe - The PetscFE object for each field 387 . funcs - The functions to evaluate for each field component 388 . ctxs - Optional array of contexts to pass to each function, or NULL. 389 - X - The coefficient vector u_h 390 391 Output Parameter: 392 . diff - The diff ||u - u_h||_2 393 394 Level: developer 395 396 .seealso: DMPlexProjectFunction(), DMPlexComputeL2GradientDiff() 397 @*/ 398 PetscErrorCode DMPlexComputeL2Diff(DM dm, PetscFE fe[], void (**funcs)(const PetscReal [], PetscScalar *, void *), void **ctxs, Vec X, PetscReal *diff) 399 { 400 const PetscInt debug = 0; 401 PetscSection section; 402 PetscQuadrature quad; 403 Vec localX; 404 PetscScalar *funcVal; 405 PetscReal *coords, *v0, *J, *invJ, detJ; 406 PetscReal localDiff = 0.0; 407 PetscInt dim, numFields, numComponents = 0, cStart, cEnd, c, field, fieldOffset, comp; 408 PetscErrorCode ierr; 409 410 PetscFunctionBegin; 411 ierr = DMPlexGetDimension(dm, &dim);CHKERRQ(ierr); 412 ierr = DMGetDefaultSection(dm, §ion);CHKERRQ(ierr); 413 ierr = PetscSectionGetNumFields(section, &numFields);CHKERRQ(ierr); 414 ierr = DMGetLocalVector(dm, &localX);CHKERRQ(ierr); 415 ierr = DMGlobalToLocalBegin(dm, X, INSERT_VALUES, localX);CHKERRQ(ierr); 416 ierr = DMGlobalToLocalEnd(dm, X, INSERT_VALUES, localX);CHKERRQ(ierr); 417 for (field = 0; field < numFields; ++field) { 418 PetscInt Nc; 419 420 ierr = PetscFEGetNumComponents(fe[field], &Nc);CHKERRQ(ierr); 421 numComponents += Nc; 422 } 423 ierr = DMPlexProjectFunctionLocal(dm, fe, funcs, ctxs, INSERT_BC_VALUES, localX);CHKERRQ(ierr); 424 ierr = PetscMalloc5(numComponents,&funcVal,dim,&coords,dim,&v0,dim*dim,&J,dim*dim,&invJ);CHKERRQ(ierr); 425 ierr = DMPlexGetHeightStratum(dm, 0, &cStart, &cEnd);CHKERRQ(ierr); 426 ierr = PetscFEGetQuadrature(fe[0], &quad);CHKERRQ(ierr); 427 for (c = cStart; c < cEnd; ++c) { 428 PetscScalar *x = NULL; 429 PetscReal elemDiff = 0.0; 430 431 ierr = DMPlexComputeCellGeometry(dm, c, v0, J, invJ, &detJ);CHKERRQ(ierr); 432 if (detJ <= 0.0) SETERRQ2(PETSC_COMM_SELF, PETSC_ERR_ARG_OUTOFRANGE, "Invalid determinant %g for element %d", detJ, c); 433 ierr = DMPlexVecGetClosure(dm, NULL, localX, c, NULL, &x);CHKERRQ(ierr); 434 435 for (field = 0, comp = 0, fieldOffset = 0; field < numFields; ++field) { 436 void * const ctx = ctxs ? ctxs[field] : NULL; 437 const PetscReal *quadPoints, *quadWeights; 438 PetscReal *basis; 439 PetscInt numQuadPoints, numBasisFuncs, numBasisComps, q, d, e, fc, f; 440 441 ierr = PetscQuadratureGetData(quad, NULL, &numQuadPoints, &quadPoints, &quadWeights);CHKERRQ(ierr); 442 ierr = PetscFEGetDimension(fe[field], &numBasisFuncs);CHKERRQ(ierr); 443 ierr = PetscFEGetNumComponents(fe[field], &numBasisComps);CHKERRQ(ierr); 444 ierr = PetscFEGetDefaultTabulation(fe[field], &basis, NULL, NULL);CHKERRQ(ierr); 445 if (debug) { 446 char title[1024]; 447 ierr = PetscSNPrintf(title, 1023, "Solution for Field %d", field);CHKERRQ(ierr); 448 ierr = DMPrintCellVector(c, title, numBasisFuncs*numBasisComps, &x[fieldOffset]);CHKERRQ(ierr); 449 } 450 for (q = 0; q < numQuadPoints; ++q) { 451 for (d = 0; d < dim; d++) { 452 coords[d] = v0[d]; 453 for (e = 0; e < dim; e++) { 454 coords[d] += J[d*dim+e]*(quadPoints[q*dim+e] + 1.0); 455 } 456 } 457 (*funcs[field])(coords, funcVal, ctx); 458 for (fc = 0; fc < numBasisComps; ++fc) { 459 PetscScalar interpolant = 0.0; 460 461 for (f = 0; f < numBasisFuncs; ++f) { 462 const PetscInt fidx = f*numBasisComps+fc; 463 interpolant += x[fieldOffset+fidx]*basis[q*numBasisFuncs*numBasisComps+fidx]; 464 } 465 if (debug) {ierr = PetscPrintf(PETSC_COMM_SELF, " elem %d field %d diff %g\n", c, field, PetscSqr(PetscRealPart(interpolant - funcVal[fc]))*quadWeights[q]*detJ);CHKERRQ(ierr);} 466 elemDiff += PetscSqr(PetscRealPart(interpolant - funcVal[fc]))*quadWeights[q]*detJ; 467 } 468 } 469 comp += numBasisComps; 470 fieldOffset += numBasisFuncs*numBasisComps; 471 } 472 ierr = DMPlexVecRestoreClosure(dm, NULL, localX, c, NULL, &x);CHKERRQ(ierr); 473 if (debug) {ierr = PetscPrintf(PETSC_COMM_SELF, " elem %d diff %g\n", c, elemDiff);CHKERRQ(ierr);} 474 localDiff += elemDiff; 475 } 476 ierr = PetscFree5(funcVal,coords,v0,J,invJ);CHKERRQ(ierr); 477 ierr = DMRestoreLocalVector(dm, &localX);CHKERRQ(ierr); 478 ierr = MPI_Allreduce(&localDiff, diff, 1, MPIU_REAL, MPI_SUM, PetscObjectComm((PetscObject)dm));CHKERRQ(ierr); 479 *diff = PetscSqrtReal(*diff); 480 PetscFunctionReturn(0); 481 } 482 483 #undef __FUNCT__ 484 #define __FUNCT__ "DMPlexComputeL2GradientDiff" 485 /*@C 486 DMPlexComputeL2GradientDiff - This function computes the L_2 difference between the gradient of a function u and an FEM interpolant solution grad u_h. 487 488 Input Parameters: 489 + dm - The DM 490 . fe - The PetscFE object for each field 491 . funcs - The gradient functions to evaluate for each field component 492 . ctxs - Optional array of contexts to pass to each function, or NULL. 493 . X - The coefficient vector u_h 494 - n - The vector to project along 495 496 Output Parameter: 497 . diff - The diff ||(grad u - grad u_h) . n||_2 498 499 Level: developer 500 501 .seealso: DMPlexProjectFunction(), DMPlexComputeL2Diff() 502 @*/ 503 PetscErrorCode DMPlexComputeL2GradientDiff(DM dm, PetscFE fe[], void (**funcs)(const PetscReal [], const PetscReal [], PetscScalar *, void *), void **ctxs, Vec X, const PetscReal n[], PetscReal *diff) 504 { 505 const PetscInt debug = 0; 506 PetscSection section; 507 PetscQuadrature quad; 508 Vec localX; 509 PetscScalar *funcVal, *interpolantVec; 510 PetscReal *coords, *realSpaceDer, *v0, *J, *invJ, detJ; 511 PetscReal localDiff = 0.0; 512 PetscInt dim, numFields, numComponents = 0, cStart, cEnd, c, field, fieldOffset, comp; 513 PetscErrorCode ierr; 514 515 PetscFunctionBegin; 516 ierr = DMPlexGetDimension(dm, &dim);CHKERRQ(ierr); 517 ierr = DMGetDefaultSection(dm, §ion);CHKERRQ(ierr); 518 ierr = PetscSectionGetNumFields(section, &numFields);CHKERRQ(ierr); 519 ierr = DMGetLocalVector(dm, &localX);CHKERRQ(ierr); 520 ierr = DMGlobalToLocalBegin(dm, X, INSERT_VALUES, localX);CHKERRQ(ierr); 521 ierr = DMGlobalToLocalEnd(dm, X, INSERT_VALUES, localX);CHKERRQ(ierr); 522 for (field = 0; field < numFields; ++field) { 523 PetscInt Nc; 524 525 ierr = PetscFEGetNumComponents(fe[field], &Nc);CHKERRQ(ierr); 526 numComponents += Nc; 527 } 528 /* ierr = DMPlexProjectFunctionLocal(dm, fe, funcs, INSERT_BC_VALUES, localX);CHKERRQ(ierr); */ 529 ierr = PetscMalloc7(numComponents,&funcVal,dim,&coords,dim,&realSpaceDer,dim,&v0,dim*dim,&J,dim*dim,&invJ,dim,&interpolantVec);CHKERRQ(ierr); 530 ierr = DMPlexGetHeightStratum(dm, 0, &cStart, &cEnd);CHKERRQ(ierr); 531 ierr = PetscFEGetQuadrature(fe[0], &quad);CHKERRQ(ierr); 532 for (c = cStart; c < cEnd; ++c) { 533 PetscScalar *x = NULL; 534 PetscReal elemDiff = 0.0; 535 536 ierr = DMPlexComputeCellGeometry(dm, c, v0, J, invJ, &detJ);CHKERRQ(ierr); 537 if (detJ <= 0.0) SETERRQ2(PETSC_COMM_SELF, PETSC_ERR_ARG_OUTOFRANGE, "Invalid determinant %g for element %d", detJ, c); 538 ierr = DMPlexVecGetClosure(dm, NULL, localX, c, NULL, &x);CHKERRQ(ierr); 539 540 for (field = 0, comp = 0, fieldOffset = 0; field < numFields; ++field) { 541 void * const ctx = ctxs ? ctxs[field] : NULL; 542 const PetscReal *quadPoints, *quadWeights; 543 PetscReal *basisDer; 544 PetscInt numQuadPoints, Nb, Ncomp, q, d, e, fc, f, g; 545 546 ierr = PetscQuadratureGetData(quad, NULL, &numQuadPoints, &quadPoints, &quadWeights);CHKERRQ(ierr); 547 ierr = PetscFEGetDimension(fe[field], &Nb);CHKERRQ(ierr); 548 ierr = PetscFEGetNumComponents(fe[field], &Ncomp);CHKERRQ(ierr); 549 ierr = PetscFEGetDefaultTabulation(fe[field], NULL, &basisDer, NULL);CHKERRQ(ierr); 550 if (debug) { 551 char title[1024]; 552 ierr = PetscSNPrintf(title, 1023, "Solution for Field %d", field);CHKERRQ(ierr); 553 ierr = DMPrintCellVector(c, title, Nb*Ncomp, &x[fieldOffset]);CHKERRQ(ierr); 554 } 555 for (q = 0; q < numQuadPoints; ++q) { 556 for (d = 0; d < dim; d++) { 557 coords[d] = v0[d]; 558 for (e = 0; e < dim; e++) { 559 coords[d] += J[d*dim+e]*(quadPoints[q*dim+e] + 1.0); 560 } 561 } 562 (*funcs[field])(coords, n, funcVal, ctx); 563 for (fc = 0; fc < Ncomp; ++fc) { 564 PetscScalar interpolant = 0.0; 565 566 for (d = 0; d < dim; ++d) interpolantVec[d] = 0.0; 567 for (f = 0; f < Nb; ++f) { 568 const PetscInt fidx = f*Ncomp+fc; 569 570 for (d = 0; d < dim; ++d) { 571 realSpaceDer[d] = 0.0; 572 for (g = 0; g < dim; ++g) { 573 realSpaceDer[d] += invJ[g*dim+d]*basisDer[(q*Nb*Ncomp+fidx)*dim+g]; 574 } 575 interpolantVec[d] += x[fieldOffset+fidx]*realSpaceDer[d]; 576 } 577 } 578 for (d = 0; d < dim; ++d) interpolant += interpolantVec[d]*n[d]; 579 if (debug) {ierr = PetscPrintf(PETSC_COMM_SELF, " elem %d fieldDer %d diff %g\n", c, field, PetscSqr(PetscRealPart(interpolant - funcVal[fc]))*quadWeights[q]*detJ);CHKERRQ(ierr);} 580 elemDiff += PetscSqr(PetscRealPart(interpolant - funcVal[fc]))*quadWeights[q]*detJ; 581 } 582 } 583 comp += Ncomp; 584 fieldOffset += Nb*Ncomp; 585 } 586 ierr = DMPlexVecRestoreClosure(dm, NULL, localX, c, NULL, &x);CHKERRQ(ierr); 587 if (debug) {ierr = PetscPrintf(PETSC_COMM_SELF, " elem %d diff %g\n", c, elemDiff);CHKERRQ(ierr);} 588 localDiff += elemDiff; 589 } 590 ierr = PetscFree7(funcVal,coords,realSpaceDer,v0,J,invJ,interpolantVec);CHKERRQ(ierr); 591 ierr = DMRestoreLocalVector(dm, &localX);CHKERRQ(ierr); 592 ierr = MPI_Allreduce(&localDiff, diff, 1, MPIU_REAL, MPI_SUM, PetscObjectComm((PetscObject)dm));CHKERRQ(ierr); 593 *diff = PetscSqrtReal(*diff); 594 PetscFunctionReturn(0); 595 } 596 597 #undef __FUNCT__ 598 #define __FUNCT__ "DMPlexComputeResidualFEM" 599 /*@ 600 DMPlexComputeResidualFEM - Form the local residual F from the local input X using pointwise functions specified by the user 601 602 Input Parameters: 603 + dm - The mesh 604 . X - Local input vector 605 - user - The user context 606 607 Output Parameter: 608 . F - Local output vector 609 610 Note: 611 The first member of the user context must be an FEMContext. 612 613 We form the residual one batch of elements at a time. This allows us to offload work onto an accelerator, 614 like a GPU, or vectorize on a multicore machine. 615 616 Level: developer 617 618 .seealso: DMPlexComputeJacobianActionFEM() 619 @*/ 620 PetscErrorCode DMPlexComputeResidualFEM(DM dm, Vec X, Vec F, void *user) 621 { 622 DM_Plex *mesh = (DM_Plex *) dm->data; 623 PetscFEM *fem = (PetscFEM *) user; 624 PetscFE *fe = fem->fe; 625 PetscFE *feAux = fem->feAux; 626 PetscFE *feBd = fem->feBd; 627 const char *name = "Residual"; 628 DM dmAux; 629 Vec A; 630 PetscQuadrature q; 631 PetscCellGeometry geom; 632 PetscSection section, sectionAux; 633 PetscReal *v0, *J, *invJ, *detJ; 634 PetscScalar *elemVec, *u, *a = NULL; 635 PetscInt dim, Nf, NfAux = 0, f, numCells, cStart, cEnd, c; 636 PetscInt cellDof = 0, numComponents = 0; 637 PetscInt cellDofAux = 0, numComponentsAux = 0; 638 PetscErrorCode ierr; 639 640 PetscFunctionBegin; 641 ierr = PetscLogEventBegin(DMPLEX_ResidualFEM,dm,0,0,0);CHKERRQ(ierr); 642 ierr = DMPlexGetDimension(dm, &dim);CHKERRQ(ierr); 643 ierr = DMGetDefaultSection(dm, §ion);CHKERRQ(ierr); 644 ierr = PetscSectionGetNumFields(section, &Nf);CHKERRQ(ierr); 645 ierr = DMPlexGetHeightStratum(dm, 0, &cStart, &cEnd);CHKERRQ(ierr); 646 numCells = cEnd - cStart; 647 for (f = 0; f < Nf; ++f) { 648 PetscInt Nb, Nc; 649 650 ierr = PetscFEGetDimension(fe[f], &Nb);CHKERRQ(ierr); 651 ierr = PetscFEGetNumComponents(fe[f], &Nc);CHKERRQ(ierr); 652 cellDof += Nb*Nc; 653 numComponents += Nc; 654 } 655 ierr = PetscObjectQuery((PetscObject) dm, "dmAux", (PetscObject *) &dmAux);CHKERRQ(ierr); 656 ierr = PetscObjectQuery((PetscObject) dm, "A", (PetscObject *) &A);CHKERRQ(ierr); 657 if (dmAux) { 658 ierr = DMGetDefaultSection(dmAux, §ionAux);CHKERRQ(ierr); 659 ierr = PetscSectionGetNumFields(sectionAux, &NfAux);CHKERRQ(ierr); 660 } 661 for (f = 0; f < NfAux; ++f) { 662 PetscInt Nb, Nc; 663 664 ierr = PetscFEGetDimension(feAux[f], &Nb);CHKERRQ(ierr); 665 ierr = PetscFEGetNumComponents(feAux[f], &Nc);CHKERRQ(ierr); 666 cellDofAux += Nb*Nc; 667 numComponentsAux += Nc; 668 } 669 ierr = DMPlexInsertBoundaryValues(dm, X);CHKERRQ(ierr); 670 ierr = VecSet(F, 0.0);CHKERRQ(ierr); 671 ierr = PetscMalloc6(numCells*cellDof,&u,numCells*dim,&v0,numCells*dim*dim,&J,numCells*dim*dim,&invJ,numCells,&detJ,numCells*cellDof,&elemVec);CHKERRQ(ierr); 672 if (dmAux) {ierr = PetscMalloc1(numCells*cellDofAux, &a);CHKERRQ(ierr);} 673 for (c = cStart; c < cEnd; ++c) { 674 PetscScalar *x = NULL; 675 PetscInt i; 676 677 ierr = DMPlexComputeCellGeometry(dm, c, &v0[c*dim], &J[c*dim*dim], &invJ[c*dim*dim], &detJ[c]);CHKERRQ(ierr); 678 if (detJ[c] <= 0.0) SETERRQ2(PETSC_COMM_SELF, PETSC_ERR_ARG_OUTOFRANGE, "Invalid determinant %g for element %d", detJ[c], c); 679 ierr = DMPlexVecGetClosure(dm, section, X, c, NULL, &x);CHKERRQ(ierr); 680 for (i = 0; i < cellDof; ++i) u[c*cellDof+i] = x[i]; 681 ierr = DMPlexVecRestoreClosure(dm, section, X, c, NULL, &x);CHKERRQ(ierr); 682 if (dmAux) { 683 ierr = DMPlexVecGetClosure(dmAux, sectionAux, A, c, NULL, &x);CHKERRQ(ierr); 684 for (i = 0; i < cellDofAux; ++i) a[c*cellDofAux+i] = x[i]; 685 ierr = DMPlexVecRestoreClosure(dmAux, sectionAux, A, c, NULL, &x);CHKERRQ(ierr); 686 } 687 } 688 for (f = 0; f < Nf; ++f) { 689 void (*f0)(const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscReal[], PetscScalar[]) = fem->f0Funcs[f]; 690 void (*f1)(const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscReal[], PetscScalar[]) = fem->f1Funcs[f]; 691 PetscInt numQuadPoints, Nb; 692 /* Conforming batches */ 693 PetscInt numChunks, numBatches, numBlocks, Ne, blockSize, batchSize; 694 /* Remainder */ 695 PetscInt Nr, offset; 696 697 ierr = PetscFEGetQuadrature(fe[f], &q);CHKERRQ(ierr); 698 ierr = PetscFEGetDimension(fe[f], &Nb);CHKERRQ(ierr); 699 ierr = PetscFEGetTileSizes(fe[f], NULL, &numBlocks, NULL, &numBatches);CHKERRQ(ierr); 700 ierr = PetscQuadratureGetData(q, NULL, &numQuadPoints, NULL, NULL);CHKERRQ(ierr); 701 blockSize = Nb*numQuadPoints; 702 batchSize = numBlocks * blockSize; 703 ierr = PetscFESetTileSizes(fe[f], blockSize, numBlocks, batchSize, numBatches);CHKERRQ(ierr); 704 numChunks = numCells / (numBatches*batchSize); 705 Ne = numChunks*numBatches*batchSize; 706 Nr = numCells % (numBatches*batchSize); 707 offset = numCells - Nr; 708 geom.v0 = v0; 709 geom.J = J; 710 geom.invJ = invJ; 711 geom.detJ = detJ; 712 ierr = PetscFEIntegrateResidual(fe[f], Ne, Nf, fe, f, geom, u, NfAux, feAux, a, f0, f1, elemVec);CHKERRQ(ierr); 713 geom.v0 = &v0[offset*dim]; 714 geom.J = &J[offset*dim*dim]; 715 geom.invJ = &invJ[offset*dim*dim]; 716 geom.detJ = &detJ[offset]; 717 ierr = PetscFEIntegrateResidual(fe[f], Nr, Nf, fe, f, geom, &u[offset*cellDof], NfAux, feAux, &a[offset*cellDofAux], f0, f1, &elemVec[offset*cellDof]);CHKERRQ(ierr); 718 } 719 for (c = cStart; c < cEnd; ++c) { 720 if (mesh->printFEM > 1) {ierr = DMPrintCellVector(c, name, cellDof, &elemVec[c*cellDof]);CHKERRQ(ierr);} 721 ierr = DMPlexVecSetClosure(dm, section, F, c, &elemVec[c*cellDof], ADD_VALUES);CHKERRQ(ierr); 722 } 723 ierr = PetscFree6(u,v0,J,invJ,detJ,elemVec);CHKERRQ(ierr); 724 if (dmAux) {ierr = PetscFree(a);CHKERRQ(ierr);} 725 if (feBd) { 726 DMLabel label, depth; 727 IS pointIS; 728 const PetscInt *points; 729 PetscInt dep, numPoints, p, numFaces; 730 PetscReal *n; 731 732 ierr = DMPlexGetLabel(dm, "boundary", &label);CHKERRQ(ierr); 733 ierr = DMPlexGetDepthLabel(dm, &depth);CHKERRQ(ierr); 734 ierr = DMLabelGetStratumSize(label, 1, &numPoints);CHKERRQ(ierr); 735 ierr = DMLabelGetStratumIS(label, 1, &pointIS);CHKERRQ(ierr); 736 ierr = ISGetIndices(pointIS, &points);CHKERRQ(ierr); 737 for (f = 0, cellDof = 0, numComponents = 0; f < Nf; ++f) { 738 PetscInt Nb, Nc; 739 740 ierr = PetscFEGetDimension(feBd[f], &Nb);CHKERRQ(ierr); 741 ierr = PetscFEGetNumComponents(feBd[f], &Nc);CHKERRQ(ierr); 742 cellDof += Nb*Nc; 743 numComponents += Nc; 744 } 745 for (p = 0, numFaces = 0; p < numPoints; ++p) { 746 ierr = DMLabelGetValue(depth, points[p], &dep);CHKERRQ(ierr); 747 if (dep == dim-1) ++numFaces; 748 } 749 ierr = PetscMalloc7(numFaces*cellDof,&u,numFaces*dim,&v0,numFaces*dim,&n,numFaces*dim*dim,&J,numFaces*dim*dim,&invJ,numFaces,&detJ,numFaces*cellDof,&elemVec);CHKERRQ(ierr); 750 for (p = 0, f = 0; p < numPoints; ++p) { 751 const PetscInt point = points[p]; 752 PetscScalar *x = NULL; 753 PetscInt i; 754 755 ierr = DMLabelGetValue(depth, points[p], &dep);CHKERRQ(ierr); 756 if (dep != dim-1) continue; 757 ierr = DMPlexComputeCellGeometry(dm, point, &v0[f*dim], &J[f*dim*dim], &invJ[f*dim*dim], &detJ[f]);CHKERRQ(ierr); 758 ierr = DMPlexComputeCellGeometryFVM(dm, point, NULL, NULL, &n[f*dim]); 759 if (detJ[f] <= 0.0) SETERRQ2(PETSC_COMM_SELF, PETSC_ERR_ARG_OUTOFRANGE, "Invalid determinant %g for face %d", detJ[f], point); 760 ierr = DMPlexVecGetClosure(dm, section, X, point, NULL, &x);CHKERRQ(ierr); 761 for (i = 0; i < cellDof; ++i) u[f*cellDof+i] = x[i]; 762 ierr = DMPlexVecRestoreClosure(dm, section, X, point, NULL, &x);CHKERRQ(ierr); 763 ++f; 764 } 765 for (f = 0; f < Nf; ++f) { 766 void (*f0)(const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscReal[], const PetscReal[], PetscScalar[]) = fem->f0BdFuncs[f]; 767 void (*f1)(const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscReal[], const PetscReal[], PetscScalar[]) = fem->f1BdFuncs[f]; 768 PetscInt numQuadPoints, Nb; 769 /* Conforming batches */ 770 PetscInt numChunks, numBatches, numBlocks, Ne, blockSize, batchSize; 771 /* Remainder */ 772 PetscInt Nr, offset; 773 774 ierr = PetscFEGetQuadrature(feBd[f], &q);CHKERRQ(ierr); 775 ierr = PetscFEGetDimension(feBd[f], &Nb);CHKERRQ(ierr); 776 ierr = PetscFEGetTileSizes(feBd[f], NULL, &numBlocks, NULL, &numBatches);CHKERRQ(ierr); 777 ierr = PetscQuadratureGetData(q, NULL, &numQuadPoints, NULL, NULL);CHKERRQ(ierr); 778 blockSize = Nb*numQuadPoints; 779 batchSize = numBlocks * blockSize; 780 ierr = PetscFESetTileSizes(feBd[f], blockSize, numBlocks, batchSize, numBatches);CHKERRQ(ierr); 781 numChunks = numFaces / (numBatches*batchSize); 782 Ne = numChunks*numBatches*batchSize; 783 Nr = numFaces % (numBatches*batchSize); 784 offset = numFaces - Nr; 785 geom.v0 = v0; 786 geom.n = n; 787 geom.J = J; 788 geom.invJ = invJ; 789 geom.detJ = detJ; 790 ierr = PetscFEIntegrateBdResidual(feBd[f], Ne, Nf, feBd, f, geom, u, 0, NULL, NULL, f0, f1, elemVec);CHKERRQ(ierr); 791 geom.v0 = &v0[offset*dim]; 792 geom.n = &n[offset*dim]; 793 geom.J = &J[offset*dim*dim]; 794 geom.invJ = &invJ[offset*dim*dim]; 795 geom.detJ = &detJ[offset]; 796 ierr = PetscFEIntegrateBdResidual(feBd[f], Nr, Nf, feBd, f, geom, &u[offset*cellDof], 0, NULL, NULL, f0, f1, &elemVec[offset*cellDof]);CHKERRQ(ierr); 797 } 798 for (p = 0, f = 0; p < numPoints; ++p) { 799 const PetscInt point = points[p]; 800 801 ierr = DMLabelGetValue(depth, point, &dep);CHKERRQ(ierr); 802 if (dep != dim-1) continue; 803 if (mesh->printFEM > 1) {ierr = DMPrintCellVector(point, "BdResidual", cellDof, &elemVec[f*cellDof]);CHKERRQ(ierr);} 804 ierr = DMPlexVecSetClosure(dm, NULL, F, point, &elemVec[f*cellDof], ADD_VALUES);CHKERRQ(ierr); 805 ++f; 806 } 807 ierr = ISRestoreIndices(pointIS, &points);CHKERRQ(ierr); 808 ierr = ISDestroy(&pointIS);CHKERRQ(ierr); 809 ierr = PetscFree7(u,v0,n,J,invJ,detJ,elemVec);CHKERRQ(ierr); 810 } 811 if (mesh->printFEM) {ierr = DMPrintLocalVec(dm, name, mesh->printTol, F);CHKERRQ(ierr);} 812 ierr = PetscLogEventEnd(DMPLEX_ResidualFEM,dm,0,0,0);CHKERRQ(ierr); 813 PetscFunctionReturn(0); 814 } 815 816 #undef __FUNCT__ 817 #define __FUNCT__ "DMPlexComputeIFunctionFEM" 818 /*@ 819 DMPlexComputeIFunctionFEM - Form the local implicit function F from the local input X, X_t using pointwise functions specified by the user 820 821 Input Parameters: 822 + dm - The mesh 823 . time - The current time 824 . X - Local input vector 825 . X_t - Time derivative of the local input vector 826 - user - The user context 827 828 Output Parameter: 829 . F - Local output vector 830 831 Note: 832 The first member of the user context must be an FEMContext. 833 834 We form the residual one batch of elements at a time. This allows us to offload work onto an accelerator, 835 like a GPU, or vectorize on a multicore machine. 836 837 Level: developer 838 839 .seealso: DMPlexComputeResidualFEM() 840 @*/ 841 PetscErrorCode DMPlexComputeIFunctionFEM(DM dm, PetscReal time, Vec X, Vec X_t, Vec F, void *user) 842 { 843 DM_Plex *mesh = (DM_Plex *) dm->data; 844 PetscFEM *fem = (PetscFEM *) user; 845 PetscFE *fe = fem->fe; 846 PetscFE *feAux = fem->feAux; 847 PetscFE *feBd = fem->feBd; 848 const char *name = "Residual"; 849 DM dmAux; 850 Vec A; 851 PetscQuadrature q; 852 PetscCellGeometry geom; 853 PetscSection section, sectionAux; 854 PetscReal *v0, *J, *invJ, *detJ; 855 PetscScalar *elemVec, *u, *u_t, *a = NULL; 856 PetscInt dim, Nf, NfAux = 0, f, numCells, cStart, cEnd, c; 857 PetscInt cellDof = 0, numComponents = 0; 858 PetscInt cellDofAux = 0, numComponentsAux = 0; 859 PetscErrorCode ierr; 860 861 PetscFunctionBegin; 862 ierr = PetscLogEventBegin(DMPLEX_ResidualFEM,dm,0,0,0);CHKERRQ(ierr); 863 ierr = DMPlexGetDimension(dm, &dim);CHKERRQ(ierr); 864 ierr = DMGetDefaultSection(dm, §ion);CHKERRQ(ierr); 865 ierr = PetscSectionGetNumFields(section, &Nf);CHKERRQ(ierr); 866 ierr = DMPlexGetHeightStratum(dm, 0, &cStart, &cEnd);CHKERRQ(ierr); 867 numCells = cEnd - cStart; 868 for (f = 0; f < Nf; ++f) { 869 PetscInt Nb, Nc; 870 871 ierr = PetscFEGetDimension(fe[f], &Nb);CHKERRQ(ierr); 872 ierr = PetscFEGetNumComponents(fe[f], &Nc);CHKERRQ(ierr); 873 cellDof += Nb*Nc; 874 numComponents += Nc; 875 } 876 ierr = PetscObjectQuery((PetscObject) dm, "dmAux", (PetscObject *) &dmAux);CHKERRQ(ierr); 877 ierr = PetscObjectQuery((PetscObject) dm, "A", (PetscObject *) &A);CHKERRQ(ierr); 878 if (dmAux) { 879 ierr = DMGetDefaultSection(dmAux, §ionAux);CHKERRQ(ierr); 880 ierr = PetscSectionGetNumFields(sectionAux, &NfAux);CHKERRQ(ierr); 881 } 882 for (f = 0; f < NfAux; ++f) { 883 PetscInt Nb, Nc; 884 885 ierr = PetscFEGetDimension(feAux[f], &Nb);CHKERRQ(ierr); 886 ierr = PetscFEGetNumComponents(feAux[f], &Nc);CHKERRQ(ierr); 887 cellDofAux += Nb*Nc; 888 numComponentsAux += Nc; 889 } 890 ierr = DMPlexInsertBoundaryValues(dm, X);CHKERRQ(ierr); 891 ierr = VecSet(F, 0.0);CHKERRQ(ierr); 892 ierr = PetscMalloc7(numCells*cellDof,&u,numCells*cellDof,&u_t,numCells*dim,&v0,numCells*dim*dim,&J,numCells*dim*dim,&invJ,numCells,&detJ,numCells*cellDof,&elemVec);CHKERRQ(ierr); 893 if (dmAux) {ierr = PetscMalloc1(numCells*cellDofAux, &a);CHKERRQ(ierr);} 894 for (c = cStart; c < cEnd; ++c) { 895 PetscScalar *x = NULL, *x_t = NULL; 896 PetscInt i; 897 898 ierr = DMPlexComputeCellGeometry(dm, c, &v0[c*dim], &J[c*dim*dim], &invJ[c*dim*dim], &detJ[c]);CHKERRQ(ierr); 899 if (detJ[c] <= 0.0) SETERRQ2(PETSC_COMM_SELF, PETSC_ERR_ARG_OUTOFRANGE, "Invalid determinant %g for element %d", detJ[c], c); 900 ierr = DMPlexVecGetClosure(dm, section, X, c, NULL, &x);CHKERRQ(ierr); 901 for (i = 0; i < cellDof; ++i) u[c*cellDof+i] = x[i]; 902 ierr = DMPlexVecRestoreClosure(dm, section, X, c, NULL, &x);CHKERRQ(ierr); 903 ierr = DMPlexVecGetClosure(dm, section, X_t, c, NULL, &x_t);CHKERRQ(ierr); 904 for (i = 0; i < cellDof; ++i) u_t[c*cellDof+i] = x_t[i]; 905 ierr = DMPlexVecRestoreClosure(dm, section, X_t, c, NULL, &x_t);CHKERRQ(ierr); 906 if (dmAux) { 907 PetscScalar *x_a = NULL; 908 ierr = DMPlexVecGetClosure(dmAux, sectionAux, A, c, NULL, &x_a);CHKERRQ(ierr); 909 for (i = 0; i < cellDofAux; ++i) a[c*cellDofAux+i] = x_a[i]; 910 ierr = DMPlexVecRestoreClosure(dmAux, sectionAux, A, c, NULL, &x_a);CHKERRQ(ierr); 911 } 912 } 913 for (f = 0; f < Nf; ++f) { 914 void (*f0)(const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscReal[], PetscScalar[]) = fem->f0IFuncs[f]; 915 void (*f1)(const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscReal[], PetscScalar[]) = fem->f1IFuncs[f]; 916 PetscInt numQuadPoints, Nb; 917 /* Conforming batches */ 918 PetscInt numChunks, numBatches, numBlocks, Ne, blockSize, batchSize; 919 /* Remainder */ 920 PetscInt Nr, offset; 921 922 ierr = PetscFEGetQuadrature(fe[f], &q);CHKERRQ(ierr); 923 ierr = PetscFEGetDimension(fe[f], &Nb);CHKERRQ(ierr); 924 ierr = PetscFEGetTileSizes(fe[f], NULL, &numBlocks, NULL, &numBatches);CHKERRQ(ierr); 925 ierr = PetscQuadratureGetData(q, NULL, &numQuadPoints, NULL, NULL);CHKERRQ(ierr); 926 blockSize = Nb*numQuadPoints; 927 batchSize = numBlocks * blockSize; 928 ierr = PetscFESetTileSizes(fe[f], blockSize, numBlocks, batchSize, numBatches);CHKERRQ(ierr); 929 numChunks = numCells / (numBatches*batchSize); 930 Ne = numChunks*numBatches*batchSize; 931 Nr = numCells % (numBatches*batchSize); 932 offset = numCells - Nr; 933 geom.v0 = v0; 934 geom.J = J; 935 geom.invJ = invJ; 936 geom.detJ = detJ; 937 ierr = PetscFEIntegrateIFunction(fe[f], Ne, Nf, fe, f, geom, u, u_t, NfAux, feAux, a, f0, f1, elemVec);CHKERRQ(ierr); 938 geom.v0 = &v0[offset*dim]; 939 geom.J = &J[offset*dim*dim]; 940 geom.invJ = &invJ[offset*dim*dim]; 941 geom.detJ = &detJ[offset]; 942 ierr = PetscFEIntegrateIFunction(fe[f], Nr, Nf, fe, f, geom, &u[offset*cellDof], &u_t[offset*cellDof], NfAux, feAux, &a[offset*cellDofAux], f0, f1, &elemVec[offset*cellDof]);CHKERRQ(ierr); 943 } 944 for (c = cStart; c < cEnd; ++c) { 945 if (mesh->printFEM > 1) {ierr = DMPrintCellVector(c, name, cellDof, &elemVec[c*cellDof]);CHKERRQ(ierr);} 946 ierr = DMPlexVecSetClosure(dm, section, F, c, &elemVec[c*cellDof], ADD_VALUES);CHKERRQ(ierr); 947 } 948 ierr = PetscFree7(u,u_t,v0,J,invJ,detJ,elemVec);CHKERRQ(ierr); 949 if (dmAux) {ierr = PetscFree(a);CHKERRQ(ierr);} 950 if (feBd) { 951 DMLabel label, depth; 952 IS pointIS; 953 const PetscInt *points; 954 PetscInt dep, numPoints, p, numFaces; 955 PetscReal *n; 956 957 ierr = DMPlexGetLabel(dm, "boundary", &label);CHKERRQ(ierr); 958 ierr = DMPlexGetDepthLabel(dm, &depth);CHKERRQ(ierr); 959 ierr = DMLabelGetStratumSize(label, 1, &numPoints);CHKERRQ(ierr); 960 ierr = DMLabelGetStratumIS(label, 1, &pointIS);CHKERRQ(ierr); 961 ierr = ISGetIndices(pointIS, &points);CHKERRQ(ierr); 962 for (f = 0, cellDof = 0, numComponents = 0; f < Nf; ++f) { 963 PetscInt Nb, Nc; 964 965 ierr = PetscFEGetDimension(feBd[f], &Nb);CHKERRQ(ierr); 966 ierr = PetscFEGetNumComponents(feBd[f], &Nc);CHKERRQ(ierr); 967 cellDof += Nb*Nc; 968 numComponents += Nc; 969 } 970 for (p = 0, numFaces = 0; p < numPoints; ++p) { 971 ierr = DMLabelGetValue(depth, points[p], &dep);CHKERRQ(ierr); 972 if (dep == dim-1) ++numFaces; 973 } 974 ierr = PetscMalloc7(numFaces*cellDof,&u,numFaces*dim,&v0,numFaces*dim,&n,numFaces*dim*dim,&J,numFaces*dim*dim,&invJ,numFaces,&detJ,numFaces*cellDof,&elemVec);CHKERRQ(ierr); 975 ierr = PetscMalloc1(numFaces*cellDof,&u_t);CHKERRQ(ierr); 976 for (p = 0, f = 0; p < numPoints; ++p) { 977 const PetscInt point = points[p]; 978 PetscScalar *x = NULL; 979 PetscInt i; 980 981 ierr = DMLabelGetValue(depth, points[p], &dep);CHKERRQ(ierr); 982 if (dep != dim-1) continue; 983 ierr = DMPlexComputeCellGeometry(dm, point, &v0[f*dim], &J[f*dim*dim], &invJ[f*dim*dim], &detJ[f]);CHKERRQ(ierr); 984 ierr = DMPlexComputeCellGeometryFVM(dm, point, NULL, NULL, &n[f*dim]); 985 if (detJ[f] <= 0.0) SETERRQ2(PETSC_COMM_SELF, PETSC_ERR_ARG_OUTOFRANGE, "Invalid determinant %g for face %d", detJ[f], point); 986 ierr = DMPlexVecGetClosure(dm, section, X, point, NULL, &x);CHKERRQ(ierr); 987 for (i = 0; i < cellDof; ++i) u[f*cellDof+i] = x[i]; 988 ierr = DMPlexVecRestoreClosure(dm, section, X, point, NULL, &x);CHKERRQ(ierr); 989 ierr = DMPlexVecGetClosure(dm, section, X_t, point, NULL, &x);CHKERRQ(ierr); 990 for (i = 0; i < cellDof; ++i) u_t[f*cellDof+i] = x[i]; 991 ierr = DMPlexVecRestoreClosure(dm, section, X_t, point, NULL, &x);CHKERRQ(ierr); 992 ++f; 993 } 994 for (f = 0; f < Nf; ++f) { 995 void (*f0)(const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscReal[], const PetscReal[], PetscScalar[]) = fem->f0BdIFuncs[f]; 996 void (*f1)(const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscReal[], const PetscReal[], PetscScalar[]) = fem->f1BdIFuncs[f]; 997 PetscInt numQuadPoints, Nb; 998 /* Conforming batches */ 999 PetscInt numChunks, numBatches, numBlocks, Ne, blockSize, batchSize; 1000 /* Remainder */ 1001 PetscInt Nr, offset; 1002 1003 ierr = PetscFEGetQuadrature(feBd[f], &q);CHKERRQ(ierr); 1004 ierr = PetscFEGetDimension(feBd[f], &Nb);CHKERRQ(ierr); 1005 ierr = PetscFEGetTileSizes(feBd[f], NULL, &numBlocks, NULL, &numBatches);CHKERRQ(ierr); 1006 ierr = PetscQuadratureGetData(q, NULL, &numQuadPoints, NULL, NULL);CHKERRQ(ierr); 1007 blockSize = Nb*numQuadPoints; 1008 batchSize = numBlocks * blockSize; 1009 ierr = PetscFESetTileSizes(feBd[f], blockSize, numBlocks, batchSize, numBatches);CHKERRQ(ierr); 1010 numChunks = numFaces / (numBatches*batchSize); 1011 Ne = numChunks*numBatches*batchSize; 1012 Nr = numFaces % (numBatches*batchSize); 1013 offset = numFaces - Nr; 1014 geom.v0 = v0; 1015 geom.n = n; 1016 geom.J = J; 1017 geom.invJ = invJ; 1018 geom.detJ = detJ; 1019 ierr = PetscFEIntegrateBdIFunction(feBd[f], Ne, Nf, feBd, f, geom, u, u_t, 0, NULL, NULL, f0, f1, elemVec);CHKERRQ(ierr); 1020 geom.v0 = &v0[offset*dim]; 1021 geom.n = &n[offset*dim]; 1022 geom.J = &J[offset*dim*dim]; 1023 geom.invJ = &invJ[offset*dim*dim]; 1024 geom.detJ = &detJ[offset]; 1025 ierr = PetscFEIntegrateBdIFunction(feBd[f], Nr, Nf, feBd, f, geom, &u[offset*cellDof], &u_t[offset*cellDof], 0, NULL, NULL, f0, f1, &elemVec[offset*cellDof]);CHKERRQ(ierr); 1026 } 1027 for (p = 0, f = 0; p < numPoints; ++p) { 1028 const PetscInt point = points[p]; 1029 1030 ierr = DMLabelGetValue(depth, point, &dep);CHKERRQ(ierr); 1031 if (dep != dim-1) continue; 1032 if (mesh->printFEM > 1) {ierr = DMPrintCellVector(point, "BdResidual", cellDof, &elemVec[f*cellDof]);CHKERRQ(ierr);} 1033 ierr = DMPlexVecSetClosure(dm, NULL, F, point, &elemVec[f*cellDof], ADD_VALUES);CHKERRQ(ierr); 1034 ++f; 1035 } 1036 ierr = ISRestoreIndices(pointIS, &points);CHKERRQ(ierr); 1037 ierr = ISDestroy(&pointIS);CHKERRQ(ierr); 1038 ierr = PetscFree7(u,v0,n,J,invJ,detJ,elemVec);CHKERRQ(ierr); 1039 ierr = PetscFree(u_t);CHKERRQ(ierr); 1040 } 1041 if (mesh->printFEM) {ierr = DMPrintLocalVec(dm, name, mesh->printTol, F);CHKERRQ(ierr);} 1042 ierr = PetscLogEventEnd(DMPLEX_ResidualFEM,dm,0,0,0);CHKERRQ(ierr); 1043 PetscFunctionReturn(0); 1044 } 1045 1046 #undef __FUNCT__ 1047 #define __FUNCT__ "DMPlexComputeJacobianActionFEM" 1048 /*@C 1049 DMPlexComputeJacobianActionFEM - Form the local action of Jacobian J(u) on the local input X using pointwise functions specified by the user 1050 1051 Input Parameters: 1052 + dm - The mesh 1053 . J - The Jacobian shell matrix 1054 . X - Local input vector 1055 - user - The user context 1056 1057 Output Parameter: 1058 . F - Local output vector 1059 1060 Note: 1061 The first member of the user context must be an FEMContext. 1062 1063 We form the residual one batch of elements at a time. This allows us to offload work onto an accelerator, 1064 like a GPU, or vectorize on a multicore machine. 1065 1066 Level: developer 1067 1068 .seealso: DMPlexComputeResidualFEM() 1069 @*/ 1070 PetscErrorCode DMPlexComputeJacobianActionFEM(DM dm, Mat Jac, Vec X, Vec F, void *user) 1071 { 1072 DM_Plex *mesh = (DM_Plex *) dm->data; 1073 PetscFEM *fem = (PetscFEM *) user; 1074 PetscFE *fe = fem->fe; 1075 PetscQuadrature quad; 1076 PetscCellGeometry geom; 1077 PetscSection section; 1078 JacActionCtx *jctx; 1079 PetscReal *v0, *J, *invJ, *detJ; 1080 PetscScalar *elemVec, *u, *a; 1081 PetscInt dim, numFields, field, numCells, cStart, cEnd, c; 1082 PetscInt cellDof = 0; 1083 PetscErrorCode ierr; 1084 1085 PetscFunctionBegin; 1086 /* ierr = PetscLogEventBegin(DMPLEX_JacobianActionFEM,dm,0,0,0);CHKERRQ(ierr); */ 1087 ierr = MatShellGetContext(Jac, &jctx);CHKERRQ(ierr); 1088 ierr = DMPlexGetDimension(dm, &dim);CHKERRQ(ierr); 1089 ierr = DMGetDefaultSection(dm, §ion);CHKERRQ(ierr); 1090 ierr = PetscSectionGetNumFields(section, &numFields);CHKERRQ(ierr); 1091 ierr = DMPlexGetHeightStratum(dm, 0, &cStart, &cEnd);CHKERRQ(ierr); 1092 numCells = cEnd - cStart; 1093 for (field = 0; field < numFields; ++field) { 1094 PetscInt Nb, Nc; 1095 1096 ierr = PetscFEGetDimension(fe[field], &Nb);CHKERRQ(ierr); 1097 ierr = PetscFEGetNumComponents(fe[field], &Nc);CHKERRQ(ierr); 1098 cellDof += Nb*Nc; 1099 } 1100 ierr = VecSet(F, 0.0);CHKERRQ(ierr); 1101 ierr = PetscMalloc7(numCells*cellDof,&u,numCells*cellDof,&a,numCells*dim,&v0,numCells*dim*dim,&J,numCells*dim*dim,&invJ,numCells,&detJ,numCells*cellDof,&elemVec);CHKERRQ(ierr); 1102 for (c = cStart; c < cEnd; ++c) { 1103 PetscScalar *x = NULL; 1104 PetscInt i; 1105 1106 ierr = DMPlexComputeCellGeometry(dm, c, &v0[c*dim], &J[c*dim*dim], &invJ[c*dim*dim], &detJ[c]);CHKERRQ(ierr); 1107 if (detJ[c] <= 0.0) SETERRQ2(PETSC_COMM_SELF, PETSC_ERR_ARG_OUTOFRANGE, "Invalid determinant %g for element %d", detJ[c], c); 1108 ierr = DMPlexVecGetClosure(dm, NULL, jctx->u, c, NULL, &x);CHKERRQ(ierr); 1109 for (i = 0; i < cellDof; ++i) u[c*cellDof+i] = x[i]; 1110 ierr = DMPlexVecRestoreClosure(dm, NULL, jctx->u, c, NULL, &x);CHKERRQ(ierr); 1111 ierr = DMPlexVecGetClosure(dm, NULL, X, c, NULL, &x);CHKERRQ(ierr); 1112 for (i = 0; i < cellDof; ++i) a[c*cellDof+i] = x[i]; 1113 ierr = DMPlexVecRestoreClosure(dm, NULL, X, c, NULL, &x);CHKERRQ(ierr); 1114 } 1115 for (field = 0; field < numFields; ++field) { 1116 PetscInt numQuadPoints, Nb; 1117 /* Conforming batches */ 1118 PetscInt numBlocks = 1; 1119 PetscInt numBatches = 1; 1120 PetscInt numChunks, Ne, blockSize, batchSize; 1121 /* Remainder */ 1122 PetscInt Nr, offset; 1123 1124 ierr = PetscFEGetQuadrature(fe[field], &quad);CHKERRQ(ierr); 1125 ierr = PetscFEGetDimension(fe[field], &Nb);CHKERRQ(ierr); 1126 ierr = PetscQuadratureGetData(quad, NULL, &numQuadPoints, NULL, NULL);CHKERRQ(ierr); 1127 blockSize = Nb*numQuadPoints; 1128 batchSize = numBlocks * blockSize; 1129 numChunks = numCells / (numBatches*batchSize); 1130 Ne = numChunks*numBatches*batchSize; 1131 Nr = numCells % (numBatches*batchSize); 1132 offset = numCells - Nr; 1133 geom.v0 = v0; 1134 geom.J = J; 1135 geom.invJ = invJ; 1136 geom.detJ = detJ; 1137 ierr = PetscFEIntegrateJacobianAction(fe[field], Ne, numFields, fe, field, geom, u, a, fem->g0Funcs, fem->g1Funcs, fem->g2Funcs, fem->g3Funcs, elemVec);CHKERRQ(ierr); 1138 geom.v0 = &v0[offset*dim]; 1139 geom.J = &J[offset*dim*dim]; 1140 geom.invJ = &invJ[offset*dim*dim]; 1141 geom.detJ = &detJ[offset]; 1142 ierr = PetscFEIntegrateJacobianAction(fe[field], Nr, numFields, fe, field, geom, &u[offset*cellDof], &a[offset*cellDof], 1143 fem->g0Funcs, fem->g1Funcs, fem->g2Funcs, fem->g3Funcs, &elemVec[offset*cellDof]);CHKERRQ(ierr); 1144 } 1145 for (c = cStart; c < cEnd; ++c) { 1146 if (mesh->printFEM > 1) {ierr = DMPrintCellVector(c, "Jacobian Action", cellDof, &elemVec[c*cellDof]);CHKERRQ(ierr);} 1147 ierr = DMPlexVecSetClosure(dm, NULL, F, c, &elemVec[c*cellDof], ADD_VALUES);CHKERRQ(ierr); 1148 } 1149 ierr = PetscFree7(u,a,v0,J,invJ,detJ,elemVec);CHKERRQ(ierr); 1150 if (mesh->printFEM) { 1151 PetscMPIInt rank, numProcs; 1152 PetscInt p; 1153 1154 ierr = MPI_Comm_rank(PetscObjectComm((PetscObject)dm), &rank);CHKERRQ(ierr); 1155 ierr = MPI_Comm_size(PetscObjectComm((PetscObject)dm), &numProcs);CHKERRQ(ierr); 1156 ierr = PetscPrintf(PetscObjectComm((PetscObject)dm), "Jacobian Action:\n");CHKERRQ(ierr); 1157 for (p = 0; p < numProcs; ++p) { 1158 if (p == rank) {ierr = VecView(F, PETSC_VIEWER_STDOUT_SELF);CHKERRQ(ierr);} 1159 ierr = PetscBarrier((PetscObject) dm);CHKERRQ(ierr); 1160 } 1161 } 1162 /* ierr = PetscLogEventEnd(DMPLEX_JacobianActionFEM,dm,0,0,0);CHKERRQ(ierr); */ 1163 PetscFunctionReturn(0); 1164 } 1165 1166 #undef __FUNCT__ 1167 #define __FUNCT__ "DMPlexComputeJacobianFEM" 1168 /*@ 1169 DMPlexComputeJacobianFEM - Form the local portion of the Jacobian matrix J at the local solution X using pointwise functions specified by the user. 1170 1171 Input Parameters: 1172 + dm - The mesh 1173 . X - Local input vector 1174 - user - The user context 1175 1176 Output Parameter: 1177 . Jac - Jacobian matrix 1178 1179 Note: 1180 The first member of the user context must be an FEMContext. 1181 1182 We form the residual one batch of elements at a time. This allows us to offload work onto an accelerator, 1183 like a GPU, or vectorize on a multicore machine. 1184 1185 Level: developer 1186 1187 .seealso: FormFunctionLocal() 1188 @*/ 1189 PetscErrorCode DMPlexComputeJacobianFEM(DM dm, Vec X, Mat Jac, Mat JacP,void *user) 1190 { 1191 DM_Plex *mesh = (DM_Plex *) dm->data; 1192 PetscFEM *fem = (PetscFEM *) user; 1193 PetscFE *fe = fem->fe; 1194 PetscFE *feAux = fem->feAux; 1195 const char *name = "Jacobian"; 1196 DM dmAux; 1197 Vec A; 1198 PetscQuadrature quad; 1199 PetscCellGeometry geom; 1200 PetscSection section, globalSection, sectionAux; 1201 PetscReal *v0, *J, *invJ, *detJ; 1202 PetscScalar *elemMat, *u, *a; 1203 PetscInt dim, Nf, NfAux = 0, f, fieldI, fieldJ, numCells, cStart, cEnd, c; 1204 PetscInt cellDof = 0, numComponents = 0; 1205 PetscInt cellDofAux = 0, numComponentsAux = 0; 1206 PetscBool isShell; 1207 PetscErrorCode ierr; 1208 1209 PetscFunctionBegin; 1210 ierr = PetscLogEventBegin(DMPLEX_JacobianFEM,dm,0,0,0);CHKERRQ(ierr); 1211 ierr = DMPlexGetDimension(dm, &dim);CHKERRQ(ierr); 1212 ierr = DMGetDefaultSection(dm, §ion);CHKERRQ(ierr); 1213 ierr = DMGetDefaultGlobalSection(dm, &globalSection);CHKERRQ(ierr); 1214 ierr = PetscSectionGetNumFields(section, &Nf);CHKERRQ(ierr); 1215 ierr = DMPlexGetHeightStratum(dm, 0, &cStart, &cEnd);CHKERRQ(ierr); 1216 numCells = cEnd - cStart; 1217 for (f = 0; f < Nf; ++f) { 1218 PetscInt Nb, Nc; 1219 1220 ierr = PetscFEGetDimension(fe[f], &Nb);CHKERRQ(ierr); 1221 ierr = PetscFEGetNumComponents(fe[f], &Nc);CHKERRQ(ierr); 1222 cellDof += Nb*Nc; 1223 numComponents += Nc; 1224 } 1225 ierr = PetscObjectQuery((PetscObject) dm, "dmAux", (PetscObject *) &dmAux);CHKERRQ(ierr); 1226 ierr = PetscObjectQuery((PetscObject) dm, "A", (PetscObject *) &A);CHKERRQ(ierr); 1227 if (dmAux) { 1228 ierr = DMGetDefaultSection(dmAux, §ionAux);CHKERRQ(ierr); 1229 ierr = PetscSectionGetNumFields(sectionAux, &NfAux);CHKERRQ(ierr); 1230 } 1231 for (f = 0; f < NfAux; ++f) { 1232 PetscInt Nb, Nc; 1233 1234 ierr = PetscFEGetDimension(feAux[f], &Nb);CHKERRQ(ierr); 1235 ierr = PetscFEGetNumComponents(feAux[f], &Nc);CHKERRQ(ierr); 1236 cellDofAux += Nb*Nc; 1237 numComponentsAux += Nc; 1238 } 1239 ierr = DMPlexInsertBoundaryValues(dm, X);CHKERRQ(ierr); 1240 ierr = MatZeroEntries(JacP);CHKERRQ(ierr); 1241 ierr = PetscMalloc6(numCells*cellDof,&u,numCells*dim,&v0,numCells*dim*dim,&J,numCells*dim*dim,&invJ,numCells,&detJ,numCells*cellDof*cellDof,&elemMat);CHKERRQ(ierr); 1242 if (dmAux) {ierr = PetscMalloc1(numCells*cellDofAux, &a);CHKERRQ(ierr);} 1243 for (c = cStart; c < cEnd; ++c) { 1244 PetscScalar *x = NULL; 1245 PetscInt i; 1246 1247 ierr = DMPlexComputeCellGeometry(dm, c, &v0[c*dim], &J[c*dim*dim], &invJ[c*dim*dim], &detJ[c]);CHKERRQ(ierr); 1248 if (detJ[c] <= 0.0) SETERRQ2(PETSC_COMM_SELF, PETSC_ERR_ARG_OUTOFRANGE, "Invalid determinant %g for element %d", detJ[c], c); 1249 ierr = DMPlexVecGetClosure(dm, section, X, c, NULL, &x);CHKERRQ(ierr); 1250 for (i = 0; i < cellDof; ++i) u[c*cellDof+i] = x[i]; 1251 ierr = DMPlexVecRestoreClosure(dm, section, X, c, NULL, &x);CHKERRQ(ierr); 1252 if (dmAux) { 1253 ierr = DMPlexVecGetClosure(dmAux, sectionAux, A, c, NULL, &x);CHKERRQ(ierr); 1254 for (i = 0; i < cellDofAux; ++i) a[c*cellDofAux+i] = x[i]; 1255 ierr = DMPlexVecRestoreClosure(dmAux, sectionAux, A, c, NULL, &x);CHKERRQ(ierr); 1256 } 1257 } 1258 ierr = PetscMemzero(elemMat, numCells*cellDof*cellDof * sizeof(PetscScalar));CHKERRQ(ierr); 1259 for (fieldI = 0; fieldI < Nf; ++fieldI) { 1260 PetscInt numQuadPoints, Nb; 1261 /* Conforming batches */ 1262 PetscInt numChunks, numBatches, numBlocks, Ne, blockSize, batchSize; 1263 /* Remainder */ 1264 PetscInt Nr, offset; 1265 1266 ierr = PetscFEGetQuadrature(fe[fieldI], &quad);CHKERRQ(ierr); 1267 ierr = PetscFEGetDimension(fe[fieldI], &Nb);CHKERRQ(ierr); 1268 ierr = PetscFEGetTileSizes(fe[fieldI], NULL, &numBlocks, NULL, &numBatches);CHKERRQ(ierr); 1269 ierr = PetscQuadratureGetData(quad, NULL, &numQuadPoints, NULL, NULL);CHKERRQ(ierr); 1270 blockSize = Nb*numQuadPoints; 1271 batchSize = numBlocks * blockSize; 1272 ierr = PetscFESetTileSizes(fe[fieldI], blockSize, numBlocks, batchSize, numBatches);CHKERRQ(ierr); 1273 numChunks = numCells / (numBatches*batchSize); 1274 Ne = numChunks*numBatches*batchSize; 1275 Nr = numCells % (numBatches*batchSize); 1276 offset = numCells - Nr; 1277 for (fieldJ = 0; fieldJ < Nf; ++fieldJ) { 1278 void (*g0)(const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscReal[], PetscScalar[]) = fem->g0Funcs[fieldI*Nf+fieldJ]; 1279 void (*g1)(const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscReal[], PetscScalar[]) = fem->g1Funcs[fieldI*Nf+fieldJ]; 1280 void (*g2)(const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscReal[], PetscScalar[]) = fem->g2Funcs[fieldI*Nf+fieldJ]; 1281 void (*g3)(const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscReal[], PetscScalar[]) = fem->g3Funcs[fieldI*Nf+fieldJ]; 1282 1283 geom.v0 = v0; 1284 geom.J = J; 1285 geom.invJ = invJ; 1286 geom.detJ = detJ; 1287 ierr = PetscFEIntegrateJacobian(fe[fieldI], Ne, Nf, fe, fieldI, fieldJ, geom, u, NfAux, feAux, a, g0, g1, g2, g3, elemMat);CHKERRQ(ierr); 1288 geom.v0 = &v0[offset*dim]; 1289 geom.J = &J[offset*dim*dim]; 1290 geom.invJ = &invJ[offset*dim*dim]; 1291 geom.detJ = &detJ[offset]; 1292 ierr = PetscFEIntegrateJacobian(fe[fieldI], Nr, Nf, fe, fieldI, fieldJ, geom, &u[offset*cellDof], NfAux, feAux, &a[offset*cellDofAux], g0, g1, g2, g3, &elemMat[offset*cellDof*cellDof]);CHKERRQ(ierr); 1293 } 1294 } 1295 for (c = cStart; c < cEnd; ++c) { 1296 if (mesh->printFEM > 1) {ierr = DMPrintCellMatrix(c, name, cellDof, cellDof, &elemMat[c*cellDof*cellDof]);CHKERRQ(ierr);} 1297 ierr = DMPlexMatSetClosure(dm, section, globalSection, JacP, c, &elemMat[c*cellDof*cellDof], ADD_VALUES);CHKERRQ(ierr); 1298 } 1299 ierr = PetscFree6(u,v0,J,invJ,detJ,elemMat);CHKERRQ(ierr); 1300 if (dmAux) {ierr = PetscFree(a);CHKERRQ(ierr);} 1301 ierr = MatAssemblyBegin(JacP, MAT_FINAL_ASSEMBLY);CHKERRQ(ierr); 1302 ierr = MatAssemblyEnd(JacP, MAT_FINAL_ASSEMBLY);CHKERRQ(ierr); 1303 if (mesh->printFEM) { 1304 ierr = PetscPrintf(PETSC_COMM_WORLD, "%s:\n", name);CHKERRQ(ierr); 1305 ierr = MatChop(JacP, 1.0e-10);CHKERRQ(ierr); 1306 ierr = MatView(JacP, PETSC_VIEWER_STDOUT_WORLD);CHKERRQ(ierr); 1307 } 1308 ierr = PetscLogEventEnd(DMPLEX_JacobianFEM,dm,0,0,0);CHKERRQ(ierr); 1309 ierr = PetscObjectTypeCompare((PetscObject) Jac, MATSHELL, &isShell);CHKERRQ(ierr); 1310 if (isShell) { 1311 JacActionCtx *jctx; 1312 1313 ierr = MatShellGetContext(Jac, &jctx);CHKERRQ(ierr); 1314 ierr = VecCopy(X, jctx->u);CHKERRQ(ierr); 1315 } 1316 PetscFunctionReturn(0); 1317 } 1318 1319 #if 0 1320 1321 static void g0_identity_1d_static(const PetscScalar u[], const PetscScalar gradU[], const PetscScalar a[], const PetscScalar gradA[], const PetscReal x[], PetscScalar g3[]) 1322 { 1323 g3[0] = 1.0; 1324 } 1325 1326 static void g0_identity_2d_static(const PetscScalar u[], const PetscScalar gradU[], const PetscScalar a[], const PetscScalar gradA[], const PetscReal x[], PetscScalar g3[]) 1327 { 1328 g3[0] = g3[3] = 1.0; 1329 } 1330 1331 static void g0_identity_3d_static(const PetscScalar u[], const PetscScalar gradU[], const PetscScalar a[], const PetscScalar gradA[], const PetscReal x[], PetscScalar g3[]) 1332 { 1333 g3[0] = g3[4] = g3[8] = 1.0; 1334 } 1335 1336 #undef __FUNCT__ 1337 #define __FUNCT__ "DMPlexComputeInterpolatorFEMBroken" 1338 PetscErrorCode DMPlexComputeInterpolatorFEMBroken(DM dmc, DM dmf, Mat I, void *user) 1339 { 1340 DM_Plex *mesh = (DM_Plex *) dmc->data; 1341 PetscFEM *fem = (PetscFEM *) user; 1342 PetscFE *fe = fem->fe; 1343 const char *name = "Interpolator"; 1344 PetscFE *feRef; 1345 PetscQuadrature quad, quadOld; 1346 PetscCellGeometry geom; 1347 PetscSection fsection, fglobalSection; 1348 PetscSection csection, cglobalSection; 1349 PetscReal *v0, *J, *invJ, *detJ; 1350 PetscScalar *elemMat; 1351 PetscInt dim, Nf, f, fieldI, fieldJ, numCells, cStart, cEnd, c; 1352 PetscInt rCellDof = 0, cCellDof = 0, numComponents = 0; 1353 PetscErrorCode ierr; 1354 1355 PetscFunctionBegin; 1356 #if 0 1357 ierr = PetscLogEventBegin(DMPLEX_InterpolatorFEM,dmc,dmf,0,0);CHKERRQ(ierr); 1358 #endif 1359 ierr = DMPlexGetDimension(dmf, &dim);CHKERRQ(ierr); 1360 ierr = DMGetDefaultSection(dmf, &fsection);CHKERRQ(ierr); 1361 ierr = DMGetDefaultGlobalSection(dmf, &fglobalSection);CHKERRQ(ierr); 1362 ierr = DMGetDefaultSection(dmc, &csection);CHKERRQ(ierr); 1363 ierr = DMGetDefaultGlobalSection(dmc, &cglobalSection);CHKERRQ(ierr); 1364 ierr = PetscSectionGetNumFields(fsection, &Nf);CHKERRQ(ierr); 1365 ierr = DMPlexGetHeightStratum(dmc, 0, &cStart, &cEnd);CHKERRQ(ierr); 1366 numCells = cEnd - cStart; 1367 ierr = PetscMalloc1(Nf,&feRef);CHKERRQ(ierr); 1368 for (fieldI = 0; fieldI < Nf; ++fieldI) { 1369 ierr = PetscFERefine(fe[fieldI], &feRef[fieldI]);CHKERRQ(ierr); 1370 } 1371 for (f = 0; f < Nf; ++f) { 1372 PetscInt rNb, cNb, Nc; 1373 1374 ierr = PetscFEGetDimension(feRef[f], &rNb);CHKERRQ(ierr); 1375 ierr = PetscFEGetDimension(fe[f], &cNb);CHKERRQ(ierr); 1376 ierr = PetscFEGetNumComponents(fe[f], &Nc);CHKERRQ(ierr); 1377 numComponents += Nc; 1378 rCellDof += rNb*Nc; 1379 cCellDof += cNb*Nc; 1380 } 1381 ierr = MatZeroEntries(I);CHKERRQ(ierr); 1382 ierr = PetscMalloc5(numCells*dim,&v0,numCells*dim*dim,&J,numCells*dim*dim,&invJ,numCells,&detJ,numCells*rCellDof*cCellDof,&elemMat);CHKERRQ(ierr); 1383 for (c = cStart; c < cEnd; ++c) { 1384 ierr = DMPlexComputeCellGeometry(dmc, c, &v0[c*dim], &J[c*dim*dim], &invJ[c*dim*dim], &detJ[c]);CHKERRQ(ierr); 1385 if (detJ[c] <= 0.0) SETERRQ2(PETSC_COMM_SELF, PETSC_ERR_ARG_OUTOFRANGE, "Invalid determinant %g for element %d", detJ[c], c); 1386 } 1387 ierr = PetscMemzero(elemMat, numCells*rCellDof*cCellDof * sizeof(PetscScalar));CHKERRQ(ierr); 1388 for (fieldI = 0; fieldI < Nf; ++fieldI) { 1389 PetscInt numQuadPoints, Nb; 1390 /* Conforming batches */ 1391 PetscInt numChunks, numBatches, numBlocks, Ne, blockSize, batchSize; 1392 /* Remainder */ 1393 PetscInt Nr, offset; 1394 1395 /* Make new fine FE which refines the ref cell and the quadrature rule */ 1396 ierr = PetscFEGetQuadrature(feRef[fieldI], &quad);CHKERRQ(ierr); 1397 ierr = PetscFEGetDimension(feRef[fieldI], &Nb);CHKERRQ(ierr); 1398 ierr = PetscFEGetTileSizes(feRef[fieldI], NULL, &numBlocks, NULL, &numBatches);CHKERRQ(ierr); 1399 ierr = PetscQuadratureGetData(quad, NULL, &numQuadPoints, NULL, NULL);CHKERRQ(ierr); 1400 blockSize = Nb*numQuadPoints; 1401 batchSize = numBlocks * blockSize; 1402 ierr = PetscFESetTileSizes(feRef[fieldI], blockSize, numBlocks, batchSize, numBatches);CHKERRQ(ierr); 1403 numChunks = numCells / (numBatches*batchSize); 1404 Ne = numChunks*numBatches*batchSize; 1405 Nr = numCells % (numBatches*batchSize); 1406 offset = numCells - Nr; 1407 1408 for (fieldJ = 0; fieldJ < Nf; ++fieldJ) { 1409 /* void (*g0)(const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscReal[], PetscScalar[]) = fem->g0Funcs[fieldI*Nf+fieldJ]; */ 1410 void (*g0)(const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscScalar[], const PetscReal[], PetscScalar[]) = g0_identity_2d_static; 1411 1412 /* Replace quadrature in coarse FE with refined quadrature */ 1413 ierr = PetscFEGetQuadrature(fe[fieldJ], &quadOld);CHKERRQ(ierr); 1414 ierr = PetscObjectReference((PetscObject) quadOld);CHKERRQ(ierr); 1415 ierr = PetscFESetQuadrature(fe[fieldJ], quad);CHKERRQ(ierr); 1416 geom.v0 = v0; 1417 geom.J = J; 1418 geom.invJ = invJ; 1419 geom.detJ = detJ; 1420 ierr = PetscFEIntegrateInterpolator_Basic(feRef[fieldI], Ne, Nf, feRef, fieldI, fe, fieldJ, geom, g0, elemMat);CHKERRQ(ierr); 1421 geom.v0 = &v0[offset*dim]; 1422 geom.J = &J[offset*dim*dim]; 1423 geom.invJ = &invJ[offset*dim*dim]; 1424 geom.detJ = &detJ[offset]; 1425 ierr = PetscFEIntegrateInterpolator_Basic(feRef[fieldI], Nr, Nf, feRef, fieldI, fe, fieldJ, geom, g0, &elemMat[offset*rCellDof*cCellDof]);CHKERRQ(ierr); 1426 ierr = PetscFESetQuadrature(fe[fieldJ], quadOld);CHKERRQ(ierr); 1427 } 1428 } 1429 for (c = cStart; c < cEnd; ++c) { 1430 if (mesh->printFEM > 1) {ierr = DMPrintCellMatrix(c, name, rCellDof, cCellDof, &elemMat[c*rCellDof*cCellDof]);CHKERRQ(ierr);} 1431 ierr = DMPlexMatSetClosureRefined(dmf, fsection, fglobalSection, dmc, csection, cglobalSection, I, c, &elemMat[c*rCellDof*cCellDof], ADD_VALUES);CHKERRQ(ierr); 1432 } 1433 ierr = PetscFree5(v0,J,invJ,detJ,elemMat);CHKERRQ(ierr); 1434 ierr = PetscFree(feRef);CHKERRQ(ierr); 1435 ierr = MatAssemblyBegin(I, MAT_FINAL_ASSEMBLY);CHKERRQ(ierr); 1436 ierr = MatAssemblyEnd(I, MAT_FINAL_ASSEMBLY);CHKERRQ(ierr); 1437 if (mesh->printFEM) { 1438 ierr = PetscPrintf(PETSC_COMM_WORLD, "%s:\n", name);CHKERRQ(ierr); 1439 ierr = MatChop(I, 1.0e-10);CHKERRQ(ierr); 1440 ierr = MatView(I, PETSC_VIEWER_STDOUT_WORLD);CHKERRQ(ierr); 1441 } 1442 #if 0 1443 ierr = PetscLogEventEnd(DMPLEX_InterpolatorFEM,dmc,dmf,0,0);CHKERRQ(ierr); 1444 #endif 1445 PetscFunctionReturn(0); 1446 } 1447 #endif 1448 1449 #undef __FUNCT__ 1450 #define __FUNCT__ "DMPlexComputeInterpolatorFEM" 1451 /*@ 1452 DMPlexComputeInterpolatorFEM - Form the local portion of the interpolation matrix I from the coarse DM to the uniformly refined DM. 1453 1454 Input Parameters: 1455 + dmf - The fine mesh 1456 . dmc - The coarse mesh 1457 - user - The user context 1458 1459 Output Parameter: 1460 . In - The interpolation matrix 1461 1462 Note: 1463 The first member of the user context must be an FEMContext. 1464 1465 We form the residual one batch of elements at a time. This allows us to offload work onto an accelerator, 1466 like a GPU, or vectorize on a multicore machine. 1467 1468 Level: developer 1469 1470 .seealso: DMPlexComputeJacobianFEM() 1471 @*/ 1472 PetscErrorCode DMPlexComputeInterpolatorFEM(DM dmc, DM dmf, Mat In, void *user) 1473 { 1474 DM_Plex *mesh = (DM_Plex *) dmc->data; 1475 PetscFEM *fem = (PetscFEM *) user; 1476 PetscFE *fe = fem->fe; 1477 const char *name = "Interpolator"; 1478 PetscFE *feRef; 1479 PetscSection fsection, fglobalSection; 1480 PetscSection csection, cglobalSection; 1481 PetscScalar *elemMat; 1482 PetscInt dim, Nf, f, fieldI, fieldJ, offsetI, offsetJ, cStart, cEnd, c; 1483 PetscInt rCellDof = 0, cCellDof = 0; 1484 PetscErrorCode ierr; 1485 1486 PetscFunctionBegin; 1487 #if 0 1488 ierr = PetscLogEventBegin(DMPLEX_InterpolatorFEM,dmc,dmf,0,0);CHKERRQ(ierr); 1489 #endif 1490 ierr = DMPlexGetDimension(dmf, &dim);CHKERRQ(ierr); 1491 ierr = DMGetDefaultSection(dmf, &fsection);CHKERRQ(ierr); 1492 ierr = DMGetDefaultGlobalSection(dmf, &fglobalSection);CHKERRQ(ierr); 1493 ierr = DMGetDefaultSection(dmc, &csection);CHKERRQ(ierr); 1494 ierr = DMGetDefaultGlobalSection(dmc, &cglobalSection);CHKERRQ(ierr); 1495 ierr = PetscSectionGetNumFields(fsection, &Nf);CHKERRQ(ierr); 1496 ierr = DMPlexGetHeightStratum(dmc, 0, &cStart, &cEnd);CHKERRQ(ierr); 1497 ierr = PetscMalloc1(Nf,&feRef);CHKERRQ(ierr); 1498 for (f = 0; f < Nf; ++f) { 1499 PetscInt rNb, cNb, Nc; 1500 1501 ierr = PetscFERefine(fe[f], &feRef[f]);CHKERRQ(ierr); 1502 ierr = PetscFEGetDimension(feRef[f], &rNb);CHKERRQ(ierr); 1503 ierr = PetscFEGetDimension(fe[f], &cNb);CHKERRQ(ierr); 1504 ierr = PetscFEGetNumComponents(fe[f], &Nc);CHKERRQ(ierr); 1505 rCellDof += rNb*Nc; 1506 cCellDof += cNb*Nc; 1507 } 1508 ierr = MatZeroEntries(In);CHKERRQ(ierr); 1509 ierr = PetscMalloc1(rCellDof*cCellDof,&elemMat);CHKERRQ(ierr); 1510 ierr = PetscMemzero(elemMat, rCellDof*cCellDof * sizeof(PetscScalar));CHKERRQ(ierr); 1511 for (fieldI = 0, offsetI = 0; fieldI < Nf; ++fieldI) { 1512 PetscDualSpace Qref; 1513 PetscQuadrature f; 1514 const PetscReal *qpoints, *qweights; 1515 PetscReal *points; 1516 PetscInt npoints = 0, Nc, Np, fpdim, i, k, p, d; 1517 1518 /* Compose points from all dual basis functionals */ 1519 ierr = PetscFEGetNumComponents(fe[fieldI], &Nc);CHKERRQ(ierr); 1520 ierr = PetscFEGetDualSpace(feRef[fieldI], &Qref);CHKERRQ(ierr); 1521 ierr = PetscDualSpaceGetDimension(Qref, &fpdim);CHKERRQ(ierr); 1522 for (i = 0; i < fpdim; ++i) { 1523 ierr = PetscDualSpaceGetFunctional(Qref, i, &f);CHKERRQ(ierr); 1524 ierr = PetscQuadratureGetData(f, NULL, &Np, NULL, NULL);CHKERRQ(ierr); 1525 npoints += Np; 1526 } 1527 ierr = PetscMalloc1(npoints*dim,&points);CHKERRQ(ierr); 1528 for (i = 0, k = 0; i < fpdim; ++i) { 1529 ierr = PetscDualSpaceGetFunctional(Qref, i, &f);CHKERRQ(ierr); 1530 ierr = PetscQuadratureGetData(f, NULL, &Np, &qpoints, NULL);CHKERRQ(ierr); 1531 for (p = 0; p < Np; ++p, ++k) for (d = 0; d < dim; ++d) points[k*dim+d] = qpoints[p*dim+d]; 1532 } 1533 1534 for (fieldJ = 0, offsetJ = 0; fieldJ < Nf; ++fieldJ) { 1535 PetscReal *B; 1536 PetscInt NcJ, cpdim, j; 1537 1538 /* Evaluate basis at points */ 1539 ierr = PetscFEGetNumComponents(fe[fieldJ], &NcJ);CHKERRQ(ierr); 1540 if (Nc != NcJ) SETERRQ2(PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Number of components in fine space field %d does not match coarse field %d", Nc, NcJ); 1541 ierr = PetscFEGetDimension(fe[fieldJ], &cpdim);CHKERRQ(ierr); 1542 /* For now, fields only interpolate themselves */ 1543 if (fieldI == fieldJ) { 1544 ierr = PetscFEGetTabulation(fe[fieldJ], npoints, points, &B, NULL, NULL);CHKERRQ(ierr); 1545 for (i = 0, k = 0; i < fpdim; ++i) { 1546 ierr = PetscDualSpaceGetFunctional(Qref, i, &f);CHKERRQ(ierr); 1547 ierr = PetscQuadratureGetData(f, NULL, &Np, NULL, &qweights);CHKERRQ(ierr); 1548 for (p = 0; p < Np; ++p, ++k) { 1549 for (j = 0; j < cpdim; ++j) { 1550 for (c = 0; c < Nc; ++c) elemMat[(offsetI + i*Nc + c)*cCellDof + offsetJ + j*NcJ + c] += B[k*cpdim*NcJ+j*Nc+c]*qweights[p]; 1551 } 1552 } 1553 } 1554 ierr = PetscFERestoreTabulation(fe[fieldJ], npoints, points, &B, NULL, NULL);CHKERRQ(ierr);CHKERRQ(ierr); 1555 } 1556 offsetJ += cpdim*NcJ; 1557 } 1558 offsetI += fpdim*Nc; 1559 ierr = PetscFree(points);CHKERRQ(ierr); 1560 } 1561 if (mesh->printFEM > 1) {ierr = DMPrintCellMatrix(0, name, rCellDof, cCellDof, elemMat);CHKERRQ(ierr);} 1562 for (c = cStart; c < cEnd; ++c) { 1563 ierr = DMPlexMatSetClosureRefined(dmf, fsection, fglobalSection, dmc, csection, cglobalSection, In, c, elemMat, INSERT_VALUES);CHKERRQ(ierr); 1564 } 1565 for (f = 0; f < Nf; ++f) {ierr = PetscFEDestroy(&feRef[f]);CHKERRQ(ierr);} 1566 ierr = PetscFree(feRef);CHKERRQ(ierr); 1567 ierr = PetscFree(elemMat);CHKERRQ(ierr); 1568 ierr = MatAssemblyBegin(In, MAT_FINAL_ASSEMBLY);CHKERRQ(ierr); 1569 ierr = MatAssemblyEnd(In, MAT_FINAL_ASSEMBLY);CHKERRQ(ierr); 1570 if (mesh->printFEM) { 1571 ierr = PetscPrintf(PETSC_COMM_WORLD, "%s:\n", name);CHKERRQ(ierr); 1572 ierr = MatChop(In, 1.0e-10);CHKERRQ(ierr); 1573 ierr = MatView(In, PETSC_VIEWER_STDOUT_WORLD);CHKERRQ(ierr); 1574 } 1575 #if 0 1576 ierr = PetscLogEventEnd(DMPLEX_InterpolatorFEM,dmc,dmf,0,0);CHKERRQ(ierr); 1577 #endif 1578 PetscFunctionReturn(0); 1579 } 1580 1581 #undef __FUNCT__ 1582 #define __FUNCT__ "DMPlexAddBoundary" 1583 /* The ids can be overridden by the command line option -bc_<boundary name> */ 1584 PetscErrorCode DMPlexAddBoundary(DM dm, PetscBool isEssential, const char name[], PetscInt field, void (*bcFunc)(), PetscInt numids, const PetscInt *ids, void *ctx) 1585 { 1586 DM_Plex *mesh = (DM_Plex *) dm->data; 1587 DMBoundary b; 1588 PetscErrorCode ierr; 1589 1590 PetscFunctionBegin; 1591 ierr = PetscNew(&b);CHKERRQ(ierr); 1592 ierr = PetscStrallocpy(name, (char **) &b->name);CHKERRQ(ierr); 1593 ierr = PetscMalloc1(numids, &b->ids);CHKERRQ(ierr); 1594 ierr = PetscMemcpy(b->ids, ids, numids*sizeof(PetscInt));CHKERRQ(ierr); 1595 b->essential = isEssential; 1596 b->field = field; 1597 b->func = bcFunc; 1598 b->numids = numids; 1599 b->ctx = ctx; 1600 b->next = mesh->boundary; 1601 mesh->boundary = b; 1602 PetscFunctionReturn(0); 1603 } 1604 1605 #undef __FUNCT__ 1606 #define __FUNCT__ "DMPlexGetNumBoundary" 1607 PetscErrorCode DMPlexGetNumBoundary(DM dm, PetscInt *numBd) 1608 { 1609 DM_Plex *mesh = (DM_Plex *) dm->data; 1610 DMBoundary b = mesh->boundary; 1611 1612 PetscFunctionBegin; 1613 *numBd = 0; 1614 while (b) {++(*numBd); b = b->next;} 1615 PetscFunctionReturn(0); 1616 } 1617 1618 #undef __FUNCT__ 1619 #define __FUNCT__ "DMPlexGetBoundary" 1620 PetscErrorCode DMPlexGetBoundary(DM dm, PetscInt bd, PetscBool *isEssential, const char **name, PetscInt *field, void (**func)(), PetscInt *numids, const PetscInt **ids, void **ctx) 1621 { 1622 DM_Plex *mesh = (DM_Plex *) dm->data; 1623 DMBoundary b = mesh->boundary; 1624 PetscInt n = 0; 1625 1626 PetscFunctionBegin; 1627 while (b) { 1628 if (n == bd) break; 1629 b = b->next; 1630 ++n; 1631 } 1632 if (n != bd) SETERRQ2(PETSC_COMM_SELF, PETSC_ERR_ARG_OUTOFRANGE, "Boundary %d is not in [0, %d)", bd, n); 1633 if (isEssential) { 1634 PetscValidPointer(isEssential, 3); 1635 *isEssential = b->essential; 1636 } 1637 if (name) { 1638 PetscValidPointer(name, 4); 1639 *name = b->name; 1640 } 1641 if (field) { 1642 PetscValidPointer(field, 5); 1643 *field = b->field; 1644 } 1645 if (func) { 1646 PetscValidPointer(func, 6); 1647 *func = b->func; 1648 } 1649 if (numids) { 1650 PetscValidPointer(numids, 7); 1651 *numids = b->numids; 1652 } 1653 if (ids) { 1654 PetscValidPointer(ids, 8); 1655 *ids = b->ids; 1656 } 1657 if (ctx) { 1658 PetscValidPointer(ctx, 9); 1659 *ctx = b->ctx; 1660 } 1661 PetscFunctionReturn(0); 1662 } 1663