1*3d8e8822SJeremy L Thompson // Copyright (c) 2017-2022, Lawrence Livermore National Security, LLC and other CEED contributors. 2*3d8e8822SJeremy L Thompson // All Rights Reserved. See the top-level LICENSE and NOTICE files for details. 34d537eeaSYohann // 4*3d8e8822SJeremy L Thompson // SPDX-License-Identifier: BSD-2-Clause 54d537eeaSYohann // 6*3d8e8822SJeremy L Thompson // This file is part of CEED: http://github.com/ceed 74d537eeaSYohann 836d2312cSvaleriabarra #ifndef bps_h 936d2312cSvaleriabarra #define bps_h 1036d2312cSvaleriabarra 114d537eeaSYohann #include <math.h> 124d537eeaSYohann 13ccaff030SJeremy L Thompson #ifndef M_PI 14ccaff030SJeremy L Thompson #define M_PI 3.14159265358979323846 15ccaff030SJeremy L Thompson #endif 16ccaff030SJeremy L Thompson 174d537eeaSYohann // ***************************************************************************** 184d537eeaSYohann // BP 1 194d537eeaSYohann // ***************************************************************************** 20ccaff030SJeremy L Thompson CEED_QFUNCTION(masssetupf)(void *ctx, CeedInt Q, const CeedScalar *const *in, 21ccaff030SJeremy L Thompson CeedScalar *const *out) { 22a2fa7910SValeria Barra CeedScalar *qdata = out[0], *rhs = out[1]; 234d537eeaSYohann const CeedScalar *x = in[0]; 244d537eeaSYohann const CeedScalar *J = in[1]; 254d537eeaSYohann const CeedScalar *w = in[2]; 26ee07ded2SValeria Barra 27ee07ded2SValeria Barra // Quadrature Point Loop 284d537eeaSYohann for (CeedInt i=0; i<Q; i++) { 294d537eeaSYohann CeedScalar det = (J[i+Q*0]*(J[i+Q*4]*J[i+Q*8] - J[i+Q*5]*J[i+Q*7]) - 304d537eeaSYohann J[i+Q*1]*(J[i+Q*3]*J[i+Q*8] - J[i+Q*5]*J[i+Q*6]) + 314d537eeaSYohann J[i+Q*2]*(J[i+Q*3]*J[i+Q*7] - J[i+Q*4]*J[i+Q*6])); 32a2fa7910SValeria Barra qdata[i] = det * w[i]; 33ab213215SJeremy L Thompson rhs[i] = qdata[i] * sqrt(x[i]*x[i] + x[i+Q]*x[i+Q] + x[i+2*Q]*x[i+2*Q]); 34ee07ded2SValeria Barra } // End of Quadrature Point Loop 354d537eeaSYohann return 0; 364d537eeaSYohann } 374d537eeaSYohann 38ab213215SJeremy L Thompson CEED_QFUNCTION(massf)(void *ctx, CeedInt Q, const CeedScalar *const *in, 39ccaff030SJeremy L Thompson CeedScalar *const *out) { 404d537eeaSYohann const CeedScalar *u = in[0]; 41a2fa7910SValeria Barra const CeedScalar *qdata = in[1]; 424d537eeaSYohann CeedScalar *v = out[0]; 43ee07ded2SValeria Barra 44ee07ded2SValeria Barra // Quadrature Point Loop 45ee07ded2SValeria Barra for (CeedInt i=0; i<Q; i++) 46a2fa7910SValeria Barra v[i] = qdata[i] * u[i]; 47ee07ded2SValeria Barra 484d537eeaSYohann return 0; 494d537eeaSYohann } 504d537eeaSYohann // ***************************************************************************** 514d537eeaSYohann // BP 3 524d537eeaSYohann // ***************************************************************************** 53ccaff030SJeremy L Thompson CEED_QFUNCTION(diffsetupf)(void *ctx, CeedInt Q, const CeedScalar *const *in, 54ccaff030SJeremy L Thompson CeedScalar *const *out) { 554d537eeaSYohann const CeedScalar *x = in[0]; 564d537eeaSYohann const CeedScalar *J = in[1]; 574d537eeaSYohann const CeedScalar *w = in[2]; 58a2fa7910SValeria Barra CeedScalar *qdata = out[0], *rhs = out[1]; 59ee07ded2SValeria Barra 60ee07ded2SValeria Barra // Quadrature Point Loop 614d537eeaSYohann for (CeedInt i=0; i<Q; i++) { 62288c0443SJeremy L Thompson // Stored in Voigt convention 63288c0443SJeremy L Thompson // 0 5 4 64288c0443SJeremy L Thompson // 5 1 3 65288c0443SJeremy L Thompson // 4 3 2 664d537eeaSYohann const CeedScalar J11 = J[i+Q*0]; 674d537eeaSYohann const CeedScalar J21 = J[i+Q*1]; 684d537eeaSYohann const CeedScalar J31 = J[i+Q*2]; 694d537eeaSYohann const CeedScalar J12 = J[i+Q*3]; 704d537eeaSYohann const CeedScalar J22 = J[i+Q*4]; 714d537eeaSYohann const CeedScalar J32 = J[i+Q*5]; 724d537eeaSYohann const CeedScalar J13 = J[i+Q*6]; 734d537eeaSYohann const CeedScalar J23 = J[i+Q*7]; 744d537eeaSYohann const CeedScalar J33 = J[i+Q*8]; 754d537eeaSYohann const CeedScalar A11 = J22*J33 - J23*J32; 764d537eeaSYohann const CeedScalar A12 = J13*J32 - J12*J33; 774d537eeaSYohann const CeedScalar A13 = J12*J23 - J13*J22; 784d537eeaSYohann const CeedScalar A21 = J23*J31 - J21*J33; 794d537eeaSYohann const CeedScalar A22 = J11*J33 - J13*J31; 804d537eeaSYohann const CeedScalar A23 = J13*J21 - J11*J23; 814d537eeaSYohann const CeedScalar A31 = J21*J32 - J22*J31; 824d537eeaSYohann const CeedScalar A32 = J12*J31 - J11*J32; 834d537eeaSYohann const CeedScalar A33 = J11*J22 - J12*J21; 844d537eeaSYohann const CeedScalar qw = w[i] / (J11*A11 + J21*A12 + J31*A13); 85a2fa7910SValeria Barra qdata[i+Q*0] = qw * (A11*A11 + A12*A12 + A13*A13); 86a2fa7910SValeria Barra qdata[i+Q*1] = qw * (A21*A21 + A22*A22 + A23*A23); 87a2fa7910SValeria Barra qdata[i+Q*2] = qw * (A31*A31 + A32*A32 + A33*A33); 88a2fa7910SValeria Barra qdata[i+Q*3] = qw * (A21*A31 + A22*A32 + A23*A33); 89a2fa7910SValeria Barra qdata[i+Q*4] = qw * (A11*A31 + A12*A32 + A13*A33); 90a2fa7910SValeria Barra qdata[i+Q*5] = qw * (A11*A21 + A12*A22 + A13*A23); 914d537eeaSYohann const CeedScalar c[3] = { 0, 1., 2. }; 924d537eeaSYohann const CeedScalar k[3] = { 1., 2., 3. }; 934d537eeaSYohann const CeedScalar rho = w[i] * (J11*A11 + J21*A12 + J31*A13); 944d537eeaSYohann rhs[i] = rho * M_PI*M_PI * (k[0]*k[0] + k[1]*k[1] + k[2]*k[2]) * 954d537eeaSYohann sin(M_PI*(c[0] + k[0]*x[i+Q*0])) * 964d537eeaSYohann sin(M_PI*(c[1] + k[1]*x[i+Q*1])) * 974d537eeaSYohann sin(M_PI*(c[2] + k[2]*x[i+Q*2])); 98ee07ded2SValeria Barra } // End of Quadrature Point Loop 994d537eeaSYohann return 0; 1004d537eeaSYohann } 1014d537eeaSYohann 102ab213215SJeremy L Thompson CEED_QFUNCTION(diffusionf)(void *ctx, CeedInt Q, const CeedScalar *const *in, 103ccaff030SJeremy L Thompson CeedScalar *const *out) { 1044d537eeaSYohann const CeedScalar *ug = in[0]; 105a2fa7910SValeria Barra const CeedScalar *qdata = in[1]; 1064d537eeaSYohann CeedScalar *vg = out[0]; 107ee07ded2SValeria Barra 108ee07ded2SValeria Barra // Quadrature Point Loop 1094d537eeaSYohann for (CeedInt i=0; i<Q; i++) { 1104d537eeaSYohann const CeedScalar ug0 = ug[i+Q*0]; 1114d537eeaSYohann const CeedScalar ug1 = ug[i+Q*1]; 1124d537eeaSYohann const CeedScalar ug2 = ug[i+Q*2]; 113a2fa7910SValeria Barra vg[i+Q*0] = qdata[i+Q*0]*ug0 + qdata[i+Q*5]*ug1 + qdata[i+Q*4]*ug2; 114a2fa7910SValeria Barra vg[i+Q*1] = qdata[i+Q*5]*ug0 + qdata[i+Q*1]*ug1 + qdata[i+Q*3]*ug2; 115a2fa7910SValeria Barra vg[i+Q*2] = qdata[i+Q*4]*ug0 + qdata[i+Q*3]*ug1 + qdata[i+Q*2]*ug2; 116ee07ded2SValeria Barra } // End of Quadrature Point Loop 1174d537eeaSYohann return 0; 1184d537eeaSYohann } 11936d2312cSvaleriabarra 12036d2312cSvaleriabarra #endif // bps_h 121