1 // Copyright (c) 2017-2022, Lawrence Livermore National Security, LLC and other CEED contributors. 2 // All Rights Reserved. See the top-level LICENSE and NOTICE files for details. 3 // 4 // SPDX-License-Identifier: BSD-2-Clause 5 // 6 // This file is part of CEED: http://github.com/ceed 7 8 #ifndef bps_h 9 #define bps_h 10 11 #include <ceed.h> 12 #include <math.h> 13 14 #ifndef M_PI 15 #define M_PI 3.14159265358979323846 16 #endif 17 18 // ***************************************************************************** 19 // BP 1 20 // ***************************************************************************** 21 CEED_QFUNCTION(masssetupf)(void *ctx, CeedInt Q, const CeedScalar *const *in, 22 CeedScalar *const *out) { 23 CeedScalar *qdata = out[0], *rhs = out[1]; 24 const CeedScalar *x = in[0]; 25 const CeedScalar *J = in[1]; 26 const CeedScalar *w = in[2]; 27 28 // Quadrature Point Loop 29 for (CeedInt i=0; i<Q; i++) { 30 CeedScalar det = (J[i+Q*0]*(J[i+Q*4]*J[i+Q*8] - J[i+Q*5]*J[i+Q*7]) - 31 J[i+Q*1]*(J[i+Q*3]*J[i+Q*8] - J[i+Q*5]*J[i+Q*6]) + 32 J[i+Q*2]*(J[i+Q*3]*J[i+Q*7] - J[i+Q*4]*J[i+Q*6])); 33 qdata[i] = det * w[i]; 34 rhs[i] = qdata[i] * sqrt(x[i]*x[i] + x[i+Q]*x[i+Q] + x[i+2*Q]*x[i+2*Q]); 35 } // End of Quadrature Point Loop 36 return 0; 37 } 38 39 CEED_QFUNCTION(massf)(void *ctx, CeedInt Q, const CeedScalar *const *in, 40 CeedScalar *const *out) { 41 const CeedScalar *u = in[0]; 42 const CeedScalar *qdata = in[1]; 43 CeedScalar *v = out[0]; 44 45 // Quadrature Point Loop 46 for (CeedInt i=0; i<Q; i++) 47 v[i] = qdata[i] * u[i]; 48 49 return 0; 50 } 51 // ***************************************************************************** 52 // BP 3 53 // ***************************************************************************** 54 CEED_QFUNCTION(diffsetupf)(void *ctx, CeedInt Q, const CeedScalar *const *in, 55 CeedScalar *const *out) { 56 const CeedScalar *x = in[0]; 57 const CeedScalar *J = in[1]; 58 const CeedScalar *w = in[2]; 59 CeedScalar *qdata = out[0], *rhs = out[1]; 60 61 // Quadrature Point Loop 62 for (CeedInt i=0; i<Q; i++) { 63 // Stored in Voigt convention 64 // 0 5 4 65 // 5 1 3 66 // 4 3 2 67 const CeedScalar J11 = J[i+Q*0]; 68 const CeedScalar J21 = J[i+Q*1]; 69 const CeedScalar J31 = J[i+Q*2]; 70 const CeedScalar J12 = J[i+Q*3]; 71 const CeedScalar J22 = J[i+Q*4]; 72 const CeedScalar J32 = J[i+Q*5]; 73 const CeedScalar J13 = J[i+Q*6]; 74 const CeedScalar J23 = J[i+Q*7]; 75 const CeedScalar J33 = J[i+Q*8]; 76 const CeedScalar A11 = J22*J33 - J23*J32; 77 const CeedScalar A12 = J13*J32 - J12*J33; 78 const CeedScalar A13 = J12*J23 - J13*J22; 79 const CeedScalar A21 = J23*J31 - J21*J33; 80 const CeedScalar A22 = J11*J33 - J13*J31; 81 const CeedScalar A23 = J13*J21 - J11*J23; 82 const CeedScalar A31 = J21*J32 - J22*J31; 83 const CeedScalar A32 = J12*J31 - J11*J32; 84 const CeedScalar A33 = J11*J22 - J12*J21; 85 const CeedScalar qw = w[i] / (J11*A11 + J21*A12 + J31*A13); 86 qdata[i+Q*0] = qw * (A11*A11 + A12*A12 + A13*A13); 87 qdata[i+Q*1] = qw * (A21*A21 + A22*A22 + A23*A23); 88 qdata[i+Q*2] = qw * (A31*A31 + A32*A32 + A33*A33); 89 qdata[i+Q*3] = qw * (A21*A31 + A22*A32 + A23*A33); 90 qdata[i+Q*4] = qw * (A11*A31 + A12*A32 + A13*A33); 91 qdata[i+Q*5] = qw * (A11*A21 + A12*A22 + A13*A23); 92 const CeedScalar c[3] = { 0, 1., 2. }; 93 const CeedScalar k[3] = { 1., 2., 3. }; 94 const CeedScalar rho = w[i] * (J11*A11 + J21*A12 + J31*A13); 95 rhs[i] = rho * M_PI*M_PI * (k[0]*k[0] + k[1]*k[1] + k[2]*k[2]) * 96 sin(M_PI*(c[0] + k[0]*x[i+Q*0])) * 97 sin(M_PI*(c[1] + k[1]*x[i+Q*1])) * 98 sin(M_PI*(c[2] + k[2]*x[i+Q*2])); 99 } // End of Quadrature Point Loop 100 return 0; 101 } 102 103 CEED_QFUNCTION(diffusionf)(void *ctx, CeedInt Q, const CeedScalar *const *in, 104 CeedScalar *const *out) { 105 const CeedScalar *ug = in[0]; 106 const CeedScalar *qdata = in[1]; 107 CeedScalar *vg = out[0]; 108 109 // Quadrature Point Loop 110 for (CeedInt i=0; i<Q; i++) { 111 const CeedScalar ug0 = ug[i+Q*0]; 112 const CeedScalar ug1 = ug[i+Q*1]; 113 const CeedScalar ug2 = ug[i+Q*2]; 114 vg[i+Q*0] = qdata[i+Q*0]*ug0 + qdata[i+Q*5]*ug1 + qdata[i+Q*4]*ug2; 115 vg[i+Q*1] = qdata[i+Q*5]*ug0 + qdata[i+Q*1]*ug1 + qdata[i+Q*3]*ug2; 116 vg[i+Q*2] = qdata[i+Q*4]*ug0 + qdata[i+Q*3]*ug1 + qdata[i+Q*2]*ug2; 117 } // End of Quadrature Point Loop 118 return 0; 119 } 120 121 #endif // bps_h 122