xref: /libCEED/backends/blocked/ceed-blocked-operator.c (revision e64bb3f3ed2986a0c10dec3b47522d734c6e367d)
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 #include <ceed.h>
9 #include <ceed/backend.h>
10 #include <stdbool.h>
11 #include <stddef.h>
12 #include <stdint.h>
13 
14 #include "ceed-blocked.h"
15 
16 //------------------------------------------------------------------------------
17 // Setup Input/Output Fields
18 //------------------------------------------------------------------------------
19 static int CeedOperatorSetupFields_Blocked(CeedQFunction qf, CeedOperator op, bool is_input, CeedElemRestriction *blk_restr, CeedVector *e_vecs_full,
20                                            CeedVector *e_vecs, CeedVector *q_vecs, CeedInt start_e, CeedInt num_fields, CeedInt Q) {
21   CeedInt  num_comp, size, P;
22   CeedSize e_size, q_size;
23   Ceed     ceed;
24   CeedCallBackend(CeedOperatorGetCeed(op, &ceed));
25   CeedBasis           basis;
26   CeedElemRestriction r;
27   CeedOperatorField  *op_fields;
28   CeedQFunctionField *qf_fields;
29   if (is_input) {
30     CeedCallBackend(CeedOperatorGetFields(op, NULL, &op_fields, NULL, NULL));
31     CeedCallBackend(CeedQFunctionGetFields(qf, NULL, &qf_fields, NULL, NULL));
32   } else {
33     CeedCallBackend(CeedOperatorGetFields(op, NULL, NULL, NULL, &op_fields));
34     CeedCallBackend(CeedQFunctionGetFields(qf, NULL, NULL, NULL, &qf_fields));
35   }
36   const CeedInt blk_size = 8;
37 
38   // Loop over fields
39   for (CeedInt i = 0; i < num_fields; i++) {
40     CeedEvalMode eval_mode;
41     CeedCallBackend(CeedQFunctionFieldGetEvalMode(qf_fields[i], &eval_mode));
42 
43     if (eval_mode != CEED_EVAL_WEIGHT) {
44       Ceed ceed_rstr;
45       CeedCallBackend(CeedOperatorFieldGetElemRestriction(op_fields[i], &r));
46       CeedCallBackend(CeedElemRestrictionGetCeed(r, &ceed_rstr));
47       CeedSize l_size;
48       CeedInt  num_elem, elem_size, comp_stride;
49       CeedCallBackend(CeedElemRestrictionGetNumElements(r, &num_elem));
50       CeedCallBackend(CeedElemRestrictionGetElementSize(r, &elem_size));
51       CeedCallBackend(CeedElemRestrictionGetLVectorSize(r, &l_size));
52       CeedCallBackend(CeedElemRestrictionGetNumComponents(r, &num_comp));
53       CeedCallBackend(CeedElemRestrictionGetCompStride(r, &comp_stride));
54 
55       CeedRestrictionType rstr_type;
56       CeedCallBackend(CeedElemRestrictionGetType(r, &rstr_type));
57       switch (rstr_type) {
58         case CEED_RESTRICTION_STANDARD: {
59           const CeedInt *offsets = NULL;
60           CeedCallBackend(CeedElemRestrictionGetOffsets(r, CEED_MEM_HOST, &offsets));
61           CeedCallBackend(CeedElemRestrictionCreateBlocked(ceed_rstr, num_elem, elem_size, blk_size, num_comp, comp_stride, l_size, CEED_MEM_HOST,
62                                                            CEED_COPY_VALUES, offsets, &blk_restr[i + start_e]));
63           CeedCallBackend(CeedElemRestrictionRestoreOffsets(r, &offsets));
64         } break;
65         case CEED_RESTRICTION_ORIENTED: {
66           const CeedInt *offsets = NULL;
67           const bool    *orients = NULL;
68           CeedCallBackend(CeedElemRestrictionGetOffsets(r, CEED_MEM_HOST, &offsets));
69           CeedCallBackend(CeedElemRestrictionGetOrientations(r, CEED_MEM_HOST, &orients));
70           CeedCallBackend(CeedElemRestrictionCreateBlockedOriented(ceed_rstr, num_elem, elem_size, blk_size, num_comp, comp_stride, l_size,
71                                                                    CEED_MEM_HOST, CEED_COPY_VALUES, offsets, orients, &blk_restr[i + start_e]));
72           CeedCallBackend(CeedElemRestrictionRestoreOffsets(r, &offsets));
73           CeedCallBackend(CeedElemRestrictionRestoreOrientations(r, &orients));
74         } break;
75         case CEED_RESTRICTION_CURL_ORIENTED: {
76           const CeedInt  *offsets      = NULL;
77           const CeedInt8 *curl_orients = NULL;
78           CeedCallBackend(CeedElemRestrictionGetOffsets(r, CEED_MEM_HOST, &offsets));
79           CeedCallBackend(CeedElemRestrictionGetCurlOrientations(r, CEED_MEM_HOST, &curl_orients));
80           CeedCallBackend(CeedElemRestrictionCreateBlockedCurlOriented(ceed_rstr, num_elem, elem_size, blk_size, num_comp, comp_stride, l_size,
81                                                                        CEED_MEM_HOST, CEED_COPY_VALUES, offsets, curl_orients,
82                                                                        &blk_restr[i + start_e]));
83           CeedCallBackend(CeedElemRestrictionRestoreOffsets(r, &offsets));
84           CeedCallBackend(CeedElemRestrictionRestoreCurlOrientations(r, &curl_orients));
85         } break;
86         case CEED_RESTRICTION_STRIDED: {
87           CeedInt strides[3];
88           CeedCallBackend(CeedElemRestrictionGetStrides(r, &strides));
89           CeedCallBackend(
90               CeedElemRestrictionCreateBlockedStrided(ceed_rstr, num_elem, elem_size, blk_size, num_comp, l_size, strides, &blk_restr[i + start_e]));
91         } break;
92       }
93       CeedCallBackend(CeedElemRestrictionCreateVector(blk_restr[i + start_e], NULL, &e_vecs_full[i + start_e]));
94     }
95 
96     switch (eval_mode) {
97       case CEED_EVAL_NONE:
98         CeedCallBackend(CeedQFunctionFieldGetSize(qf_fields[i], &size));
99         q_size = (CeedSize)Q * size * blk_size;
100         CeedCallBackend(CeedVectorCreate(ceed, q_size, &q_vecs[i]));
101         break;
102       case CEED_EVAL_INTERP:
103       case CEED_EVAL_GRAD:
104       case CEED_EVAL_DIV:
105       case CEED_EVAL_CURL:
106         CeedCallBackend(CeedOperatorFieldGetBasis(op_fields[i], &basis));
107         CeedCallBackend(CeedQFunctionFieldGetSize(qf_fields[i], &size));
108         CeedCallBackend(CeedBasisGetNumNodes(basis, &P));
109         CeedCallBackend(CeedBasisGetNumComponents(basis, &num_comp));
110         e_size = (CeedSize)P * num_comp * blk_size;
111         CeedCallBackend(CeedVectorCreate(ceed, e_size, &e_vecs[i]));
112         q_size = (CeedSize)Q * size * blk_size;
113         CeedCallBackend(CeedVectorCreate(ceed, q_size, &q_vecs[i]));
114         break;
115       case CEED_EVAL_WEIGHT:  // Only on input fields
116         CeedCallBackend(CeedOperatorFieldGetBasis(op_fields[i], &basis));
117         q_size = (CeedSize)Q * blk_size;
118         CeedCallBackend(CeedVectorCreate(ceed, q_size, &q_vecs[i]));
119         CeedCallBackend(CeedBasisApply(basis, blk_size, CEED_NOTRANSPOSE, CEED_EVAL_WEIGHT, CEED_VECTOR_NONE, q_vecs[i]));
120         break;
121     }
122   }
123   return CEED_ERROR_SUCCESS;
124 }
125 
126 //------------------------------------------------------------------------------
127 // Setup Operator
128 //------------------------------------------------------------------------------
129 static int CeedOperatorSetup_Blocked(CeedOperator op) {
130   bool is_setup_done;
131   CeedCallBackend(CeedOperatorIsSetupDone(op, &is_setup_done));
132   if (is_setup_done) return CEED_ERROR_SUCCESS;
133   Ceed ceed;
134   CeedCallBackend(CeedOperatorGetCeed(op, &ceed));
135   CeedOperator_Blocked *impl;
136   CeedCallBackend(CeedOperatorGetData(op, &impl));
137   CeedQFunction qf;
138   CeedCallBackend(CeedOperatorGetQFunction(op, &qf));
139   CeedInt Q, num_input_fields, num_output_fields;
140   CeedCallBackend(CeedOperatorGetNumQuadraturePoints(op, &Q));
141   CeedCallBackend(CeedQFunctionIsIdentity(qf, &impl->is_identity_qf));
142   CeedOperatorField *op_input_fields, *op_output_fields;
143   CeedCallBackend(CeedOperatorGetFields(op, &num_input_fields, &op_input_fields, &num_output_fields, &op_output_fields));
144   CeedQFunctionField *qf_input_fields, *qf_output_fields;
145   CeedCallBackend(CeedQFunctionGetFields(qf, NULL, &qf_input_fields, NULL, &qf_output_fields));
146 
147   // Allocate
148   CeedCallBackend(CeedCalloc(num_input_fields + num_output_fields, &impl->blk_restr));
149   CeedCallBackend(CeedCalloc(num_input_fields + num_output_fields, &impl->e_vecs_full));
150 
151   CeedCallBackend(CeedCalloc(CEED_FIELD_MAX, &impl->input_states));
152   CeedCallBackend(CeedCalloc(CEED_FIELD_MAX, &impl->e_vecs_in));
153   CeedCallBackend(CeedCalloc(CEED_FIELD_MAX, &impl->e_vecs_out));
154   CeedCallBackend(CeedCalloc(CEED_FIELD_MAX, &impl->q_vecs_in));
155   CeedCallBackend(CeedCalloc(CEED_FIELD_MAX, &impl->q_vecs_out));
156 
157   impl->num_inputs  = num_input_fields;
158   impl->num_outputs = num_output_fields;
159 
160   // Set up infield and outfield pointer arrays
161   // Infields
162   CeedCallBackend(
163       CeedOperatorSetupFields_Blocked(qf, op, true, impl->blk_restr, impl->e_vecs_full, impl->e_vecs_in, impl->q_vecs_in, 0, num_input_fields, Q));
164   // Outfields
165   CeedCallBackend(CeedOperatorSetupFields_Blocked(qf, op, false, impl->blk_restr, impl->e_vecs_full, impl->e_vecs_out, impl->q_vecs_out,
166                                                   num_input_fields, num_output_fields, Q));
167 
168   // Identity QFunctions
169   if (impl->is_identity_qf) {
170     CeedEvalMode        in_mode, out_mode;
171     CeedQFunctionField *in_fields, *out_fields;
172     CeedCallBackend(CeedQFunctionGetFields(qf, NULL, &in_fields, NULL, &out_fields));
173     CeedCallBackend(CeedQFunctionFieldGetEvalMode(in_fields[0], &in_mode));
174     CeedCallBackend(CeedQFunctionFieldGetEvalMode(out_fields[0], &out_mode));
175 
176     if (in_mode == CEED_EVAL_NONE && out_mode == CEED_EVAL_NONE) {
177       impl->is_identity_restr_op = true;
178     } else {
179       CeedCallBackend(CeedVectorReferenceCopy(impl->q_vecs_in[0], &impl->q_vecs_out[0]));
180     }
181   }
182 
183   CeedCallBackend(CeedOperatorSetSetupDone(op));
184 
185   return CEED_ERROR_SUCCESS;
186 }
187 
188 //------------------------------------------------------------------------------
189 // Setup Operator Inputs
190 //------------------------------------------------------------------------------
191 static inline int CeedOperatorSetupInputs_Blocked(CeedInt num_input_fields, CeedQFunctionField *qf_input_fields, CeedOperatorField *op_input_fields,
192                                                   CeedVector in_vec, bool skip_active, CeedScalar *e_data_full[2 * CEED_FIELD_MAX],
193                                                   CeedOperator_Blocked *impl, CeedRequest *request) {
194   CeedEvalMode eval_mode;
195   CeedVector   vec;
196   uint64_t     state;
197 
198   for (CeedInt i = 0; i < num_input_fields; i++) {
199     // Get input vector
200     CeedCallBackend(CeedOperatorFieldGetVector(op_input_fields[i], &vec));
201     if (vec == CEED_VECTOR_ACTIVE) {
202       if (skip_active) continue;
203       else vec = in_vec;
204     }
205 
206     CeedCallBackend(CeedQFunctionFieldGetEvalMode(qf_input_fields[i], &eval_mode));
207     if (eval_mode == CEED_EVAL_WEIGHT) {  // Skip
208     } else {
209       // Restrict
210       CeedCallBackend(CeedVectorGetState(vec, &state));
211       if (state != impl->input_states[i] || vec == in_vec) {
212         CeedCallBackend(CeedElemRestrictionApply(impl->blk_restr[i], CEED_NOTRANSPOSE, vec, impl->e_vecs_full[i], request));
213         impl->input_states[i] = state;
214       }
215       // Get evec
216       CeedCallBackend(CeedVectorGetArrayRead(impl->e_vecs_full[i], CEED_MEM_HOST, (const CeedScalar **)&e_data_full[i]));
217     }
218   }
219   return CEED_ERROR_SUCCESS;
220 }
221 
222 //------------------------------------------------------------------------------
223 // Input Basis Action
224 //------------------------------------------------------------------------------
225 static inline int CeedOperatorInputBasis_Blocked(CeedInt e, CeedInt Q, CeedQFunctionField *qf_input_fields, CeedOperatorField *op_input_fields,
226                                                  CeedInt num_input_fields, CeedInt blk_size, bool skip_active,
227                                                  CeedScalar *e_data_full[2 * CEED_FIELD_MAX], CeedOperator_Blocked *impl) {
228   CeedInt             elem_size, size, num_comp;
229   CeedElemRestriction elem_restr;
230   CeedEvalMode        eval_mode;
231   CeedBasis           basis;
232 
233   for (CeedInt i = 0; i < num_input_fields; i++) {
234     // Skip active input
235     if (skip_active) {
236       CeedVector vec;
237       CeedCallBackend(CeedOperatorFieldGetVector(op_input_fields[i], &vec));
238       if (vec == CEED_VECTOR_ACTIVE) continue;
239     }
240 
241     // Get elem_size, eval_mode, size
242     CeedCallBackend(CeedOperatorFieldGetElemRestriction(op_input_fields[i], &elem_restr));
243     CeedCallBackend(CeedElemRestrictionGetElementSize(elem_restr, &elem_size));
244     CeedCallBackend(CeedQFunctionFieldGetEvalMode(qf_input_fields[i], &eval_mode));
245     CeedCallBackend(CeedQFunctionFieldGetSize(qf_input_fields[i], &size));
246     // Basis action
247     switch (eval_mode) {
248       case CEED_EVAL_NONE:
249         CeedCallBackend(CeedVectorSetArray(impl->q_vecs_in[i], CEED_MEM_HOST, CEED_USE_POINTER, &e_data_full[i][e * Q * size]));
250         break;
251       case CEED_EVAL_INTERP:
252       case CEED_EVAL_GRAD:
253       case CEED_EVAL_DIV:
254       case CEED_EVAL_CURL:
255         CeedCallBackend(CeedOperatorFieldGetBasis(op_input_fields[i], &basis));
256         CeedCallBackend(CeedBasisGetNumComponents(basis, &num_comp));
257         CeedCallBackend(CeedVectorSetArray(impl->e_vecs_in[i], CEED_MEM_HOST, CEED_USE_POINTER, &e_data_full[i][e * elem_size * num_comp]));
258         CeedCallBackend(CeedBasisApply(basis, blk_size, CEED_NOTRANSPOSE, eval_mode, impl->e_vecs_in[i], impl->q_vecs_in[i]));
259         break;
260       case CEED_EVAL_WEIGHT:
261         break;  // No action
262     }
263   }
264   return CEED_ERROR_SUCCESS;
265 }
266 
267 //------------------------------------------------------------------------------
268 // Output Basis Action
269 //------------------------------------------------------------------------------
270 static inline int CeedOperatorOutputBasis_Blocked(CeedInt e, CeedInt Q, CeedQFunctionField *qf_output_fields, CeedOperatorField *op_output_fields,
271                                                   CeedInt blk_size, CeedInt num_input_fields, CeedInt num_output_fields, CeedOperator op,
272                                                   CeedScalar *e_data_full[2 * CEED_FIELD_MAX], CeedOperator_Blocked *impl) {
273   CeedInt             elem_size, num_comp;
274   CeedElemRestriction elem_restr;
275   CeedEvalMode        eval_mode;
276   CeedBasis           basis;
277 
278   for (CeedInt i = 0; i < num_output_fields; i++) {
279     // Get elem_size, eval_mode, size
280     CeedCallBackend(CeedOperatorFieldGetElemRestriction(op_output_fields[i], &elem_restr));
281     CeedCallBackend(CeedElemRestrictionGetElementSize(elem_restr, &elem_size));
282     CeedCallBackend(CeedQFunctionFieldGetEvalMode(qf_output_fields[i], &eval_mode));
283     // Basis action
284     switch (eval_mode) {
285       case CEED_EVAL_NONE:
286         break;  // No action
287       case CEED_EVAL_INTERP:
288       case CEED_EVAL_GRAD:
289       case CEED_EVAL_DIV:
290       case CEED_EVAL_CURL:
291         CeedCallBackend(CeedOperatorFieldGetBasis(op_output_fields[i], &basis));
292         CeedCallBackend(CeedBasisGetNumComponents(basis, &num_comp));
293         CeedCallBackend(
294             CeedVectorSetArray(impl->e_vecs_out[i], CEED_MEM_HOST, CEED_USE_POINTER, &e_data_full[i + num_input_fields][e * elem_size * num_comp]));
295         CeedCallBackend(CeedBasisApply(basis, blk_size, CEED_TRANSPOSE, eval_mode, impl->q_vecs_out[i], impl->e_vecs_out[i]));
296         break;
297       // LCOV_EXCL_START
298       case CEED_EVAL_WEIGHT: {
299         Ceed ceed;
300         CeedCallBackend(CeedOperatorGetCeed(op, &ceed));
301         return CeedError(ceed, CEED_ERROR_BACKEND, "CEED_EVAL_WEIGHT cannot be an output evaluation mode");
302         // LCOV_EXCL_STOP
303       }
304     }
305   }
306   return CEED_ERROR_SUCCESS;
307 }
308 
309 //------------------------------------------------------------------------------
310 // Restore Input Vectors
311 //------------------------------------------------------------------------------
312 static inline int CeedOperatorRestoreInputs_Blocked(CeedInt num_input_fields, CeedQFunctionField *qf_input_fields, CeedOperatorField *op_input_fields,
313                                                     bool skip_active, CeedScalar *e_data_full[2 * CEED_FIELD_MAX], CeedOperator_Blocked *impl) {
314   CeedEvalMode eval_mode;
315 
316   for (CeedInt i = 0; i < num_input_fields; i++) {
317     // Skip active inputs
318     if (skip_active) {
319       CeedVector vec;
320       CeedCallBackend(CeedOperatorFieldGetVector(op_input_fields[i], &vec));
321       if (vec == CEED_VECTOR_ACTIVE) continue;
322     }
323     CeedCallBackend(CeedQFunctionFieldGetEvalMode(qf_input_fields[i], &eval_mode));
324     if (eval_mode == CEED_EVAL_WEIGHT) {  // Skip
325     } else {
326       CeedCallBackend(CeedVectorRestoreArrayRead(impl->e_vecs_full[i], (const CeedScalar **)&e_data_full[i]));
327     }
328   }
329   return CEED_ERROR_SUCCESS;
330 }
331 
332 //------------------------------------------------------------------------------
333 // Operator Apply
334 //------------------------------------------------------------------------------
335 static int CeedOperatorApplyAdd_Blocked(CeedOperator op, CeedVector in_vec, CeedVector out_vec, CeedRequest *request) {
336   CeedOperator_Blocked *impl;
337   CeedCallBackend(CeedOperatorGetData(op, &impl));
338   const CeedInt blk_size = 8;
339   CeedInt       Q, num_input_fields, num_output_fields, num_elem, size;
340   CeedCallBackend(CeedOperatorGetNumElements(op, &num_elem));
341   CeedCallBackend(CeedOperatorGetNumQuadraturePoints(op, &Q));
342   CeedInt       num_blks = (num_elem / blk_size) + !!(num_elem % blk_size);
343   CeedQFunction qf;
344   CeedCallBackend(CeedOperatorGetQFunction(op, &qf));
345   CeedOperatorField *op_input_fields, *op_output_fields;
346   CeedCallBackend(CeedOperatorGetFields(op, &num_input_fields, &op_input_fields, &num_output_fields, &op_output_fields));
347   CeedQFunctionField *qf_input_fields, *qf_output_fields;
348   CeedCallBackend(CeedQFunctionGetFields(qf, NULL, &qf_input_fields, NULL, &qf_output_fields));
349   CeedEvalMode eval_mode;
350   CeedVector   vec;
351   CeedScalar  *e_data_full[2 * CEED_FIELD_MAX] = {0};
352 
353   // Setup
354   CeedCallBackend(CeedOperatorSetup_Blocked(op));
355 
356   // Restriction only operator
357   if (impl->is_identity_restr_op) {
358     CeedCallBackend(CeedElemRestrictionApply(impl->blk_restr[0], CEED_NOTRANSPOSE, in_vec, impl->e_vecs_full[0], request));
359     CeedCallBackend(CeedElemRestrictionApply(impl->blk_restr[1], CEED_TRANSPOSE, impl->e_vecs_full[0], out_vec, request));
360     return CEED_ERROR_SUCCESS;
361   }
362 
363   // Input Evecs and Restriction
364   CeedCallBackend(CeedOperatorSetupInputs_Blocked(num_input_fields, qf_input_fields, op_input_fields, in_vec, false, e_data_full, impl, request));
365 
366   // Output Evecs
367   for (CeedInt i = 0; i < num_output_fields; i++) {
368     CeedCallBackend(CeedVectorGetArrayWrite(impl->e_vecs_full[i + impl->num_inputs], CEED_MEM_HOST, &e_data_full[i + num_input_fields]));
369   }
370 
371   // Loop through elements
372   for (CeedInt e = 0; e < num_blks * blk_size; e += blk_size) {
373     // Output pointers
374     for (CeedInt i = 0; i < num_output_fields; i++) {
375       CeedCallBackend(CeedQFunctionFieldGetEvalMode(qf_output_fields[i], &eval_mode));
376       if (eval_mode == CEED_EVAL_NONE) {
377         CeedCallBackend(CeedQFunctionFieldGetSize(qf_output_fields[i], &size));
378         CeedCallBackend(CeedVectorSetArray(impl->q_vecs_out[i], CEED_MEM_HOST, CEED_USE_POINTER, &e_data_full[i + num_input_fields][e * Q * size]));
379       }
380     }
381 
382     // Input basis apply
383     CeedCallBackend(CeedOperatorInputBasis_Blocked(e, Q, qf_input_fields, op_input_fields, num_input_fields, blk_size, false, e_data_full, impl));
384 
385     // Q function
386     if (!impl->is_identity_qf) {
387       CeedCallBackend(CeedQFunctionApply(qf, Q * blk_size, impl->q_vecs_in, impl->q_vecs_out));
388     }
389 
390     // Output basis apply
391     CeedCallBackend(CeedOperatorOutputBasis_Blocked(e, Q, qf_output_fields, op_output_fields, blk_size, num_input_fields, num_output_fields, op,
392                                                     e_data_full, impl));
393   }
394 
395   // Output restriction
396   for (CeedInt i = 0; i < num_output_fields; i++) {
397     // Restore evec
398     CeedCallBackend(CeedVectorRestoreArray(impl->e_vecs_full[i + impl->num_inputs], &e_data_full[i + num_input_fields]));
399     // Get output vector
400     CeedCallBackend(CeedOperatorFieldGetVector(op_output_fields[i], &vec));
401     // Active
402     if (vec == CEED_VECTOR_ACTIVE) vec = out_vec;
403     // Restrict
404     CeedCallBackend(
405         CeedElemRestrictionApply(impl->blk_restr[i + impl->num_inputs], CEED_TRANSPOSE, impl->e_vecs_full[i + impl->num_inputs], vec, request));
406   }
407 
408   // Restore input arrays
409   CeedCallBackend(CeedOperatorRestoreInputs_Blocked(num_input_fields, qf_input_fields, op_input_fields, false, e_data_full, impl));
410 
411   return CEED_ERROR_SUCCESS;
412 }
413 
414 //------------------------------------------------------------------------------
415 // Core code for assembling linear QFunction
416 //------------------------------------------------------------------------------
417 static inline int CeedOperatorLinearAssembleQFunctionCore_Blocked(CeedOperator op, bool build_objects, CeedVector *assembled,
418                                                                   CeedElemRestriction *rstr, CeedRequest *request) {
419   CeedOperator_Blocked *impl;
420   CeedCallBackend(CeedOperatorGetData(op, &impl));
421   const CeedInt blk_size = 8;
422   CeedInt       Q, num_input_fields, num_output_fields, num_elem, size;
423   CeedCallBackend(CeedOperatorGetNumElements(op, &num_elem));
424   CeedCallBackend(CeedOperatorGetNumQuadraturePoints(op, &Q));
425   CeedInt       num_blks = (num_elem / blk_size) + !!(num_elem % blk_size);
426   CeedQFunction qf;
427   CeedCallBackend(CeedOperatorGetQFunction(op, &qf));
428   CeedOperatorField *op_input_fields, *op_output_fields;
429   CeedCallBackend(CeedOperatorGetFields(op, &num_input_fields, &op_input_fields, &num_output_fields, &op_output_fields));
430   CeedQFunctionField *qf_input_fields, *qf_output_fields;
431   CeedCallBackend(CeedQFunctionGetFields(qf, NULL, &qf_input_fields, NULL, &qf_output_fields));
432   CeedVector  vec, l_vec = impl->qf_l_vec;
433   CeedInt     num_active_in = impl->num_active_in, num_active_out = impl->num_active_out;
434   CeedSize    q_size;
435   CeedVector *active_in = impl->qf_active_in;
436   CeedScalar *a, *tmp;
437   Ceed        ceed;
438   CeedCallBackend(CeedOperatorGetCeed(op, &ceed));
439   CeedScalar *e_data_full[2 * CEED_FIELD_MAX] = {0};
440 
441   // Setup
442   CeedCallBackend(CeedOperatorSetup_Blocked(op));
443 
444   // Check for identity
445   CeedCheck(!impl->is_identity_qf, ceed, CEED_ERROR_BACKEND, "Assembling identity QFunctions not supported");
446 
447   // Input Evecs and Restriction
448   CeedCallBackend(CeedOperatorSetupInputs_Blocked(num_input_fields, qf_input_fields, op_input_fields, NULL, true, e_data_full, impl, request));
449 
450   // Count number of active input fields
451   if (!num_active_in) {
452     for (CeedInt i = 0; i < num_input_fields; i++) {
453       // Get input vector
454       CeedCallBackend(CeedOperatorFieldGetVector(op_input_fields[i], &vec));
455       // Check if active input
456       if (vec == CEED_VECTOR_ACTIVE) {
457         CeedCallBackend(CeedQFunctionFieldGetSize(qf_input_fields[i], &size));
458         CeedCallBackend(CeedVectorSetValue(impl->q_vecs_in[i], 0.0));
459         CeedCallBackend(CeedVectorGetArray(impl->q_vecs_in[i], CEED_MEM_HOST, &tmp));
460         CeedCallBackend(CeedRealloc(num_active_in + size, &active_in));
461         for (CeedInt field = 0; field < size; field++) {
462           q_size = (CeedSize)Q * blk_size;
463           CeedCallBackend(CeedVectorCreate(ceed, q_size, &active_in[num_active_in + field]));
464           CeedCallBackend(CeedVectorSetArray(active_in[num_active_in + field], CEED_MEM_HOST, CEED_USE_POINTER, &tmp[field * Q * blk_size]));
465         }
466         num_active_in += size;
467         CeedCallBackend(CeedVectorRestoreArray(impl->q_vecs_in[i], &tmp));
468       }
469     }
470     impl->num_active_in = num_active_in;
471     impl->qf_active_in  = active_in;
472   }
473 
474   // Count number of active output fields
475   if (!num_active_out) {
476     for (CeedInt i = 0; i < num_output_fields; i++) {
477       // Get output vector
478       CeedCallBackend(CeedOperatorFieldGetVector(op_output_fields[i], &vec));
479       // Check if active output
480       if (vec == CEED_VECTOR_ACTIVE) {
481         CeedCallBackend(CeedQFunctionFieldGetSize(qf_output_fields[i], &size));
482         num_active_out += size;
483       }
484     }
485     impl->num_active_out = num_active_out;
486   }
487 
488   // Check sizes
489   CeedCheck(num_active_in > 0 && num_active_out > 0, ceed, CEED_ERROR_BACKEND, "Cannot assemble QFunction without active inputs and outputs");
490 
491   // Setup Lvec
492   if (!l_vec) {
493     CeedSize l_size = (CeedSize)num_blks * blk_size * Q * num_active_in * num_active_out;
494     CeedCallBackend(CeedVectorCreate(ceed, l_size, &l_vec));
495     impl->qf_l_vec = l_vec;
496   }
497   CeedCallBackend(CeedVectorGetArrayWrite(l_vec, CEED_MEM_HOST, &a));
498 
499   // Build objects if needed
500   CeedInt strides[3] = {1, Q, num_active_in * num_active_out * Q};
501   if (build_objects) {
502     // Create output restriction
503     CeedCallBackend(CeedElemRestrictionCreateStrided(ceed, num_elem, Q, num_active_in * num_active_out, num_active_in * num_active_out * num_elem * Q,
504                                                      strides, rstr));
505     // Create assembled vector
506     CeedSize l_size = (CeedSize)num_elem * Q * num_active_in * num_active_out;
507     CeedCallBackend(CeedVectorCreate(ceed, l_size, assembled));
508   }
509 
510   // Loop through elements
511   for (CeedInt e = 0; e < num_blks * blk_size; e += blk_size) {
512     // Input basis apply
513     CeedCallBackend(CeedOperatorInputBasis_Blocked(e, Q, qf_input_fields, op_input_fields, num_input_fields, blk_size, true, e_data_full, impl));
514 
515     // Assemble QFunction
516     for (CeedInt in = 0; in < num_active_in; in++) {
517       // Set Inputs
518       CeedCallBackend(CeedVectorSetValue(active_in[in], 1.0));
519       if (num_active_in > 1) {
520         CeedCallBackend(CeedVectorSetValue(active_in[(in + num_active_in - 1) % num_active_in], 0.0));
521       }
522       // Set Outputs
523       for (CeedInt out = 0; out < num_output_fields; out++) {
524         // Get output vector
525         CeedCallBackend(CeedOperatorFieldGetVector(op_output_fields[out], &vec));
526         // Check if active output
527         if (vec == CEED_VECTOR_ACTIVE) {
528           CeedCallBackend(CeedVectorSetArray(impl->q_vecs_out[out], CEED_MEM_HOST, CEED_USE_POINTER, a));
529           CeedCallBackend(CeedQFunctionFieldGetSize(qf_output_fields[out], &size));
530           a += size * Q * blk_size;  // Advance the pointer by the size of the output
531         }
532       }
533       // Apply QFunction
534       CeedCallBackend(CeedQFunctionApply(qf, Q * blk_size, impl->q_vecs_in, impl->q_vecs_out));
535     }
536   }
537 
538   // Un-set output Qvecs to prevent accidental overwrite of Assembled
539   for (CeedInt out = 0; out < num_output_fields; out++) {
540     // Get output vector
541     CeedCallBackend(CeedOperatorFieldGetVector(op_output_fields[out], &vec));
542     // Check if active output
543     if (vec == CEED_VECTOR_ACTIVE) {
544       CeedCallBackend(CeedVectorSetArray(impl->q_vecs_out[out], CEED_MEM_HOST, CEED_COPY_VALUES, NULL));
545     }
546   }
547 
548   // Restore input arrays
549   CeedCallBackend(CeedOperatorRestoreInputs_Blocked(num_input_fields, qf_input_fields, op_input_fields, true, e_data_full, impl));
550 
551   // Output blocked restriction
552   CeedCallBackend(CeedVectorRestoreArray(l_vec, &a));
553   CeedCallBackend(CeedVectorSetValue(*assembled, 0.0));
554   CeedElemRestriction blk_rstr = impl->qf_blk_rstr;
555   if (!impl->qf_blk_rstr) {
556     CeedCallBackend(CeedElemRestrictionCreateBlockedStrided(ceed, num_elem, Q, blk_size, num_active_in * num_active_out,
557                                                             num_active_in * num_active_out * num_elem * Q, strides, &blk_rstr));
558     impl->qf_blk_rstr = blk_rstr;
559   }
560   CeedCallBackend(CeedElemRestrictionApply(blk_rstr, CEED_TRANSPOSE, l_vec, *assembled, request));
561 
562   return CEED_ERROR_SUCCESS;
563 }
564 
565 //------------------------------------------------------------------------------
566 // Assemble Linear QFunction
567 //------------------------------------------------------------------------------
568 static int CeedOperatorLinearAssembleQFunction_Blocked(CeedOperator op, CeedVector *assembled, CeedElemRestriction *rstr, CeedRequest *request) {
569   return CeedOperatorLinearAssembleQFunctionCore_Blocked(op, true, assembled, rstr, request);
570 }
571 
572 //------------------------------------------------------------------------------
573 // Update Assembled Linear QFunction
574 //------------------------------------------------------------------------------
575 static int CeedOperatorLinearAssembleQFunctionUpdate_Blocked(CeedOperator op, CeedVector assembled, CeedElemRestriction rstr, CeedRequest *request) {
576   return CeedOperatorLinearAssembleQFunctionCore_Blocked(op, false, &assembled, &rstr, request);
577 }
578 
579 //------------------------------------------------------------------------------
580 // Operator Destroy
581 //------------------------------------------------------------------------------
582 static int CeedOperatorDestroy_Blocked(CeedOperator op) {
583   CeedOperator_Blocked *impl;
584   CeedCallBackend(CeedOperatorGetData(op, &impl));
585 
586   for (CeedInt i = 0; i < impl->num_inputs + impl->num_outputs; i++) {
587     CeedCallBackend(CeedElemRestrictionDestroy(&impl->blk_restr[i]));
588     CeedCallBackend(CeedVectorDestroy(&impl->e_vecs_full[i]));
589   }
590   CeedCallBackend(CeedFree(&impl->blk_restr));
591   CeedCallBackend(CeedFree(&impl->e_vecs_full));
592   CeedCallBackend(CeedFree(&impl->input_states));
593 
594   for (CeedInt i = 0; i < impl->num_inputs; i++) {
595     CeedCallBackend(CeedVectorDestroy(&impl->e_vecs_in[i]));
596     CeedCallBackend(CeedVectorDestroy(&impl->q_vecs_in[i]));
597   }
598   CeedCallBackend(CeedFree(&impl->e_vecs_in));
599   CeedCallBackend(CeedFree(&impl->q_vecs_in));
600 
601   for (CeedInt i = 0; i < impl->num_outputs; i++) {
602     CeedCallBackend(CeedVectorDestroy(&impl->e_vecs_out[i]));
603     CeedCallBackend(CeedVectorDestroy(&impl->q_vecs_out[i]));
604   }
605   CeedCallBackend(CeedFree(&impl->e_vecs_out));
606   CeedCallBackend(CeedFree(&impl->q_vecs_out));
607 
608   // QFunction assembly data
609   for (CeedInt i = 0; i < impl->num_active_in; i++) {
610     CeedCallBackend(CeedVectorDestroy(&impl->qf_active_in[i]));
611   }
612   CeedCallBackend(CeedFree(&impl->qf_active_in));
613   CeedCallBackend(CeedVectorDestroy(&impl->qf_l_vec));
614   CeedCallBackend(CeedElemRestrictionDestroy(&impl->qf_blk_rstr));
615 
616   CeedCallBackend(CeedFree(&impl));
617   return CEED_ERROR_SUCCESS;
618 }
619 
620 //------------------------------------------------------------------------------
621 // Operator Create
622 //------------------------------------------------------------------------------
623 int CeedOperatorCreate_Blocked(CeedOperator op) {
624   Ceed ceed;
625   CeedCallBackend(CeedOperatorGetCeed(op, &ceed));
626   CeedOperator_Blocked *impl;
627 
628   CeedCallBackend(CeedCalloc(1, &impl));
629   CeedCallBackend(CeedOperatorSetData(op, impl));
630 
631   CeedCallBackend(CeedSetBackendFunction(ceed, "Operator", op, "LinearAssembleQFunction", CeedOperatorLinearAssembleQFunction_Blocked));
632   CeedCallBackend(CeedSetBackendFunction(ceed, "Operator", op, "LinearAssembleQFunctionUpdate", CeedOperatorLinearAssembleQFunctionUpdate_Blocked));
633   CeedCallBackend(CeedSetBackendFunction(ceed, "Operator", op, "ApplyAdd", CeedOperatorApplyAdd_Blocked));
634   CeedCallBackend(CeedSetBackendFunction(ceed, "Operator", op, "Destroy", CeedOperatorDestroy_Blocked));
635   return CEED_ERROR_SUCCESS;
636 }
637 
638 //------------------------------------------------------------------------------
639