xref: /honee/qfunctions/setupgeo.h (revision 493642f1e7bb5ccdccd1086ef1091462e675d35c)
1727da7e7SJeremy L Thompson // Copyright (c) 2017-2022, Lawrence Livermore National Security, LLC and other CEED contributors.
2727da7e7SJeremy L Thompson // All Rights Reserved. See the top-level LICENSE and NOTICE files for details.
3a515125bSLeila Ghaffari //
4727da7e7SJeremy L Thompson // SPDX-License-Identifier: BSD-2-Clause
5a515125bSLeila Ghaffari //
6727da7e7SJeremy L Thompson // This file is part of CEED:  http://github.com/ceed
7a515125bSLeila Ghaffari 
8a515125bSLeila Ghaffari /// @file
9a515125bSLeila Ghaffari /// Geometric factors (3D) for Navier-Stokes example using PETSc
10a515125bSLeila Ghaffari 
11a515125bSLeila Ghaffari #ifndef setup_geo_h
12a515125bSLeila Ghaffari #define setup_geo_h
13a515125bSLeila Ghaffari 
14a515125bSLeila Ghaffari #include <math.h>
153a8779fbSJames Wright #include <ceed.h>
16a515125bSLeila Ghaffari 
17a515125bSLeila Ghaffari // *****************************************************************************
18a515125bSLeila Ghaffari // This QFunction sets up the geometric factors required for integration and
19a515125bSLeila Ghaffari //   coordinate transformations
20a515125bSLeila Ghaffari //
21a515125bSLeila Ghaffari // Reference (parent) coordinates: X
22a515125bSLeila Ghaffari // Physical (current) coordinates: x
23a515125bSLeila Ghaffari // Change of coordinate matrix: dxdX_{i,j} = x_{i,j} (indicial notation)
24a515125bSLeila Ghaffari // Inverse of change of coordinate matrix: dXdx_{i,j} = (detJ^-1) * X_{i,j}
25a515125bSLeila Ghaffari //
26a515125bSLeila Ghaffari // All quadrature data is stored in 10 field vector of quadrature data.
27a515125bSLeila Ghaffari //
28a515125bSLeila Ghaffari // We require the determinant of the Jacobian to properly compute integrals of
29a515125bSLeila Ghaffari //   the form: int( v u )
30a515125bSLeila Ghaffari //
31a515125bSLeila Ghaffari // Determinant of Jacobian:
32a515125bSLeila Ghaffari //   detJ = J11*A11 + J21*A12 + J31*A13
33a515125bSLeila Ghaffari //     Jij = Jacobian entry ij
34a515125bSLeila Ghaffari //     Aij = Adjoint ij
35a515125bSLeila Ghaffari //
36a515125bSLeila Ghaffari // Stored: w detJ
37a515125bSLeila Ghaffari //   in q_data[0]
38a515125bSLeila Ghaffari //
39a515125bSLeila Ghaffari // We require the transpose of the inverse of the Jacobian to properly compute
40a515125bSLeila Ghaffari //   integrals of the form: int( gradv u )
41a515125bSLeila Ghaffari //
42a515125bSLeila Ghaffari // Inverse of Jacobian:
43a515125bSLeila Ghaffari //   dXdx_i,j = Aij / detJ
44a515125bSLeila Ghaffari //
45a515125bSLeila Ghaffari // Stored: Aij / detJ
46a515125bSLeila Ghaffari //   in q_data[1:9] as
47a515125bSLeila Ghaffari //   (detJ^-1) * [A11 A12 A13]
48a515125bSLeila Ghaffari //               [A21 A22 A23]
49a515125bSLeila Ghaffari //               [A31 A32 A33]
50a515125bSLeila Ghaffari //
51a515125bSLeila Ghaffari // *****************************************************************************
52a515125bSLeila Ghaffari CEED_QFUNCTION(Setup)(void *ctx, CeedInt Q,
53a515125bSLeila Ghaffari                       const CeedScalar *const *in, CeedScalar *const *out) {
54a515125bSLeila Ghaffari   // *INDENT-OFF*
55a515125bSLeila Ghaffari   // Inputs
56a515125bSLeila Ghaffari   const CeedScalar (*J)[3][CEED_Q_VLA] = (const CeedScalar(*)[3][CEED_Q_VLA])in[0],
57a515125bSLeila Ghaffari                    (*w) = in[1];
58a515125bSLeila Ghaffari 
59a515125bSLeila Ghaffari   // Outputs
60a515125bSLeila Ghaffari   CeedScalar (*q_data)[CEED_Q_VLA] = (CeedScalar(*)[CEED_Q_VLA])out[0];
61a515125bSLeila Ghaffari   // *INDENT-ON*
62a515125bSLeila Ghaffari 
63a515125bSLeila Ghaffari   CeedPragmaSIMD
64a515125bSLeila Ghaffari   // Quadrature Point Loop
65a515125bSLeila Ghaffari   for (CeedInt i=0; i<Q; i++) {
66a515125bSLeila Ghaffari     // Setup
67a515125bSLeila Ghaffari     const CeedScalar J11 = J[0][0][i];
68a515125bSLeila Ghaffari     const CeedScalar J21 = J[0][1][i];
69a515125bSLeila Ghaffari     const CeedScalar J31 = J[0][2][i];
70a515125bSLeila Ghaffari     const CeedScalar J12 = J[1][0][i];
71a515125bSLeila Ghaffari     const CeedScalar J22 = J[1][1][i];
72a515125bSLeila Ghaffari     const CeedScalar J32 = J[1][2][i];
73a515125bSLeila Ghaffari     const CeedScalar J13 = J[2][0][i];
74a515125bSLeila Ghaffari     const CeedScalar J23 = J[2][1][i];
75a515125bSLeila Ghaffari     const CeedScalar J33 = J[2][2][i];
76a515125bSLeila Ghaffari     const CeedScalar A11 = J22*J33 - J23*J32;
77a515125bSLeila Ghaffari     const CeedScalar A12 = J13*J32 - J12*J33;
78a515125bSLeila Ghaffari     const CeedScalar A13 = J12*J23 - J13*J22;
79a515125bSLeila Ghaffari     const CeedScalar A21 = J23*J31 - J21*J33;
80a515125bSLeila Ghaffari     const CeedScalar A22 = J11*J33 - J13*J31;
81a515125bSLeila Ghaffari     const CeedScalar A23 = J13*J21 - J11*J23;
82a515125bSLeila Ghaffari     const CeedScalar A31 = J21*J32 - J22*J31;
83a515125bSLeila Ghaffari     const CeedScalar A32 = J12*J31 - J11*J32;
84a515125bSLeila Ghaffari     const CeedScalar A33 = J11*J22 - J12*J21;
85a515125bSLeila Ghaffari     const CeedScalar detJ = J11*A11 + J21*A12 + J31*A13;
86a515125bSLeila Ghaffari 
87a515125bSLeila Ghaffari     // Qdata
88a515125bSLeila Ghaffari     // -- Interp-to-Interp q_data
89a515125bSLeila Ghaffari     q_data[0][i] = w[i] * detJ;
90a515125bSLeila Ghaffari     // -- Interp-to-Grad q_data
91a515125bSLeila Ghaffari     // Inverse of change of coordinate matrix: X_i,j
92a515125bSLeila Ghaffari     q_data[1][i] = A11 / detJ;
93a515125bSLeila Ghaffari     q_data[2][i] = A12 / detJ;
94a515125bSLeila Ghaffari     q_data[3][i] = A13 / detJ;
95a515125bSLeila Ghaffari     q_data[4][i] = A21 / detJ;
96a515125bSLeila Ghaffari     q_data[5][i] = A22 / detJ;
97a515125bSLeila Ghaffari     q_data[6][i] = A23 / detJ;
98a515125bSLeila Ghaffari     q_data[7][i] = A31 / detJ;
99a515125bSLeila Ghaffari     q_data[8][i] = A32 / detJ;
100a515125bSLeila Ghaffari     q_data[9][i] = A33 / detJ;
101a515125bSLeila Ghaffari 
102a515125bSLeila Ghaffari   } // End of Quadrature Point Loop
103a515125bSLeila Ghaffari 
104a515125bSLeila Ghaffari   // Return
105a515125bSLeila Ghaffari   return 0;
106a515125bSLeila Ghaffari }
107a515125bSLeila Ghaffari 
108a515125bSLeila Ghaffari // *****************************************************************************
109a515125bSLeila Ghaffari // This QFunction sets up the geometric factor required for integration when
110a515125bSLeila Ghaffari //   reference coordinates are in 2D and the physical coordinates are in 3D
111a515125bSLeila Ghaffari //
112a515125bSLeila Ghaffari // Reference (parent) 2D coordinates: X
113a515125bSLeila Ghaffari // Physical (current) 3D coordinates: x
114a515125bSLeila Ghaffari // Change of coordinate matrix:
115a515125bSLeila Ghaffari //   dxdX_{i,j} = dx_i/dX_j (indicial notation) [3 * 2]
116*493642f1SJames Wright // Inverse change of coordinate matrix:
117*493642f1SJames Wright //   dXdx_{i,j} = dX_i/dx_j (indicial notation) [2 * 3]
118a515125bSLeila Ghaffari //
119a515125bSLeila Ghaffari // (J1,J2,J3) is given by the cross product of the columns of dxdX_{i,j}
120a515125bSLeila Ghaffari //
121a515125bSLeila Ghaffari // detJb is the magnitude of (J1,J2,J3)
122a515125bSLeila Ghaffari //
123*493642f1SJames Wright // dXdx is calculated via Moore–Penrose inverse:
124*493642f1SJames Wright //
125*493642f1SJames Wright //   dX_i/dx_j = (dxdX^T dxdX)^(-1) dxdX
126*493642f1SJames Wright //             = (dx_l/dX_i * dx_l/dX_k)^(-1) dx_j/dX_k
127*493642f1SJames Wright //
128*493642f1SJames Wright // All quadrature data is stored in 10 field vector of quadrature data.
129a515125bSLeila Ghaffari //
130a515125bSLeila Ghaffari // We require the determinant of the Jacobian to properly compute integrals of
131a515125bSLeila Ghaffari //   the form: int( u v )
132a515125bSLeila Ghaffari //
133a515125bSLeila Ghaffari // Stored: w detJb
134a515125bSLeila Ghaffari //   in q_data_sur[0]
135a515125bSLeila Ghaffari //
136a515125bSLeila Ghaffari // Normal vector = (J1,J2,J3) / detJb
137a515125bSLeila Ghaffari //
138*493642f1SJames Wright //   - TODO Could possibly remove normal vector, as it could be calculated in the Qfunction from dXdx
139a515125bSLeila Ghaffari // Stored: (J1,J2,J3) / detJb
140a515125bSLeila Ghaffari //   in q_data_sur[1:3] as
141a515125bSLeila Ghaffari //   (detJb^-1) * [ J1 ]
142a515125bSLeila Ghaffari //                [ J2 ]
143a515125bSLeila Ghaffari //                [ J3 ]
144a515125bSLeila Ghaffari //
145*493642f1SJames Wright // Stored: dXdx_{i,j}
146*493642f1SJames Wright //   in q_data_sur[4:9] as
147*493642f1SJames Wright //    [dXdx_11 dXdx_12 dXdx_13]
148*493642f1SJames Wright //    [dXdx_21 dXdx_22 dXdx_23]
149*493642f1SJames Wright //
150a515125bSLeila Ghaffari // *****************************************************************************
151a515125bSLeila Ghaffari CEED_QFUNCTION(SetupBoundary)(void *ctx, CeedInt Q,
152a515125bSLeila Ghaffari                               const CeedScalar *const *in, CeedScalar *const *out) {
153a515125bSLeila Ghaffari   // *INDENT-OFF*
154a515125bSLeila Ghaffari   // Inputs
155a515125bSLeila Ghaffari   const CeedScalar (*J)[3][CEED_Q_VLA] = (const CeedScalar(*)[3][CEED_Q_VLA])in[0],
156a515125bSLeila Ghaffari                    (*w) = in[1];
157a515125bSLeila Ghaffari   // Outputs
158a515125bSLeila Ghaffari   CeedScalar (*q_data_sur)[CEED_Q_VLA] = (CeedScalar(*)[CEED_Q_VLA])out[0];
159a515125bSLeila Ghaffari 
160a515125bSLeila Ghaffari   CeedPragmaSIMD
161a515125bSLeila Ghaffari   // Quadrature Point Loop
162a515125bSLeila Ghaffari   for (CeedInt i=0; i<Q; i++) {
163a515125bSLeila Ghaffari     // Setup
164a515125bSLeila Ghaffari     const CeedScalar dxdX[3][2] = {{J[0][0][i],
165a515125bSLeila Ghaffari                                     J[1][0][i]},
166a515125bSLeila Ghaffari                                    {J[0][1][i],
167a515125bSLeila Ghaffari                                     J[1][1][i]},
168a515125bSLeila Ghaffari                                    {J[0][2][i],
169a515125bSLeila Ghaffari                                     J[1][2][i]}
170a515125bSLeila Ghaffari                                    };
171a515125bSLeila Ghaffari     // *INDENT-ON*
172a515125bSLeila Ghaffari     // J1, J2, and J3 are given by the cross product of the columns of dxdX
173a515125bSLeila Ghaffari     const CeedScalar J1 = dxdX[1][0]*dxdX[2][1] - dxdX[2][0]*dxdX[1][1];
174a515125bSLeila Ghaffari     const CeedScalar J2 = dxdX[2][0]*dxdX[0][1] - dxdX[0][0]*dxdX[2][1];
175a515125bSLeila Ghaffari     const CeedScalar J3 = dxdX[0][0]*dxdX[1][1] - dxdX[1][0]*dxdX[0][1];
176a515125bSLeila Ghaffari 
177a515125bSLeila Ghaffari     const CeedScalar detJb = sqrt(J1*J1 + J2*J2 + J3*J3);
178a515125bSLeila Ghaffari 
179a515125bSLeila Ghaffari     // q_data_sur
180a515125bSLeila Ghaffari     // -- Interp-to-Interp q_data_sur
181a515125bSLeila Ghaffari     q_data_sur[0][i] = w[i] * detJb;
182a515125bSLeila Ghaffari     q_data_sur[1][i] = J1 / detJb;
183a515125bSLeila Ghaffari     q_data_sur[2][i] = J2 / detJb;
184a515125bSLeila Ghaffari     q_data_sur[3][i] = J3 / detJb;
185a515125bSLeila Ghaffari 
186*493642f1SJames Wright     // dxdX_k,j * dxdX_j,k
187*493642f1SJames Wright     CeedScalar dxdXTdxdX[2][2] = {{ 0. }};
188*493642f1SJames Wright     for (CeedInt j=0; j<2; j++)
189*493642f1SJames Wright       for (CeedInt k=0; k<2; k++)
190*493642f1SJames Wright         for (CeedInt l=0; l<3; l++)
191*493642f1SJames Wright           dxdXTdxdX[j][k] += dxdX[l][j]*dxdX[l][k];
192*493642f1SJames Wright 
193*493642f1SJames Wright     const CeedScalar detdxdXTdxdX =  dxdXTdxdX[0][0] * dxdXTdxdX[1][1]
194*493642f1SJames Wright                                      -dxdXTdxdX[1][0] * dxdXTdxdX[0][1];
195*493642f1SJames Wright 
196*493642f1SJames Wright     // Compute inverse of dxdXTdxdX
197*493642f1SJames Wright     CeedScalar dxdXTdxdX_inv[2][2];
198*493642f1SJames Wright     dxdXTdxdX_inv[0][0] =  dxdXTdxdX[1][1] / detdxdXTdxdX;
199*493642f1SJames Wright     dxdXTdxdX_inv[0][1] = -dxdXTdxdX[0][1] / detdxdXTdxdX;
200*493642f1SJames Wright     dxdXTdxdX_inv[1][0] = -dxdXTdxdX[1][0] / detdxdXTdxdX;
201*493642f1SJames Wright     dxdXTdxdX_inv[1][1] =  dxdXTdxdX[0][0] / detdxdXTdxdX;
202*493642f1SJames Wright 
203*493642f1SJames Wright     // Compute dXdx from dxdXTdxdX^-1 and dxdX
204*493642f1SJames Wright     CeedScalar dXdx[2][3] = {{ 0. }};
205*493642f1SJames Wright     for (CeedInt j=0; j<2; j++)
206*493642f1SJames Wright       for (CeedInt k=0; k<3; k++)
207*493642f1SJames Wright         for (CeedInt l=0; l<2; l++)
208*493642f1SJames Wright           dXdx[j][k] += dxdXTdxdX_inv[l][j] * dxdX[k][l];
209*493642f1SJames Wright 
210*493642f1SJames Wright     q_data_sur[4][i] = dXdx[0][0];
211*493642f1SJames Wright     q_data_sur[5][i] = dXdx[0][1];
212*493642f1SJames Wright     q_data_sur[6][i] = dXdx[0][2];
213*493642f1SJames Wright     q_data_sur[7][i] = dXdx[1][0];
214*493642f1SJames Wright     q_data_sur[8][i] = dXdx[1][1];
215*493642f1SJames Wright     q_data_sur[9][i] = dXdx[1][2];
216*493642f1SJames Wright 
217a515125bSLeila Ghaffari   } // End of Quadrature Point Loop
218a515125bSLeila Ghaffari 
219a515125bSLeila Ghaffari   // Return
220a515125bSLeila Ghaffari   return 0;
221a515125bSLeila Ghaffari }
222a515125bSLeila Ghaffari 
223a515125bSLeila Ghaffari // *****************************************************************************
224a515125bSLeila Ghaffari 
225a515125bSLeila Ghaffari #endif // setup_geo_h
226