xref: /libCEED/examples/nek/bps/bps.h (revision c9c2c07970382857cc7b4a28d359710237b91a3e)
13d8e8822SJeremy L Thompson // Copyright (c) 2017-2022, Lawrence Livermore National Security, LLC and other CEED contributors.
23d8e8822SJeremy L Thompson // All Rights Reserved. See the top-level LICENSE and NOTICE files for details.
34d537eeaSYohann //
43d8e8822SJeremy L Thompson // SPDX-License-Identifier: BSD-2-Clause
54d537eeaSYohann //
63d8e8822SJeremy L Thompson // This file is part of CEED:  http://github.com/ceed
74d537eeaSYohann 
836d2312cSvaleriabarra #ifndef bps_h
936d2312cSvaleriabarra #define bps_h
1036d2312cSvaleriabarra 
11*c9c2c079SJeremy L Thompson #include <ceed.h>
124d537eeaSYohann #include <math.h>
134d537eeaSYohann 
14ccaff030SJeremy L Thompson #ifndef M_PI
15ccaff030SJeremy L Thompson #define M_PI    3.14159265358979323846
16ccaff030SJeremy L Thompson #endif
17ccaff030SJeremy L Thompson 
184d537eeaSYohann // *****************************************************************************
194d537eeaSYohann //   BP 1
204d537eeaSYohann // *****************************************************************************
21ccaff030SJeremy L Thompson CEED_QFUNCTION(masssetupf)(void *ctx, CeedInt Q, const CeedScalar *const *in,
22ccaff030SJeremy L Thompson                            CeedScalar *const *out) {
23a2fa7910SValeria Barra   CeedScalar *qdata = out[0], *rhs = out[1];
244d537eeaSYohann   const CeedScalar *x = in[0];
254d537eeaSYohann   const CeedScalar *J = in[1];
264d537eeaSYohann   const CeedScalar *w = in[2];
27ee07ded2SValeria Barra 
28ee07ded2SValeria Barra   // Quadrature Point Loop
294d537eeaSYohann   for (CeedInt i=0; i<Q; i++) {
304d537eeaSYohann     CeedScalar det = (J[i+Q*0]*(J[i+Q*4]*J[i+Q*8] - J[i+Q*5]*J[i+Q*7]) -
314d537eeaSYohann                       J[i+Q*1]*(J[i+Q*3]*J[i+Q*8] - J[i+Q*5]*J[i+Q*6]) +
324d537eeaSYohann                       J[i+Q*2]*(J[i+Q*3]*J[i+Q*7] - J[i+Q*4]*J[i+Q*6]));
33a2fa7910SValeria Barra     qdata[i] = det * w[i];
34ab213215SJeremy 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]);
35ee07ded2SValeria Barra   } // End of Quadrature Point Loop
364d537eeaSYohann   return 0;
374d537eeaSYohann }
384d537eeaSYohann 
39ab213215SJeremy L Thompson CEED_QFUNCTION(massf)(void *ctx, CeedInt Q, const CeedScalar *const *in,
40ccaff030SJeremy L Thompson                       CeedScalar *const *out) {
414d537eeaSYohann   const CeedScalar *u = in[0];
42a2fa7910SValeria Barra   const CeedScalar *qdata = in[1];
434d537eeaSYohann   CeedScalar *v = out[0];
44ee07ded2SValeria Barra 
45ee07ded2SValeria Barra   // Quadrature Point Loop
46ee07ded2SValeria Barra   for (CeedInt i=0; i<Q; i++)
47a2fa7910SValeria Barra     v[i] = qdata[i] * u[i];
48ee07ded2SValeria Barra 
494d537eeaSYohann   return 0;
504d537eeaSYohann }
514d537eeaSYohann // *****************************************************************************
524d537eeaSYohann //   BP 3
534d537eeaSYohann // *****************************************************************************
54ccaff030SJeremy L Thompson CEED_QFUNCTION(diffsetupf)(void *ctx, CeedInt Q, const CeedScalar *const *in,
55ccaff030SJeremy L Thompson                            CeedScalar *const *out) {
564d537eeaSYohann   const CeedScalar *x = in[0];
574d537eeaSYohann   const CeedScalar *J = in[1];
584d537eeaSYohann   const CeedScalar *w = in[2];
59a2fa7910SValeria Barra   CeedScalar *qdata = out[0], *rhs = out[1];
60ee07ded2SValeria Barra 
61ee07ded2SValeria Barra   // Quadrature Point Loop
624d537eeaSYohann   for (CeedInt i=0; i<Q; i++) {
63288c0443SJeremy L Thompson     // Stored in Voigt convention
64288c0443SJeremy L Thompson     // 0 5 4
65288c0443SJeremy L Thompson     // 5 1 3
66288c0443SJeremy L Thompson     // 4 3 2
674d537eeaSYohann     const CeedScalar J11 = J[i+Q*0];
684d537eeaSYohann     const CeedScalar J21 = J[i+Q*1];
694d537eeaSYohann     const CeedScalar J31 = J[i+Q*2];
704d537eeaSYohann     const CeedScalar J12 = J[i+Q*3];
714d537eeaSYohann     const CeedScalar J22 = J[i+Q*4];
724d537eeaSYohann     const CeedScalar J32 = J[i+Q*5];
734d537eeaSYohann     const CeedScalar J13 = J[i+Q*6];
744d537eeaSYohann     const CeedScalar J23 = J[i+Q*7];
754d537eeaSYohann     const CeedScalar J33 = J[i+Q*8];
764d537eeaSYohann     const CeedScalar A11 = J22*J33 - J23*J32;
774d537eeaSYohann     const CeedScalar A12 = J13*J32 - J12*J33;
784d537eeaSYohann     const CeedScalar A13 = J12*J23 - J13*J22;
794d537eeaSYohann     const CeedScalar A21 = J23*J31 - J21*J33;
804d537eeaSYohann     const CeedScalar A22 = J11*J33 - J13*J31;
814d537eeaSYohann     const CeedScalar A23 = J13*J21 - J11*J23;
824d537eeaSYohann     const CeedScalar A31 = J21*J32 - J22*J31;
834d537eeaSYohann     const CeedScalar A32 = J12*J31 - J11*J32;
844d537eeaSYohann     const CeedScalar A33 = J11*J22 - J12*J21;
854d537eeaSYohann     const CeedScalar qw = w[i] / (J11*A11 + J21*A12 + J31*A13);
86a2fa7910SValeria Barra     qdata[i+Q*0] = qw * (A11*A11 + A12*A12 + A13*A13);
87a2fa7910SValeria Barra     qdata[i+Q*1] = qw * (A21*A21 + A22*A22 + A23*A23);
88a2fa7910SValeria Barra     qdata[i+Q*2] = qw * (A31*A31 + A32*A32 + A33*A33);
89a2fa7910SValeria Barra     qdata[i+Q*3] = qw * (A21*A31 + A22*A32 + A23*A33);
90a2fa7910SValeria Barra     qdata[i+Q*4] = qw * (A11*A31 + A12*A32 + A13*A33);
91a2fa7910SValeria Barra     qdata[i+Q*5] = qw * (A11*A21 + A12*A22 + A13*A23);
924d537eeaSYohann     const CeedScalar c[3] = { 0, 1., 2. };
934d537eeaSYohann     const CeedScalar k[3] = { 1., 2., 3. };
944d537eeaSYohann     const CeedScalar rho = w[i] * (J11*A11 + J21*A12 + J31*A13);
954d537eeaSYohann     rhs[i] = rho * M_PI*M_PI * (k[0]*k[0] + k[1]*k[1] + k[2]*k[2]) *
964d537eeaSYohann              sin(M_PI*(c[0] + k[0]*x[i+Q*0])) *
974d537eeaSYohann              sin(M_PI*(c[1] + k[1]*x[i+Q*1])) *
984d537eeaSYohann              sin(M_PI*(c[2] + k[2]*x[i+Q*2]));
99ee07ded2SValeria Barra   } // End of Quadrature Point Loop
1004d537eeaSYohann   return 0;
1014d537eeaSYohann }
1024d537eeaSYohann 
103ab213215SJeremy L Thompson CEED_QFUNCTION(diffusionf)(void *ctx, CeedInt Q, const CeedScalar *const *in,
104ccaff030SJeremy L Thompson                            CeedScalar *const *out) {
1054d537eeaSYohann   const CeedScalar *ug = in[0];
106a2fa7910SValeria Barra   const CeedScalar *qdata = in[1];
1074d537eeaSYohann   CeedScalar *vg = out[0];
108ee07ded2SValeria Barra 
109ee07ded2SValeria Barra   // Quadrature Point Loop
1104d537eeaSYohann   for (CeedInt i=0; i<Q; i++) {
1114d537eeaSYohann     const CeedScalar ug0 = ug[i+Q*0];
1124d537eeaSYohann     const CeedScalar ug1 = ug[i+Q*1];
1134d537eeaSYohann     const CeedScalar ug2 = ug[i+Q*2];
114a2fa7910SValeria Barra     vg[i+Q*0] = qdata[i+Q*0]*ug0 + qdata[i+Q*5]*ug1 + qdata[i+Q*4]*ug2;
115a2fa7910SValeria Barra     vg[i+Q*1] = qdata[i+Q*5]*ug0 + qdata[i+Q*1]*ug1 + qdata[i+Q*3]*ug2;
116a2fa7910SValeria Barra     vg[i+Q*2] = qdata[i+Q*4]*ug0 + qdata[i+Q*3]*ug1 + qdata[i+Q*2]*ug2;
117ee07ded2SValeria Barra   } // End of Quadrature Point Loop
1184d537eeaSYohann   return 0;
1194d537eeaSYohann }
12036d2312cSvaleriabarra 
12136d2312cSvaleriabarra #endif // bps_h
122