/[escript]/branches/diaplayground/ripley/src/Brick.cpp
ViewVC logotype

Diff of /branches/diaplayground/ripley/src/Brick.cpp

Parent Directory Parent Directory | Revision Log Revision Log | View Patch Patch

branches/ripleygmg_from_3668/ripley/src/Brick.cpp revision 3753 by caltinay, Tue Jan 3 09:01:49 2012 UTC trunk/ripley/src/Brick.cpp revision 4277 by caltinay, Wed Mar 6 01:30:41 2013 UTC
# Line 1  Line 1 
1    
2  /*******************************************************  /*****************************************************************************
3  *  *
4  * Copyright (c) 2003-2011 by University of Queensland  * Copyright (c) 2003-2013 by University of Queensland
5  * Earth Systems Science Computational Center (ESSCC)  * http://www.uq.edu.au
 * http://www.uq.edu.au/esscc  
6  *  *
7  * Primary Business: Queensland, Australia  * Primary Business: Queensland, Australia
8  * Licensed under the Open Software License version 3.0  * Licensed under the Open Software License version 3.0
9  * http://www.opensource.org/licenses/osl-3.0.php  * http://www.opensource.org/licenses/osl-3.0.php
10  *  *
11  *******************************************************/  * Development until 2012 by Earth Systems Science Computational Center (ESSCC)
12    * Development since 2012 by School of Earth Sciences
13    *
14    *****************************************************************************/
15    
16  #include <ripley/Brick.h>  #include <ripley/Brick.h>
17  extern "C" {  extern "C" {
18  #include "paso/SystemMatrixPattern.h"  #include <paso/SystemMatrix.h>
19  }  }
20    
21    #ifdef USE_NETCDF
22    #include <netcdfcpp.h>
23    #endif
24    
25  #if USE_SILO  #if USE_SILO
26  #include <silo.h>  #include <silo.h>
27  #ifdef ESYS_MPI  #ifdef ESYS_MPI
# Line 29  using namespace std; Line 35  using namespace std;
35    
36  namespace ripley {  namespace ripley {
37    
38  Brick::Brick(int n0, int n1, int n2, double l0, double l1, double l2, int d0,  Brick::Brick(int n0, int n1, int n2, double x0, double y0, double z0,
39               int d1, int d2) :               double x1, double y1, double z1, int d0, int d1, int d2) :
40      RipleyDomain(3),      RipleyDomain(3),
41      m_gNE0(n0),      m_x0(x0),
42      m_gNE1(n1),      m_y0(y0),
43      m_gNE2(n2),      m_z0(z0),
44      m_l0(l0),      m_l0(x1-x0),
45      m_l1(l1),      m_l1(y1-y0),
46      m_l2(l2),      m_l2(z1-z0)
     m_NX(d0),  
     m_NY(d1),  
     m_NZ(d2)  
47  {  {
48        // ignore subdivision parameters for serial run
49        if (m_mpiInfo->size == 1) {
50            d0=1;
51            d1=1;
52            d2=1;
53        }
54    
55        bool warn=false;
56        // if number of subdivisions is non-positive, try to subdivide by the same
57        // ratio as the number of elements
58        if (d0<=0 && d1<=0 && d2<=0) {
59            warn=true;
60            d0=(int)(pow(m_mpiInfo->size*(n0+1)*(n0+1)/((float)(n1+1)*(n2+1)), 1.f/3));
61            d0=max(1, d0);
62            d1=max(1, (int)(d0*n1/(float)n0));
63            d2=m_mpiInfo->size/(d0*d1);
64            if (d0*d1*d2 != m_mpiInfo->size) {
65                // ratios not the same so leave "smallest" side undivided and try
66                // dividing 2 sides only
67                if (n0>=n1) {
68                    if (n1>=n2) {
69                        d0=d1=0;
70                        d2=1;
71                    } else {
72                        d0=d2=0;
73                        d1=1;
74                    }
75                } else {
76                    if (n0>=n2) {
77                        d0=d1=0;
78                        d2=1;
79                    } else {
80                        d0=1;
81                        d1=d2=0;
82                    }
83                }
84            }
85        }
86        if (d0<=0 && d1<=0) {
87            warn=true;
88            d0=max(1, int(sqrt(m_mpiInfo->size*(n0+1)/(float)(n1+1))));
89            d1=m_mpiInfo->size/d0;
90            if (d0*d1*d2 != m_mpiInfo->size) {
91                // ratios not the same so subdivide side with more elements only
92                if (n0>n1) {
93                    d0=0;
94                    d1=1;
95                } else {
96                    d0=1;
97                    d1=0;
98                }
99            }
100        } else if (d0<=0 && d2<=0) {
101            warn=true;
102            d0=max(1, int(sqrt(m_mpiInfo->size*(n0+1)/(float)(n2+1))));
103            d2=m_mpiInfo->size/d0;
104            if (d0*d1*d2 != m_mpiInfo->size) {
105                // ratios not the same so subdivide side with more elements only
106                if (n0>n2) {
107                    d0=0;
108                    d2=1;
109                } else {
110                    d0=1;
111                    d2=0;
112                }
113            }
114        } else if (d1<=0 && d2<=0) {
115            warn=true;
116            d1=max(1, int(sqrt(m_mpiInfo->size*(n1+1)/(float)(n2+1))));
117            d2=m_mpiInfo->size/d1;
118            if (d0*d1*d2 != m_mpiInfo->size) {
119                // ratios not the same so subdivide side with more elements only
120                if (n1>n2) {
121                    d1=0;
122                    d2=1;
123                } else {
124                    d1=1;
125                    d2=0;
126                }
127            }
128        }
129        if (d0<=0) {
130            // d1,d2 are preset, determine d0
131            d0=m_mpiInfo->size/(d1*d2);
132        } else if (d1<=0) {
133            // d0,d2 are preset, determine d1
134            d1=m_mpiInfo->size/(d0*d2);
135        } else if (d2<=0) {
136            // d0,d1 are preset, determine d2
137            d2=m_mpiInfo->size/(d0*d1);
138        }
139    
140        m_NX=d0;
141        m_NY=d1;
142        m_NZ=d2;
143    
144      // ensure number of subdivisions is valid and nodes can be distributed      // ensure number of subdivisions is valid and nodes can be distributed
145      // among number of ranks      // among number of ranks
146      if (m_NX*m_NY*m_NZ != m_mpiInfo->size)      if (m_NX*m_NY*m_NZ != m_mpiInfo->size)
147          throw RipleyException("Invalid number of spatial subdivisions");          throw RipleyException("Invalid number of spatial subdivisions");
148    
149      if ((n0+1)%m_NX > 0 || (n1+1)%m_NY > 0 || (n2+1)%m_NZ > 0)      if (warn) {
150          throw RipleyException("Number of elements+1 must be separable into number of ranks in each dimension");          cout << "Warning: Automatic domain subdivision (d0=" << d0 << ", d1="
151                << d1 << ", d2=" << d2 << "). This may not be optimal!" << endl;
152        }
153    
154        if ((n0+1)%m_NX > 0) {
155            double Dx=m_l0/n0;
156            n0=(int)round((float)(n0+1)/d0+0.5)*d0-1;
157            m_l0=Dx*n0;
158            cout << "Warning: Adjusted number of elements and length. N0="
159                << n0 << ", l0=" << m_l0 << endl;
160        }
161        if ((n1+1)%m_NY > 0) {
162            double Dy=m_l1/n1;
163            n1=(int)round((float)(n1+1)/d1+0.5)*d1-1;
164            m_l1=Dy*n1;
165            cout << "Warning: Adjusted number of elements and length. N1="
166                << n1 << ", l1=" << m_l1 << endl;
167        }
168        if ((n2+1)%m_NZ > 0) {
169            double Dz=m_l2/n2;
170            n2=(int)round((float)(n2+1)/d2+0.5)*d2-1;
171            m_l2=Dz*n2;
172            cout << "Warning: Adjusted number of elements and length. N2="
173                << n2 << ", l2=" << m_l2 << endl;
174        }
175    
176        m_gNE0=n0;
177        m_gNE1=n1;
178        m_gNE2=n2;
179    
180      if ((m_NX > 1 && (n0+1)/m_NX<2) || (m_NY > 1 && (n1+1)/m_NY<2) || (m_NZ > 1 && (n2+1)/m_NZ<2))      if ((m_NX > 1 && (n0+1)/m_NX<2) || (m_NY > 1 && (n1+1)/m_NY<2) || (m_NZ > 1 && (n2+1)/m_NZ<2))
181          throw RipleyException("Too few elements for the number of ranks");          throw RipleyException("Too few elements for the number of ranks");
182    
183      // local number of elements (including overlap)      // local number of elements (including overlap)
184      m_NE0 = (m_NX>1 ? (n0+1)/m_NX : n0);      m_NE0 = m_ownNE0 = (m_NX>1 ? (n0+1)/m_NX : n0);
185      if (m_mpiInfo->rank%m_NX>0 && m_mpiInfo->rank%m_NX<m_NX-1)      if (m_mpiInfo->rank%m_NX>0 && m_mpiInfo->rank%m_NX<m_NX-1)
186          m_NE0++;          m_NE0++;
187      m_NE1 = (m_NY>1 ? (n1+1)/m_NY : n1);      else if (m_NX>1 && m_mpiInfo->rank%m_NX==m_NX-1)
188            m_ownNE0--;
189    
190        m_NE1 = m_ownNE1 = (m_NY>1 ? (n1+1)/m_NY : n1);
191      if (m_mpiInfo->rank%(m_NX*m_NY)/m_NX>0 && m_mpiInfo->rank%(m_NX*m_NY)/m_NX<m_NY-1)      if (m_mpiInfo->rank%(m_NX*m_NY)/m_NX>0 && m_mpiInfo->rank%(m_NX*m_NY)/m_NX<m_NY-1)
192          m_NE1++;          m_NE1++;
193      m_NE2 = (m_NZ>1 ? (n2+1)/m_NZ : n2);      else if (m_NY>1 && m_mpiInfo->rank%(m_NX*m_NY)/m_NX==m_NY-1)
194            m_ownNE1--;
195    
196        m_NE2 = m_ownNE2 = (m_NZ>1 ? (n2+1)/m_NZ : n2);
197      if (m_mpiInfo->rank/(m_NX*m_NY)>0 && m_mpiInfo->rank/(m_NX*m_NY)<m_NZ-1)      if (m_mpiInfo->rank/(m_NX*m_NY)>0 && m_mpiInfo->rank/(m_NX*m_NY)<m_NZ-1)
198          m_NE2++;          m_NE2++;
199        else if (m_NZ>1 && m_mpiInfo->rank/(m_NX*m_NY)==m_NZ-1)
200            m_ownNE2--;
201    
202      // local number of nodes      // local number of nodes
203      m_N0 = m_NE0+1;      m_N0 = m_NE0+1;
# Line 81  Brick::Brick(int n0, int n1, int n2, dou Line 216  Brick::Brick(int n0, int n1, int n2, dou
216          m_offset2--;          m_offset2--;
217    
218      populateSampleIds();      populateSampleIds();
219        createPattern();
220  }  }
221    
222    
223  Brick::~Brick()  Brick::~Brick()
224  {  {
225        Paso_SystemMatrixPattern_free(m_pattern);
226        Paso_Connector_free(m_connector);
227  }  }
228    
229  string Brick::getDescription() const  string Brick::getDescription() const
# Line 99  bool Brick::operator==(const AbstractDom Line 237  bool Brick::operator==(const AbstractDom
237      if (o) {      if (o) {
238          return (RipleyDomain::operator==(other) &&          return (RipleyDomain::operator==(other) &&
239                  m_gNE0==o->m_gNE0 && m_gNE1==o->m_gNE1 && m_gNE2==o->m_gNE2                  m_gNE0==o->m_gNE0 && m_gNE1==o->m_gNE1 && m_gNE2==o->m_gNE2
240                    && m_x0==o->m_x0 && m_y0==o->m_y0 && m_z0==o->m_z0
241                  && m_l0==o->m_l0 && m_l1==o->m_l1 && m_l2==o->m_l2                  && m_l0==o->m_l0 && m_l1==o->m_l1 && m_l2==o->m_l2
242                  && m_NX==o->m_NX && m_NY==o->m_NY && m_NZ==o->m_NZ);                  && m_NX==o->m_NX && m_NY==o->m_NY && m_NZ==o->m_NZ);
243      }      }
# Line 106  bool Brick::operator==(const AbstractDom Line 245  bool Brick::operator==(const AbstractDom
245      return false;      return false;
246  }  }
247    
248    void Brick::readBinaryGrid(escript::Data& out, string filename,
249                               const vector<int>& first,
250                               const vector<int>& numValues,
251                               const vector<int>& multiplier) const
252    {
253        // check destination function space
254        int myN0, myN1, myN2;
255        if (out.getFunctionSpace().getTypeCode() == Nodes) {
256            myN0 = m_N0;
257            myN1 = m_N1;
258            myN2 = m_N2;
259        } else if (out.getFunctionSpace().getTypeCode() == Elements ||
260                    out.getFunctionSpace().getTypeCode() == ReducedElements) {
261            myN0 = m_NE0;
262            myN1 = m_NE1;
263            myN2 = m_NE2;
264        } else
265            throw RipleyException("readBinaryGrid(): invalid function space for output data object");
266    
267        if (first.size() != 3)
268            throw RipleyException("readBinaryGrid(): argument 'first' must have 3 entries");
269    
270        if (numValues.size() != 3)
271            throw RipleyException("readBinaryGrid(): argument 'numValues' must have 3 entries");
272    
273        if (multiplier.size() != 3)
274            throw RipleyException("readBinaryGrid(): argument 'multiplier' must have 3 entries");
275        for (size_t i=0; i<multiplier.size(); i++)
276            if (multiplier[i]<1)
277                throw RipleyException("readBinaryGrid(): all multipliers must be positive");
278    
279        // check file existence and size
280        ifstream f(filename.c_str(), ifstream::binary);
281        if (f.fail()) {
282            throw RipleyException("readBinaryGrid(): cannot open file");
283        }
284        f.seekg(0, ios::end);
285        const int numComp = out.getDataPointSize();
286        const int filesize = f.tellg();
287        const int reqsize = numValues[0]*numValues[1]*numValues[2]*numComp*sizeof(float);
288        if (filesize < reqsize) {
289            f.close();
290            throw RipleyException("readBinaryGrid(): not enough data in file");
291        }
292    
293        // check if this rank contributes anything
294        if (first[0] >= m_offset0+myN0 || first[0]+numValues[0]*multiplier[0] <= m_offset0 ||
295                first[1] >= m_offset1+myN1 || first[1]+numValues[1]*multiplier[1] <= m_offset1 ||
296                first[2] >= m_offset2+myN2 || first[2]+numValues[2]*multiplier[2] <= m_offset2) {
297            f.close();
298            return;
299        }
300    
301        // now determine how much this rank has to write
302    
303        // first coordinates in data object to write to
304        const int first0 = max(0, first[0]-m_offset0);
305        const int first1 = max(0, first[1]-m_offset1);
306        const int first2 = max(0, first[2]-m_offset2);
307        // indices to first value in file
308        const int idx0 = max(0, m_offset0-first[0]);
309        const int idx1 = max(0, m_offset1-first[1]);
310        const int idx2 = max(0, m_offset2-first[2]);
311        // number of values to read
312        const int num0 = min(numValues[0]-idx0, myN0-first0);
313        const int num1 = min(numValues[1]-idx1, myN1-first1);
314        const int num2 = min(numValues[2]-idx2, myN2-first2);
315    
316        out.requireWrite();
317        vector<float> values(num0*numComp);
318        const int dpp = out.getNumDataPointsPerSample();
319    
320        for (index_t z=0; z<num2; z++) {
321            for (index_t y=0; y<num1; y++) {
322                const int fileofs = numComp*(idx0+(idx1+y)*numValues[0]+(idx2+z)*numValues[0]*numValues[1]);
323                f.seekg(fileofs*sizeof(float));
324                f.read((char*)&values[0], num0*numComp*sizeof(float));
325    
326                for (index_t x=0; x<num0; x++) {
327                    const int baseIndex = first0+x*multiplier[0]
328                                            +(first1+y*multiplier[1])*myN0
329                                            +(first2+z*multiplier[2])*myN0*myN1;
330                    for (index_t m2=0; m2<multiplier[2]; m2++) {
331                        for (index_t m1=0; m1<multiplier[1]; m1++) {
332                            for (index_t m0=0; m0<multiplier[0]; m0++) {
333                                const int dataIndex = baseIndex+m0
334                                               +m1*myN0
335                                               +m2*myN0*myN1;
336                                double* dest = out.getSampleDataRW(dataIndex);
337                                for (index_t c=0; c<numComp; c++) {
338                                    if (!isnan(values[x*numComp+c])) {
339                                        for (index_t q=0; q<dpp; q++) {
340                                            *dest++ = static_cast<double>(values[x*numComp+c]);
341                                        }
342                                    }
343                                }
344                            }
345                        }
346                    }
347                }
348            }
349        }
350    
351        f.close();
352    }
353    
354    void Brick::readNcGrid(escript::Data& out, string filename, string varname,
355                const vector<int>& first, const vector<int>& numValues,
356                const vector<int>& multiplier) const
357    {
358    #ifdef USE_NETCDF
359        // check destination function space
360        int myN0, myN1, myN2;
361        if (out.getFunctionSpace().getTypeCode() == Nodes) {
362            myN0 = m_N0;
363            myN1 = m_N1;
364            myN2 = m_N2;
365        } else if (out.getFunctionSpace().getTypeCode() == Elements ||
366                    out.getFunctionSpace().getTypeCode() == ReducedElements) {
367            myN0 = m_NE0;
368            myN1 = m_NE1;
369            myN2 = m_NE2;
370        } else
371            throw RipleyException("readNcGrid(): invalid function space for output data object");
372    
373        if (first.size() != 3)
374            throw RipleyException("readNcGrid(): argument 'first' must have 3 entries");
375    
376        if (numValues.size() != 3)
377            throw RipleyException("readNcGrid(): argument 'numValues' must have 3 entries");
378    
379        if (multiplier.size() != 3)
380            throw RipleyException("readNcGrid(): argument 'multiplier' must have 3 entries");
381        for (size_t i=0; i<multiplier.size(); i++)
382            if (multiplier[i]<1)
383                throw RipleyException("readNcGrid(): all multipliers must be positive");
384    
385        // check file existence and size
386        NcFile f(filename.c_str(), NcFile::ReadOnly);
387        if (!f.is_valid())
388            throw RipleyException("readNcGrid(): cannot open file");
389    
390        NcVar* var = f.get_var(varname.c_str());
391        if (!var)
392            throw RipleyException("readNcGrid(): invalid variable name");
393    
394        // TODO: rank>0 data support
395        const int numComp = out.getDataPointSize();
396        if (numComp > 1)
397            throw RipleyException("readNcGrid(): only scalar data supported");
398    
399        const int dims = var->num_dims();
400        const long *edges = var->edges();
401    
402        // is this a slice of the data object (dims!=3)?
403        // note the expected ordering of edges (as in numpy: z,y,x)
404        if ( (dims==3 && (numValues[2] > edges[0] || numValues[1] > edges[1]
405                          || numValues[0] > edges[2]))
406                || (dims==2 && numValues[2]>1)
407                || (dims==1 && (numValues[2]>1 || numValues[1]>1)) ) {
408            throw RipleyException("readNcGrid(): not enough data in file");
409        }
410    
411        // check if this rank contributes anything
412        if (first[0] >= m_offset0+myN0 || first[0]+numValues[0]*multiplier[0] <= m_offset0 ||
413                first[1] >= m_offset1+myN1 || first[1]+numValues[1]*multiplier[1] <= m_offset1 ||
414                first[2] >= m_offset2+myN2 || first[2]+numValues[2]*multiplier[2] <= m_offset2) {
415            return;
416        }
417    
418        // now determine how much this rank has to write
419    
420        // first coordinates in data object to write to
421        const int first0 = max(0, first[0]-m_offset0);
422        const int first1 = max(0, first[1]-m_offset1);
423        const int first2 = max(0, first[2]-m_offset2);
424        // indices to first value in file
425        const int idx0 = max(0, m_offset0-first[0]);
426        const int idx1 = max(0, m_offset1-first[1]);
427        const int idx2 = max(0, m_offset2-first[2]);
428        // number of values to read
429        const int num0 = min(numValues[0]-idx0, myN0-first0);
430        const int num1 = min(numValues[1]-idx1, myN1-first1);
431        const int num2 = min(numValues[2]-idx2, myN2-first2);
432    
433        vector<double> values(num0*num1*num2);
434        if (dims==3) {
435            var->set_cur(idx2, idx1, idx0);
436            var->get(&values[0], num2, num1, num0);
437        } else if (dims==2) {
438            var->set_cur(idx1, idx0);
439            var->get(&values[0], num1, num0);
440        } else {
441            var->set_cur(idx0);
442            var->get(&values[0], num0);
443        }
444    
445        const int dpp = out.getNumDataPointsPerSample();
446        out.requireWrite();
447    
448        for (index_t z=0; z<num2; z++) {
449            for (index_t y=0; y<num1; y++) {
450    #pragma omp parallel for
451                for (index_t x=0; x<num0; x++) {
452                    const int baseIndex = first0+x*multiplier[0]
453                                            +(first1+y*multiplier[1])*myN0
454                                            +(first2+z*multiplier[2])*myN0*myN1;
455                    const int srcIndex=z*num1*num0+y*num0+x;
456                    if (!isnan(values[srcIndex])) {
457                        for (index_t m2=0; m2<multiplier[2]; m2++) {
458                            for (index_t m1=0; m1<multiplier[1]; m1++) {
459                                for (index_t m0=0; m0<multiplier[0]; m0++) {
460                                    const int dataIndex = baseIndex+m0
461                                                   +m1*myN0
462                                                   +m2*myN0*myN1;
463                                    double* dest = out.getSampleDataRW(dataIndex);
464                                    for (index_t q=0; q<dpp; q++) {
465                                        *dest++ = values[srcIndex];
466                                    }
467                                }
468                            }
469                        }
470                    }
471                }
472            }
473        }
474    #else
475        throw RipleyException("readNcGrid(): not compiled with netCDF support");
476    #endif
477    }
478    
479  void Brick::dump(const string& fileName) const  void Brick::dump(const string& fileName) const
480  {  {
481  #if USE_SILO  #if USE_SILO
# Line 114  void Brick::dump(const string& fileName) Line 484  void Brick::dump(const string& fileName)
484          fn+=".silo";          fn+=".silo";
485      }      }
486    
     const int NUM_SILO_FILES = 1;  
     const char* blockDirFmt = "/block%04d";  
487      int driver=DB_HDF5;          int driver=DB_HDF5;    
488      string siloPath;      string siloPath;
489      DBfile* dbfile = NULL;      DBfile* dbfile = NULL;
490    
491  #ifdef ESYS_MPI  #ifdef ESYS_MPI
492      PMPIO_baton_t* baton = NULL;      PMPIO_baton_t* baton = NULL;
493        const int NUM_SILO_FILES = 1;
494        const char* blockDirFmt = "/block%04d";
495  #endif  #endif
496    
497      if (m_mpiInfo->size > 1) {      if (m_mpiInfo->size > 1) {
# Line 247  void Brick::dump(const string& fileName) Line 617  void Brick::dump(const string& fileName)
617      }      }
618    
619  #else // USE_SILO  #else // USE_SILO
620      throw RipleyException("dump(): no Silo support");      throw RipleyException("dump: no Silo support");
621  #endif  #endif
622  }  }
623    
# Line 257  const int* Brick::borrowSampleReferenceI Line 627  const int* Brick::borrowSampleReferenceI
627          case Nodes:          case Nodes:
628          case ReducedNodes: //FIXME: reduced          case ReducedNodes: //FIXME: reduced
629              return &m_nodeId[0];              return &m_nodeId[0];
630          case DegreesOfFreedom: //FIXME          case DegreesOfFreedom:
631          case ReducedDegreesOfFreedom: //FIXME          case ReducedDegreesOfFreedom: //FIXME: reduced
632              return &m_dofId[0];              return &m_dofId[0];
633          case Elements:          case Elements:
634          case ReducedElements:          case ReducedElements:
635              return &m_elementId[0];              return &m_elementId[0];
636            case FaceElements:
637          case ReducedFaceElements:          case ReducedFaceElements:
638              return &m_faceId[0];              return &m_faceId[0];
639          default:          default:
# Line 270  const int* Brick::borrowSampleReferenceI Line 641  const int* Brick::borrowSampleReferenceI
641      }      }
642    
643      stringstream msg;      stringstream msg;
644      msg << "borrowSampleReferenceIDs() not implemented for function space type "      msg << "borrowSampleReferenceIDs: invalid function space type "<<fsType;
         << fsType;  
645      throw RipleyException(msg.str());      throw RipleyException(msg.str());
646  }  }
647    
648  bool Brick::ownSample(int fsCode, index_t id) const  bool Brick::ownSample(int fsType, index_t id) const
649  {  {
650  #ifdef ESYS_MPI      if (getMPISize()==1)
651      if (fsCode == Nodes) {          return true;
652          const index_t left = (m_offset0==0 ? 0 : 1);  
653          const index_t bottom = (m_offset1==0 ? 0 : 1);      switch (fsType) {
654          const index_t front = (m_offset2==0 ? 0 : 1);          case Nodes:
655          const index_t right = (m_mpiInfo->rank%m_NX==m_NX-1 ? m_N0 : m_N0-1);          case ReducedNodes: //FIXME: reduced
656          const index_t top = (m_mpiInfo->rank%(m_NX*m_NY)/m_NX==m_NY-1 ? m_N1 : m_N1-1);              return (m_dofMap[id] < getNumDOF());
657          const index_t back = (m_mpiInfo->rank/(m_NX*m_NY)==m_NZ-1 ? m_N2 : m_N2-1);          case DegreesOfFreedom:
658          const index_t x=id%m_N0;          case ReducedDegreesOfFreedom:
659          const index_t y=id%(m_N0*m_N1)/m_N0;              return true;
660          const index_t z=id/(m_N0*m_N1);          case Elements:
661          return (x>=left && x<right && y>=bottom && y<top && z>=front && z<back);          case ReducedElements:
662                {
663                    // check ownership of element's _last_ node
664                    const index_t x=id%m_NE0 + 1;
665                    const index_t y=id%(m_NE0*m_NE1)/m_NE0 + 1;
666                    const index_t z=id/(m_NE0*m_NE1) + 1;
667                    return (m_dofMap[x + m_N0*y +m_N0*m_N1*z] < getNumDOF());
668                }
669            case FaceElements:
670            case ReducedFaceElements:
671                {
672                    // check ownership of face element's last node
673                    const IndexVector faces = getNumFacesPerBoundary();
674                    dim_t n=0;
675                    for (size_t i=0; i<faces.size(); i++) {
676                        n+=faces[i];
677                        if (id<n) {
678                            const index_t j=id-n+faces[i];
679                            if (i>=4) { // front or back
680                                const index_t first=(i==4 ? 0 : m_N0*m_N1*(m_N2-1));
681                                return (m_dofMap[first+j%m_NE0+1+(j/m_NE0+1)*m_N0] < getNumDOF());
682                            } else if (i>=2) { // bottom or top
683                                const index_t first=(i==2 ? 0 : m_N0*(m_N1-1));
684                                return (m_dofMap[first+j%m_NE0+1+(j/m_NE0+1)*m_N0*m_N1] < getNumDOF());
685                            } else { // left or right
686                                const index_t first=(i==0 ? 0 : m_N0-1);
687                                return (m_dofMap[first+(j%m_NE1+1)*m_N0+(j/m_NE1+1)*m_N0*m_N1] < getNumDOF());
688                            }
689                        }
690                    }
691                    return false;
692                }
693            default:
694                break;
695        }
696    
697        stringstream msg;
698        msg << "ownSample: invalid function space type " << fsType;
699        throw RipleyException(msg.str());
700    }
701    
702    void Brick::setToNormal(escript::Data& out) const
703    {
704        if (out.getFunctionSpace().getTypeCode() == FaceElements) {
705            out.requireWrite();
706    #pragma omp parallel
707            {
708                if (m_faceOffset[0] > -1) {
709    #pragma omp for nowait
710                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
711                        for (index_t k1 = 0; k1 < m_NE1; ++k1) {
712                            double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));
713                            // set vector at four quadrature points
714                            *o++ = -1.; *o++ = 0.; *o++ = 0.;
715                            *o++ = -1.; *o++ = 0.; *o++ = 0.;
716                            *o++ = -1.; *o++ = 0.; *o++ = 0.;
717                            *o++ = -1.; *o++ = 0.; *o = 0.;
718                        }
719                    }
720                }
721    
722                if (m_faceOffset[1] > -1) {
723    #pragma omp for nowait
724                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
725                        for (index_t k1 = 0; k1 < m_NE1; ++k1) {
726                            double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));
727                            // set vector at four quadrature points
728                            *o++ = 1.; *o++ = 0.; *o++ = 0.;
729                            *o++ = 1.; *o++ = 0.; *o++ = 0.;
730                            *o++ = 1.; *o++ = 0.; *o++ = 0.;
731                            *o++ = 1.; *o++ = 0.; *o = 0.;
732                        }
733                    }
734                }
735    
736                if (m_faceOffset[2] > -1) {
737    #pragma omp for nowait
738                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
739                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
740                            double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));
741                            // set vector at four quadrature points
742                            *o++ = 0.; *o++ = -1.; *o++ = 0.;
743                            *o++ = 0.; *o++ = -1.; *o++ = 0.;
744                            *o++ = 0.; *o++ = -1.; *o++ = 0.;
745                            *o++ = 0.; *o++ = -1.; *o = 0.;
746                        }
747                    }
748                }
749    
750                if (m_faceOffset[3] > -1) {
751    #pragma omp for nowait
752                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
753                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
754                            double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));
755                            // set vector at four quadrature points
756                            *o++ = 0.; *o++ = 1.; *o++ = 0.;
757                            *o++ = 0.; *o++ = 1.; *o++ = 0.;
758                            *o++ = 0.; *o++ = 1.; *o++ = 0.;
759                            *o++ = 0.; *o++ = 1.; *o = 0.;
760                        }
761                    }
762                }
763    
764                if (m_faceOffset[4] > -1) {
765    #pragma omp for nowait
766                    for (index_t k1 = 0; k1 < m_NE1; ++k1) {
767                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
768                            double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));
769                            // set vector at four quadrature points
770                            *o++ = 0.; *o++ = 0.; *o++ = -1.;
771                            *o++ = 0.; *o++ = 0.; *o++ = -1.;
772                            *o++ = 0.; *o++ = 0.; *o++ = -1.;
773                            *o++ = 0.; *o++ = 0.; *o = -1.;
774                        }
775                    }
776                }
777    
778                if (m_faceOffset[5] > -1) {
779    #pragma omp for nowait
780                    for (index_t k1 = 0; k1 < m_NE1; ++k1) {
781                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
782                            double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));
783                            // set vector at four quadrature points
784                            *o++ = 0.; *o++ = 0.; *o++ = 1.;
785                            *o++ = 0.; *o++ = 0.; *o++ = 1.;
786                            *o++ = 0.; *o++ = 0.; *o++ = 1.;
787                            *o++ = 0.; *o++ = 0.; *o = 1.;
788                        }
789                    }
790                }
791            } // end of parallel section
792        } else if (out.getFunctionSpace().getTypeCode() == ReducedFaceElements) {
793            out.requireWrite();
794    #pragma omp parallel
795            {
796                if (m_faceOffset[0] > -1) {
797    #pragma omp for nowait
798                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
799                        for (index_t k1 = 0; k1 < m_NE1; ++k1) {
800                            double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));
801                            *o++ = -1.;
802                            *o++ = 0.;
803                            *o = 0.;
804                        }
805                    }
806                }
807    
808                if (m_faceOffset[1] > -1) {
809    #pragma omp for nowait
810                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
811                        for (index_t k1 = 0; k1 < m_NE1; ++k1) {
812                            double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));
813                            *o++ = 1.;
814                            *o++ = 0.;
815                            *o = 0.;
816                        }
817                    }
818                }
819    
820                if (m_faceOffset[2] > -1) {
821    #pragma omp for nowait
822                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
823                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
824                            double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));
825                            *o++ = 0.;
826                            *o++ = -1.;
827                            *o = 0.;
828                        }
829                    }
830                }
831    
832                if (m_faceOffset[3] > -1) {
833    #pragma omp for nowait
834                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
835                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
836                            double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));
837                            *o++ = 0.;
838                            *o++ = 1.;
839                            *o = 0.;
840                        }
841                    }
842                }
843    
844                if (m_faceOffset[4] > -1) {
845    #pragma omp for nowait
846                    for (index_t k1 = 0; k1 < m_NE1; ++k1) {
847                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
848                            double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));
849                            *o++ = 0.;
850                            *o++ = 0.;
851                            *o = -1.;
852                        }
853                    }
854                }
855    
856                if (m_faceOffset[5] > -1) {
857    #pragma omp for nowait
858                    for (index_t k1 = 0; k1 < m_NE1; ++k1) {
859                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
860                            double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));
861                            *o++ = 0.;
862                            *o++ = 0.;
863                            *o = 1.;
864                        }
865                    }
866                }
867            } // end of parallel section
868    
869      } else {      } else {
870          stringstream msg;          stringstream msg;
871          msg << "ownSample() not implemented for "          msg << "setToNormal: invalid function space type "
872              << functionSpaceTypeAsString(fsCode);              << out.getFunctionSpace().getTypeCode();
873          throw RipleyException(msg.str());          throw RipleyException(msg.str());
874      }      }
 #else  
     return true;  
 #endif  
875  }  }
876    
877  void Brick::setToGradient(escript::Data& out, const escript::Data& cIn) const  void Brick::setToSize(escript::Data& out) const
878    {
879        if (out.getFunctionSpace().getTypeCode() == Elements
880                || out.getFunctionSpace().getTypeCode() == ReducedElements) {
881            out.requireWrite();
882            const dim_t numQuad=out.getNumDataPointsPerSample();
883            const double xSize=getFirstCoordAndSpacing(0).second;
884            const double ySize=getFirstCoordAndSpacing(1).second;
885            const double zSize=getFirstCoordAndSpacing(2).second;
886            const double size=sqrt(xSize*xSize+ySize*ySize+zSize*zSize);
887    #pragma omp parallel for
888            for (index_t k = 0; k < getNumElements(); ++k) {
889                double* o = out.getSampleDataRW(k);
890                fill(o, o+numQuad, size);
891            }
892        } else if (out.getFunctionSpace().getTypeCode() == FaceElements
893                || out.getFunctionSpace().getTypeCode() == ReducedFaceElements) {
894            out.requireWrite();
895            const dim_t numQuad=out.getNumDataPointsPerSample();
896            const double xSize=getFirstCoordAndSpacing(0).second;
897            const double ySize=getFirstCoordAndSpacing(1).second;
898            const double zSize=getFirstCoordAndSpacing(2).second;
899    #pragma omp parallel
900            {
901                if (m_faceOffset[0] > -1) {
902                    const double size=min(ySize,zSize);
903    #pragma omp for nowait
904                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
905                        for (index_t k1 = 0; k1 < m_NE1; ++k1) {
906                            double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));
907                            fill(o, o+numQuad, size);
908                        }
909                    }
910                }
911    
912                if (m_faceOffset[1] > -1) {
913                    const double size=min(ySize,zSize);
914    #pragma omp for nowait
915                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
916                        for (index_t k1 = 0; k1 < m_NE1; ++k1) {
917                            double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));
918                            fill(o, o+numQuad, size);
919                        }
920                    }
921                }
922    
923                if (m_faceOffset[2] > -1) {
924                    const double size=min(xSize,zSize);
925    #pragma omp for nowait
926                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
927                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
928                            double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));
929                            fill(o, o+numQuad, size);
930                        }
931                    }
932                }
933    
934                if (m_faceOffset[3] > -1) {
935                    const double size=min(xSize,zSize);
936    #pragma omp for nowait
937                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
938                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
939                            double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));
940                            fill(o, o+numQuad, size);
941                        }
942                    }
943                }
944    
945                if (m_faceOffset[4] > -1) {
946                    const double size=min(xSize,ySize);
947    #pragma omp for nowait
948                    for (index_t k1 = 0; k1 < m_NE1; ++k1) {
949                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
950                            double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));
951                            fill(o, o+numQuad, size);
952                        }
953                    }
954                }
955    
956                if (m_faceOffset[5] > -1) {
957                    const double size=min(xSize,ySize);
958    #pragma omp for nowait
959                    for (index_t k1 = 0; k1 < m_NE1; ++k1) {
960                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
961                            double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));
962                            fill(o, o+numQuad, size);
963                        }
964                    }
965                }
966            } // end of parallel section
967    
968        } else {
969            stringstream msg;
970            msg << "setToSize: invalid function space type "
971                << out.getFunctionSpace().getTypeCode();
972            throw RipleyException(msg.str());
973        }
974    }
975    
976    Paso_SystemMatrixPattern* Brick::getPattern(bool reducedRowOrder,
977                                                bool reducedColOrder) const
978    {
979        /* FIXME: reduced
980        if (reducedRowOrder || reducedColOrder)
981            throw RipleyException("getPattern() not implemented for reduced order");
982        */
983        return m_pattern;
984    }
985    
986    void Brick::Print_Mesh_Info(const bool full) const
987    {
988        RipleyDomain::Print_Mesh_Info(full);
989        if (full) {
990            cout << "     Id  Coordinates" << endl;
991            cout.precision(15);
992            cout.setf(ios::scientific, ios::floatfield);
993            pair<double,double> xdx = getFirstCoordAndSpacing(0);
994            pair<double,double> ydy = getFirstCoordAndSpacing(1);
995            pair<double,double> zdz = getFirstCoordAndSpacing(2);
996            for (index_t i=0; i < getNumNodes(); i++) {
997                cout << "  " << setw(5) << m_nodeId[i]
998                    << "  " << xdx.first+(i%m_N0)*xdx.second
999                    << "  " << ydy.first+(i%(m_N0*m_N1)/m_N0)*ydy.second
1000                    << "  " << zdz.first+(i/(m_N0*m_N1))*zdz.second << endl;
1001            }
1002        }
1003    }
1004    
1005    IndexVector Brick::getNumNodesPerDim() const
1006    {
1007        IndexVector ret;
1008        ret.push_back(m_N0);
1009        ret.push_back(m_N1);
1010        ret.push_back(m_N2);
1011        return ret;
1012    }
1013    
1014    IndexVector Brick::getNumElementsPerDim() const
1015    {
1016        IndexVector ret;
1017        ret.push_back(m_NE0);
1018        ret.push_back(m_NE1);
1019        ret.push_back(m_NE2);
1020        return ret;
1021    }
1022    
1023    IndexVector Brick::getNumFacesPerBoundary() const
1024    {
1025        IndexVector ret(6, 0);
1026        //left
1027        if (m_offset0==0)
1028            ret[0]=m_NE1*m_NE2;
1029        //right
1030        if (m_mpiInfo->rank%m_NX==m_NX-1)
1031            ret[1]=m_NE1*m_NE2;
1032        //bottom
1033        if (m_offset1==0)
1034            ret[2]=m_NE0*m_NE2;
1035        //top
1036        if (m_mpiInfo->rank%(m_NX*m_NY)/m_NX==m_NY-1)
1037            ret[3]=m_NE0*m_NE2;
1038        //front
1039        if (m_offset2==0)
1040            ret[4]=m_NE0*m_NE1;
1041        //back
1042        if (m_mpiInfo->rank/(m_NX*m_NY)==m_NZ-1)
1043            ret[5]=m_NE0*m_NE1;
1044        return ret;
1045    }
1046    
1047    IndexVector Brick::getNumSubdivisionsPerDim() const
1048    {
1049        IndexVector ret;
1050        ret.push_back(m_NX);
1051        ret.push_back(m_NY);
1052        ret.push_back(m_NZ);
1053        return ret;
1054    }
1055    
1056    pair<double,double> Brick::getFirstCoordAndSpacing(dim_t dim) const
1057    {
1058        if (dim==0)
1059            return pair<double,double>(m_x0+(m_l0*m_offset0)/m_gNE0, m_l0/m_gNE0);
1060        else if (dim==1)
1061            return pair<double,double>(m_y0+(m_l1*m_offset1)/m_gNE1, m_l1/m_gNE1);
1062        else if (dim==2)
1063            return pair<double,double>(m_z0+(m_l2*m_offset2)/m_gNE2, m_l2/m_gNE2);
1064    
1065        throw RipleyException("getFirstCoordAndSpacing: invalid argument");
1066    }
1067    
1068    //protected
1069    dim_t Brick::getNumDOF() const
1070    {
1071        return (m_gNE0+1)/m_NX*(m_gNE1+1)/m_NY*(m_gNE2+1)/m_NZ;
1072    }
1073    
1074    //protected
1075    dim_t Brick::getNumFaceElements() const
1076    {
1077        const IndexVector faces = getNumFacesPerBoundary();
1078        dim_t n=0;
1079        for (size_t i=0; i<faces.size(); i++)
1080            n+=faces[i];
1081        return n;
1082    }
1083    
1084    //protected
1085    void Brick::assembleCoordinates(escript::Data& arg) const
1086    {
1087        escriptDataC x = arg.getDataC();
1088        int numDim = m_numDim;
1089        if (!isDataPointShapeEqual(&x, 1, &numDim))
1090            throw RipleyException("setToX: Invalid Data object shape");
1091        if (!numSamplesEqual(&x, 1, getNumNodes()))
1092            throw RipleyException("setToX: Illegal number of samples in Data object");
1093    
1094        pair<double,double> xdx = getFirstCoordAndSpacing(0);
1095        pair<double,double> ydy = getFirstCoordAndSpacing(1);
1096        pair<double,double> zdz = getFirstCoordAndSpacing(2);
1097        arg.requireWrite();
1098    #pragma omp parallel for
1099        for (dim_t i2 = 0; i2 < m_N2; i2++) {
1100            for (dim_t i1 = 0; i1 < m_N1; i1++) {
1101                for (dim_t i0 = 0; i0 < m_N0; i0++) {
1102                    double* point = arg.getSampleDataRW(i0+m_N0*i1+m_N0*m_N1*i2);
1103                    point[0] = xdx.first+i0*xdx.second;
1104                    point[1] = ydy.first+i1*ydy.second;
1105                    point[2] = zdz.first+i2*zdz.second;
1106                }
1107            }
1108        }
1109    }
1110    
1111    //protected
1112    void Brick::assembleGradient(escript::Data& out, escript::Data& in) const
1113  {  {
     escript::Data& in = *const_cast<escript::Data*>(&cIn);  
1114      const dim_t numComp = in.getDataPointSize();      const dim_t numComp = in.getDataPointSize();
1115      const double h0 = m_l0/m_gNE0;      const double h0 = m_l0/m_gNE0;
1116      const double h1 = m_l1/m_gNE1;      const double h1 = m_l1/m_gNE1;
1117      const double h2 = m_l1/m_gNE2;      const double h2 = m_l2/m_gNE2;
1118      const double C0 = .044658198738520451079;      const double C0 = .044658198738520451079;
1119      const double C1 = .16666666666666666667;      const double C1 = .16666666666666666667;
1120      const double C2 = .21132486540518711775;      const double C2 = .21132486540518711775;
# Line 317  void Brick::setToGradient(escript::Data& Line 1124  void Brick::setToGradient(escript::Data&
1124      const double C6 = .78867513459481288225;      const double C6 = .78867513459481288225;
1125    
1126      if (out.getFunctionSpace().getTypeCode() == Elements) {      if (out.getFunctionSpace().getTypeCode() == Elements) {
1127          /*** GENERATOR SNIP_GRAD_ELEMENTS TOP */          out.requireWrite();
1128  #pragma omp parallel for  #pragma omp parallel
1129          for (index_t k2=0; k2 < m_NE2; ++k2) {          {
1130              for (index_t k1=0; k1 < m_NE1; ++k1) {              vector<double> f_000(numComp);
1131                  for (index_t k0=0; k0 < m_NE0; ++k0) {              vector<double> f_001(numComp);
1132                      const register double* f_000 = in.getSampleDataRO(INDEX3(k0,k1,k2, m_N0,m_N1));              vector<double> f_010(numComp);
1133                      const register double* f_001 = in.getSampleDataRO(INDEX3(k0,k1,k2+1, m_N0,m_N1));              vector<double> f_011(numComp);
1134                      const register double* f_101 = in.getSampleDataRO(INDEX3(k0+1,k1,k2+1, m_N0,m_N1));              vector<double> f_100(numComp);
1135                      const register double* f_111 = in.getSampleDataRO(INDEX3(k0+1,k1+1,k2+1, m_N0,m_N1));              vector<double> f_101(numComp);
1136                      const register double* f_110 = in.getSampleDataRO(INDEX3(k0+1,k1+1,k2, m_N0,m_N1));              vector<double> f_110(numComp);
1137                      const register double* f_011 = in.getSampleDataRO(INDEX3(k0,k1+1,k2+1, m_N0,m_N1));              vector<double> f_111(numComp);
1138                      const register double* f_010 = in.getSampleDataRO(INDEX3(k0,k1+1,k2, m_N0,m_N1));  #pragma omp for
1139                      const register double* f_100 = in.getSampleDataRO(INDEX3(k0+1,k1,k2, m_N0,m_N1));              for (index_t k2=0; k2 < m_NE2; ++k2) {
1140                      double* o = out.getSampleDataRW(INDEX3(k0,k1,k2,m_NE0,m_NE1));                  for (index_t k1=0; k1 < m_NE1; ++k1) {
1141                      for (index_t i=0; i < numComp; ++i) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
1142                          const double V0=((f_100[i]-f_000[i])*C5 + (f_111[i]-f_011[i])*C0 + (f_101[i]+f_110[i]-f_001[i]-f_010[i])*C1) / h0;                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
1143                          const double V1=((f_110[i]-f_010[i])*C5 + (f_101[i]-f_001[i])*C0 + (f_100[i]+f_111[i]-f_000[i]-f_011[i])*C1) / h0;                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1144                          const double V2=((f_101[i]-f_001[i])*C5 + (f_110[i]-f_010[i])*C0 + (f_100[i]+f_111[i]-f_000[i]-f_011[i])*C1) / h0;                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
1145                          const double V3=((f_111[i]-f_011[i])*C5 + (f_100[i]-f_000[i])*C0 + (f_101[i]+f_110[i]-f_001[i]-f_010[i])*C1) / h0;                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1146                          const double V4=((f_010[i]-f_000[i])*C5 + (f_111[i]-f_101[i])*C0 + (f_011[i]+f_110[i]-f_001[i]-f_100[i])*C1) / h1;                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
1147                          const double V5=((f_110[i]-f_100[i])*C5 + (f_011[i]-f_001[i])*C0 + (f_010[i]+f_111[i]-f_000[i]-f_101[i])*C1) / h1;                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1148                          const double V6=((f_011[i]-f_001[i])*C5 + (f_110[i]-f_100[i])*C0 + (f_010[i]+f_111[i]-f_000[i]-f_101[i])*C1) / h1;                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
1149                          const double V7=((f_111[i]-f_101[i])*C5 + (f_010[i]-f_000[i])*C0 + (f_011[i]+f_110[i]-f_001[i]-f_100[i])*C1) / h1;                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1150                          const double V8=((f_001[i]-f_000[i])*C5 + (f_111[i]-f_110[i])*C0 + (f_011[i]+f_101[i]-f_010[i]-f_100[i])*C1) / h2;                          double* o = out.getSampleDataRW(INDEX3(k0,k1,k2,m_NE0,m_NE1));
1151                          const double V9=((f_101[i]-f_100[i])*C5 + (f_011[i]-f_010[i])*C0 + (f_001[i]+f_111[i]-f_000[i]-f_110[i])*C1) / h2;                          for (index_t i=0; i < numComp; ++i) {
1152                          const double V10=((f_011[i]-f_010[i])*C5 + (f_101[i]-f_100[i])*C0 + (f_001[i]+f_111[i]-f_000[i]-f_110[i])*C1) / h2;                              const double V0=((f_100[i]-f_000[i])*C5 + (f_111[i]-f_011[i])*C0 + (f_101[i]+f_110[i]-f_001[i]-f_010[i])*C1) / h0;
1153                          const double V11=((f_111[i]-f_110[i])*C5 + (f_001[i]-f_000[i])*C0 + (f_011[i]+f_101[i]-f_010[i]-f_100[i])*C1) / h2;                              const double V1=((f_110[i]-f_010[i])*C5 + (f_101[i]-f_001[i])*C0 + (f_100[i]+f_111[i]-f_000[i]-f_011[i])*C1) / h0;
1154                          o[INDEX3(i,0,0,numComp,3)] = V0;                              const double V2=((f_101[i]-f_001[i])*C5 + (f_110[i]-f_010[i])*C0 + (f_100[i]+f_111[i]-f_000[i]-f_011[i])*C1) / h0;
1155                          o[INDEX3(i,1,0,numComp,3)] = V4;                              const double V3=((f_111[i]-f_011[i])*C5 + (f_100[i]-f_000[i])*C0 + (f_101[i]+f_110[i]-f_001[i]-f_010[i])*C1) / h0;
1156                          o[INDEX3(i,2,0,numComp,3)] = V8;                              const double V4=((f_010[i]-f_000[i])*C5 + (f_111[i]-f_101[i])*C0 + (f_011[i]+f_110[i]-f_001[i]-f_100[i])*C1) / h1;
1157                          o[INDEX3(i,0,1,numComp,3)] = V0;                              const double V5=((f_110[i]-f_100[i])*C5 + (f_011[i]-f_001[i])*C0 + (f_010[i]+f_111[i]-f_000[i]-f_101[i])*C1) / h1;
1158                          o[INDEX3(i,1,1,numComp,3)] = V5;                              const double V6=((f_011[i]-f_001[i])*C5 + (f_110[i]-f_100[i])*C0 + (f_010[i]+f_111[i]-f_000[i]-f_101[i])*C1) / h1;
1159                          o[INDEX3(i,2,1,numComp,3)] = V9;                              const double V7=((f_111[i]-f_101[i])*C5 + (f_010[i]-f_000[i])*C0 + (f_011[i]+f_110[i]-f_001[i]-f_100[i])*C1) / h1;
1160                          o[INDEX3(i,0,2,numComp,3)] = V1;                              const double V8=((f_001[i]-f_000[i])*C5 + (f_111[i]-f_110[i])*C0 + (f_011[i]+f_101[i]-f_010[i]-f_100[i])*C1) / h2;
1161                          o[INDEX3(i,1,2,numComp,3)] = V4;                              const double V9=((f_101[i]-f_100[i])*C5 + (f_011[i]-f_010[i])*C0 + (f_001[i]+f_111[i]-f_000[i]-f_110[i])*C1) / h2;
1162                          o[INDEX3(i,2,2,numComp,3)] = V10;                              const double V10=((f_011[i]-f_010[i])*C5 + (f_101[i]-f_100[i])*C0 + (f_001[i]+f_111[i]-f_000[i]-f_110[i])*C1) / h2;
1163                          o[INDEX3(i,0,3,numComp,3)] = V1;                              const double V11=((f_111[i]-f_110[i])*C5 + (f_001[i]-f_000[i])*C0 + (f_011[i]+f_101[i]-f_010[i]-f_100[i])*C1) / h2;
1164                          o[INDEX3(i,1,3,numComp,3)] = V5;                              o[INDEX3(i,0,0,numComp,3)] = V0;
1165                          o[INDEX3(i,2,3,numComp,3)] = V11;                              o[INDEX3(i,1,0,numComp,3)] = V4;
1166                          o[INDEX3(i,0,4,numComp,3)] = V2;                              o[INDEX3(i,2,0,numComp,3)] = V8;
1167                          o[INDEX3(i,1,4,numComp,3)] = V6;                              o[INDEX3(i,0,1,numComp,3)] = V0;
1168                          o[INDEX3(i,2,4,numComp,3)] = V8;                              o[INDEX3(i,1,1,numComp,3)] = V5;
1169                          o[INDEX3(i,0,5,numComp,3)] = V2;                              o[INDEX3(i,2,1,numComp,3)] = V9;
1170                          o[INDEX3(i,1,5,numComp,3)] = V7;                              o[INDEX3(i,0,2,numComp,3)] = V1;
1171                          o[INDEX3(i,2,5,numComp,3)] = V9;                              o[INDEX3(i,1,2,numComp,3)] = V4;
1172                          o[INDEX3(i,0,6,numComp,3)] = V3;                              o[INDEX3(i,2,2,numComp,3)] = V10;
1173                          o[INDEX3(i,1,6,numComp,3)] = V6;                              o[INDEX3(i,0,3,numComp,3)] = V1;
1174                          o[INDEX3(i,2,6,numComp,3)] = V10;                              o[INDEX3(i,1,3,numComp,3)] = V5;
1175                          o[INDEX3(i,0,7,numComp,3)] = V3;                              o[INDEX3(i,2,3,numComp,3)] = V11;
1176                          o[INDEX3(i,1,7,numComp,3)] = V7;                              o[INDEX3(i,0,4,numComp,3)] = V2;
1177                          o[INDEX3(i,2,7,numComp,3)] = V11;                              o[INDEX3(i,1,4,numComp,3)] = V6;
1178                      } /* end of component loop i */                              o[INDEX3(i,2,4,numComp,3)] = V8;
1179                  } /* end of k0 loop */                              o[INDEX3(i,0,5,numComp,3)] = V2;
1180              } /* end of k1 loop */                              o[INDEX3(i,1,5,numComp,3)] = V7;
1181          } /* end of k2 loop */                              o[INDEX3(i,2,5,numComp,3)] = V9;
1182          /* GENERATOR SNIP_GRAD_ELEMENTS BOTTOM */                              o[INDEX3(i,0,6,numComp,3)] = V3;
1183                                o[INDEX3(i,1,6,numComp,3)] = V6;
1184                                o[INDEX3(i,2,6,numComp,3)] = V10;
1185                                o[INDEX3(i,0,7,numComp,3)] = V3;
1186                                o[INDEX3(i,1,7,numComp,3)] = V7;
1187                                o[INDEX3(i,2,7,numComp,3)] = V11;
1188                            } // end of component loop i
1189                        } // end of k0 loop
1190                    } // end of k1 loop
1191                } // end of k2 loop
1192            } // end of parallel section
1193      } else if (out.getFunctionSpace().getTypeCode() == ReducedElements) {      } else if (out.getFunctionSpace().getTypeCode() == ReducedElements) {
1194          /*** GENERATOR SNIP_GRAD_REDUCED_ELEMENTS TOP */          out.requireWrite();
1195  #pragma omp parallel for  #pragma omp parallel
1196          for (index_t k2=0; k2 < m_NE2; ++k2) {          {
1197              for (index_t k1=0; k1 < m_NE1; ++k1) {              vector<double> f_000(numComp);
1198                  for (index_t k0=0; k0 < m_NE0; ++k0) {              vector<double> f_001(numComp);
1199                      const register double* f_000 = in.getSampleDataRO(INDEX3(k0,k1,k2, m_N0,m_N1));              vector<double> f_010(numComp);
1200                      const register double* f_001 = in.getSampleDataRO(INDEX3(k0,k1,k2+1, m_N0,m_N1));              vector<double> f_011(numComp);
1201                      const register double* f_101 = in.getSampleDataRO(INDEX3(k0+1,k1,k2+1, m_N0,m_N1));              vector<double> f_100(numComp);
1202                      const register double* f_011 = in.getSampleDataRO(INDEX3(k0,k1+1,k2+1, m_N0,m_N1));              vector<double> f_101(numComp);
1203                      const register double* f_100 = in.getSampleDataRO(INDEX3(k0+1,k1,k2, m_N0,m_N1));              vector<double> f_110(numComp);
1204                      const register double* f_110 = in.getSampleDataRO(INDEX3(k0+1,k1+1,k2, m_N0,m_N1));              vector<double> f_111(numComp);
1205                      const register double* f_010 = in.getSampleDataRO(INDEX3(k0,k1+1,k2, m_N0,m_N1));  #pragma omp for
1206                      const register double* f_111 = in.getSampleDataRO(INDEX3(k0+1,k1+1,k2+1, m_N0,m_N1));              for (index_t k2=0; k2 < m_NE2; ++k2) {
1207                      double* o = out.getSampleDataRW(INDEX3(k0,k1,k2,m_NE0,m_NE1));                  for (index_t k1=0; k1 < m_NE1; ++k1) {
1208                      for (index_t i=0; i < numComp; ++i) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
1209                          o[INDEX3(i,0,0,numComp,3)] = (f_100[i]+f_101[i]+f_110[i]+f_111[i]-f_000[i]-f_001[i]-f_010[i]-f_011[i])*C3 / h0;                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
1210                          o[INDEX3(i,1,0,numComp,3)] = (f_010[i]+f_011[i]+f_110[i]+f_111[i]-f_000[i]-f_001[i]-f_100[i]-f_101[i])*C3 / h1;                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1211                          o[INDEX3(i,2,0,numComp,3)] = (f_001[i]+f_011[i]+f_101[i]+f_111[i]-f_000[i]-f_010[i]-f_100[i]-f_110[i])*C3 / h2;                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
1212                      } /* end of component loop i */                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1213                  } /* end of k0 loop */                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
1214              } /* end of k1 loop */                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1215          } /* end of k2 loop */                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
1216          /* GENERATOR SNIP_GRAD_REDUCED_ELEMENTS BOTTOM */                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1217                            double* o = out.getSampleDataRW(INDEX3(k0,k1,k2,m_NE0,m_NE1));
1218                            for (index_t i=0; i < numComp; ++i) {
1219                                o[INDEX3(i,0,0,numComp,3)] = (f_100[i]+f_101[i]+f_110[i]+f_111[i]-f_000[i]-f_001[i]-f_010[i]-f_011[i])*C3 / h0;
1220                                o[INDEX3(i,1,0,numComp,3)] = (f_010[i]+f_011[i]+f_110[i]+f_111[i]-f_000[i]-f_001[i]-f_100[i]-f_101[i])*C3 / h1;
1221                                o[INDEX3(i,2,0,numComp,3)] = (f_001[i]+f_011[i]+f_101[i]+f_111[i]-f_000[i]-f_010[i]-f_100[i]-f_110[i])*C3 / h2;
1222                            } // end of component loop i
1223                        } // end of k0 loop
1224                    } // end of k1 loop
1225                } // end of k2 loop
1226            } // end of parallel section
1227      } else if (out.getFunctionSpace().getTypeCode() == FaceElements) {      } else if (out.getFunctionSpace().getTypeCode() == FaceElements) {
1228          /*** GENERATOR SNIP_GRAD_FACES TOP */          out.requireWrite();
1229  #pragma omp parallel  #pragma omp parallel
1230          {          {
1231                vector<double> f_000(numComp);
1232                vector<double> f_001(numComp);
1233                vector<double> f_010(numComp);
1234                vector<double> f_011(numComp);
1235                vector<double> f_100(numComp);
1236                vector<double> f_101(numComp);
1237                vector<double> f_110(numComp);
1238                vector<double> f_111(numComp);
1239              if (m_faceOffset[0] > -1) {              if (m_faceOffset[0] > -1) {
1240  #pragma omp for nowait  #pragma omp for nowait
1241                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE2; ++k2) {
1242                      for (index_t k1=0; k1 < m_NE1; ++k1) {                      for (index_t k1=0; k1 < m_NE1; ++k1) {
1243                          const register double* f_000 = in.getSampleDataRO(INDEX3(0,k1,k2, m_N0,m_N1));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(0,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
1244                          const register double* f_001 = in.getSampleDataRO(INDEX3(0,k1,k2+1, m_N0,m_N1));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(0,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1245                          const register double* f_101 = in.getSampleDataRO(INDEX3(1,k1,k2+1, m_N0,m_N1));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(0,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
1246                          const register double* f_111 = in.getSampleDataRO(INDEX3(1,k1+1,k2+1, m_N0,m_N1));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(0,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1247                          const register double* f_110 = in.getSampleDataRO(INDEX3(1,k1+1,k2, m_N0,m_N1));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(1,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
1248                          const register double* f_011 = in.getSampleDataRO(INDEX3(0,k1+1,k2+1, m_N0,m_N1));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(1,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1249                          const register double* f_010 = in.getSampleDataRO(INDEX3(0,k1+1,k2, m_N0,m_N1));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(1,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
1250                          const register double* f_100 = in.getSampleDataRO(INDEX3(1,k1,k2, m_N0,m_N1));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(1,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1251                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));
1252                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1253                              const double V0=((f_010[i]-f_000[i])*C6 + (f_011[i]-f_001[i])*C2) / h1;                              const double V0=((f_010[i]-f_000[i])*C6 + (f_011[i]-f_001[i])*C2) / h1;
# Line 431  void Brick::setToGradient(escript::Data& Line 1266  void Brick::setToGradient(escript::Data&
1266                              o[INDEX3(i,0,3,numComp,3)] = ((f_111[i]-f_011[i])*C5 + (f_100[i]-f_000[i])*C0 + (f_101[i]+f_110[i]-f_001[i]-f_010[i])*C1) / h0;                              o[INDEX3(i,0,3,numComp,3)] = ((f_111[i]-f_011[i])*C5 + (f_100[i]-f_000[i])*C0 + (f_101[i]+f_110[i]-f_001[i]-f_010[i])*C1) / h0;
1267                              o[INDEX3(i,1,3,numComp,3)] = V1;                              o[INDEX3(i,1,3,numComp,3)] = V1;
1268                              o[INDEX3(i,2,3,numComp,3)] = V3;                              o[INDEX3(i,2,3,numComp,3)] = V3;
1269                          } /* end of component loop i */                          } // end of component loop i
1270                      } /* end of k1 loop */                      } // end of k1 loop
1271                  } /* end of k2 loop */                  } // end of k2 loop
1272              } /* end of face 0 */              } // end of face 0
1273              if (m_faceOffset[1] > -1) {              if (m_faceOffset[1] > -1) {
1274  #pragma omp for nowait  #pragma omp for nowait
1275                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE2; ++k2) {
1276                      for (index_t k1=0; k1 < m_NE1; ++k1) {                      for (index_t k1=0; k1 < m_NE1; ++k1) {
1277                          const register double* f_000 = in.getSampleDataRO(INDEX3(m_N0-2,k1,k2, m_N0,m_N1));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(m_N0-2,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
1278                          const register double* f_001 = in.getSampleDataRO(INDEX3(m_N0-2,k1,k2+1, m_N0,m_N1));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(m_N0-2,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1279                          const register double* f_101 = in.getSampleDataRO(INDEX3(m_N0-1,k1,k2+1, m_N0,m_N1));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(m_N0-2,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
1280                          const register double* f_111 = in.getSampleDataRO(INDEX3(m_N0-1,k1+1,k2+1, m_N0,m_N1));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(m_N0-2,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1281                          const register double* f_110 = in.getSampleDataRO(INDEX3(m_N0-1,k1+1,k2, m_N0,m_N1));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(m_N0-1,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
1282                          const register double* f_011 = in.getSampleDataRO(INDEX3(m_N0-2,k1+1,k2+1, m_N0,m_N1));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(m_N0-1,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1283                          const register double* f_010 = in.getSampleDataRO(INDEX3(m_N0-2,k1+1,k2, m_N0,m_N1));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(m_N0-1,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
1284                          const register double* f_100 = in.getSampleDataRO(INDEX3(m_N0-1,k1,k2, m_N0,m_N1));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(m_N0-1,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1285                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));
1286                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1287                              const double V0=((f_110[i]-f_100[i])*C6 + (f_111[i]-f_101[i])*C2) / h1;                              const double V0=((f_110[i]-f_100[i])*C6 + (f_111[i]-f_101[i])*C2) / h1;
# Line 465  void Brick::setToGradient(escript::Data& Line 1300  void Brick::setToGradient(escript::Data&
1300                              o[INDEX3(i,0,3,numComp,3)] = ((f_111[i]-f_011[i])*C5 + (f_100[i]-f_000[i])*C0 + (f_101[i]+f_110[i]-f_001[i]-f_010[i])*C1) / h0;                              o[INDEX3(i,0,3,numComp,3)] = ((f_111[i]-f_011[i])*C5 + (f_100[i]-f_000[i])*C0 + (f_101[i]+f_110[i]-f_001[i]-f_010[i])*C1) / h0;
1301                              o[INDEX3(i,1,3,numComp,3)] = V1;                              o[INDEX3(i,1,3,numComp,3)] = V1;
1302                              o[INDEX3(i,2,3,numComp,3)] = V3;                              o[INDEX3(i,2,3,numComp,3)] = V3;
1303                          } /* end of component loop i */                          } // end of component loop i
1304                      } /* end of k1 loop */                      } // end of k1 loop
1305                  } /* end of k2 loop */                  } // end of k2 loop
1306              } /* end of face 1 */              } // end of face 1
1307              if (m_faceOffset[2] > -1) {              if (m_faceOffset[2] > -1) {
1308  #pragma omp for nowait  #pragma omp for nowait
1309                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE2; ++k2) {
1310                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
1311                          const register double* f_000 = in.getSampleDataRO(INDEX3(k0,0,k2, m_N0,m_N1));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,0,k2, m_N0,m_N1)), numComp*sizeof(double));
1312                          const register double* f_001 = in.getSampleDataRO(INDEX3(k0,0,k2+1, m_N0,m_N1));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,0,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1313                          const register double* f_101 = in.getSampleDataRO(INDEX3(k0+1,0,k2+1, m_N0,m_N1));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,1,k2, m_N0,m_N1)), numComp*sizeof(double));
1314                          const register double* f_100 = in.getSampleDataRO(INDEX3(k0+1,0,k2, m_N0,m_N1));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1315                          const register double* f_111 = in.getSampleDataRO(INDEX3(k0+1,1,k2+1, m_N0,m_N1));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,0,k2, m_N0,m_N1)), numComp*sizeof(double));
1316                          const register double* f_110 = in.getSampleDataRO(INDEX3(k0+1,1,k2, m_N0,m_N1));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,0,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1317                          const register double* f_011 = in.getSampleDataRO(INDEX3(k0,1,k2+1, m_N0,m_N1));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,1,k2, m_N0,m_N1)), numComp*sizeof(double));
1318                          const register double* f_010 = in.getSampleDataRO(INDEX3(k0,1,k2, m_N0,m_N1));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1319                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));
1320                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1321                              const double V0=((f_100[i]-f_000[i])*C6 + (f_101[i]-f_001[i])*C2) / h0;                              const double V0=((f_100[i]-f_000[i])*C6 + (f_101[i]-f_001[i])*C2) / h0;
# Line 498  void Brick::setToGradient(escript::Data& Line 1333  void Brick::setToGradient(escript::Data&
1333                              o[INDEX3(i,0,3,numComp,3)] = V0;                              o[INDEX3(i,0,3,numComp,3)] = V0;
1334                              o[INDEX3(i,1,3,numComp,3)] = ((f_111[i]-f_101[i])*C5 + (f_010[i]-f_000[i])*C0 + (f_011[i]+f_110[i]-f_001[i]-f_100[i])*C1) / h1;                              o[INDEX3(i,1,3,numComp,3)] = ((f_111[i]-f_101[i])*C5 + (f_010[i]-f_000[i])*C0 + (f_011[i]+f_110[i]-f_001[i]-f_100[i])*C1) / h1;
1335                              o[INDEX3(i,2,3,numComp,3)] = V2;                              o[INDEX3(i,2,3,numComp,3)] = V2;
1336                          } /* end of component loop i */                          } // end of component loop i
1337                      } /* end of k0 loop */                      } // end of k0 loop
1338                  } /* end of k2 loop */                  } // end of k2 loop
1339              } /* end of face 2 */              } // end of face 2
1340              if (m_faceOffset[3] > -1) {              if (m_faceOffset[3] > -1) {
1341  #pragma omp for nowait  #pragma omp for nowait
1342                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE2; ++k2) {
1343                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
1344                          const register double* f_011 = in.getSampleDataRO(INDEX3(k0,m_N1-1,k2+1, m_N0,m_N1));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,m_N1-2,k2, m_N0,m_N1)), numComp*sizeof(double));
1345                          const register double* f_110 = in.getSampleDataRO(INDEX3(k0+1,m_N1-1,k2, m_N0,m_N1));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,m_N1-2,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1346                          const register double* f_010 = in.getSampleDataRO(INDEX3(k0,m_N1-1,k2, m_N0,m_N1));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,m_N1-1,k2, m_N0,m_N1)), numComp*sizeof(double));
1347                          const register double* f_111 = in.getSampleDataRO(INDEX3(k0+1,m_N1-1,k2+1, m_N0,m_N1));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,m_N1-1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1348                          const register double* f_000 = in.getSampleDataRO(INDEX3(k0,m_N1-2,k2, m_N0,m_N1));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-2,k2, m_N0,m_N1)), numComp*sizeof(double));
1349                          const register double* f_001 = in.getSampleDataRO(INDEX3(k0,m_N1-2,k2+1, m_N0,m_N1));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-2,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1350                          const register double* f_101 = in.getSampleDataRO(INDEX3(k0+1,m_N1-2,k2+1, m_N0,m_N1));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-1,k2, m_N0,m_N1)), numComp*sizeof(double));
1351                          const register double* f_100 = in.getSampleDataRO(INDEX3(k0+1,m_N1-2,k2, m_N0,m_N1));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1352                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));
1353                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1354                              const double V0=((f_110[i]-f_010[i])*C6 + (f_111[i]-f_011[i])*C2) / h0;                              const double V0=((f_110[i]-f_010[i])*C6 + (f_111[i]-f_011[i])*C2) / h0;
# Line 532  void Brick::setToGradient(escript::Data& Line 1367  void Brick::setToGradient(escript::Data&
1367                              o[INDEX3(i,0,3,numComp,3)] = V1;                              o[INDEX3(i,0,3,numComp,3)] = V1;
1368                              o[INDEX3(i,1,3,numComp,3)] = ((f_111[i]-f_101[i])*C5 + (f_010[i]-f_000[i])*C0 + (f_011[i]+f_110[i]-f_001[i]-f_100[i])*C1) / h1;                              o[INDEX3(i,1,3,numComp,3)] = ((f_111[i]-f_101[i])*C5 + (f_010[i]-f_000[i])*C0 + (f_011[i]+f_110[i]-f_001[i]-f_100[i])*C1) / h1;
1369                              o[INDEX3(i,2,3,numComp,3)] = V3;                              o[INDEX3(i,2,3,numComp,3)] = V3;
1370                          } /* end of component loop i */                          } // end of component loop i
1371                      } /* end of k0 loop */                      } // end of k0 loop
1372                  } /* end of k2 loop */                  } // end of k2 loop
1373              } /* end of face 3 */              } // end of face 3
1374              if (m_faceOffset[4] > -1) {              if (m_faceOffset[4] > -1) {
1375  #pragma omp for nowait  #pragma omp for nowait
1376                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1=0; k1 < m_NE1; ++k1) {
1377                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
1378                          const register double* f_000 = in.getSampleDataRO(INDEX3(k0,k1,0, m_N0,m_N1));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,0, m_N0,m_N1)), numComp*sizeof(double));
1379                          const register double* f_100 = in.getSampleDataRO(INDEX3(k0+1,k1,0, m_N0,m_N1));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,1, m_N0,m_N1)), numComp*sizeof(double));
1380                          const register double* f_110 = in.getSampleDataRO(INDEX3(k0+1,k1+1,0, m_N0,m_N1));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,0, m_N0,m_N1)), numComp*sizeof(double));
1381                          const register double* f_010 = in.getSampleDataRO(INDEX3(k0,k1+1,0, m_N0,m_N1));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,1, m_N0,m_N1)), numComp*sizeof(double));
1382                          const register double* f_001 = in.getSampleDataRO(INDEX3(k0,k1,1, m_N0,m_N1));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,0, m_N0,m_N1)), numComp*sizeof(double));
1383                          const register double* f_101 = in.getSampleDataRO(INDEX3(k0+1,k1,1, m_N0,m_N1));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,1, m_N0,m_N1)), numComp*sizeof(double));
1384                          const register double* f_011 = in.getSampleDataRO(INDEX3(k0,k1+1,1, m_N0,m_N1));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,0, m_N0,m_N1)), numComp*sizeof(double));
1385                          const register double* f_111 = in.getSampleDataRO(INDEX3(k0+1,k1+1,1, m_N0,m_N1));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,1, m_N0,m_N1)), numComp*sizeof(double));
1386                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));
1387                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1388                              const double V0=((f_100[i]-f_000[i])*C6 + (f_110[i]-f_010[i])*C2) / h0;                              const double V0=((f_100[i]-f_000[i])*C6 + (f_110[i]-f_010[i])*C2) / h0;
# Line 566  void Brick::setToGradient(escript::Data& Line 1401  void Brick::setToGradient(escript::Data&
1401                              o[INDEX3(i,0,3,numComp,3)] = V1;                              o[INDEX3(i,0,3,numComp,3)] = V1;
1402                              o[INDEX3(i,1,3,numComp,3)] = V3;                              o[INDEX3(i,1,3,numComp,3)] = V3;
1403                              o[INDEX3(i,2,3,numComp,3)] = ((f_111[i]-f_110[i])*C5 + (f_001[i]-f_000[i])*C0 + (f_011[i]+f_101[i]-f_010[i]-f_100[i])*C1) / h2;                              o[INDEX3(i,2,3,numComp,3)] = ((f_111[i]-f_110[i])*C5 + (f_001[i]-f_000[i])*C0 + (f_011[i]+f_101[i]-f_010[i]-f_100[i])*C1) / h2;
1404                          } /* end of component loop i */                          } // end of component loop i
1405                      } /* end of k0 loop */                      } // end of k0 loop
1406                  } /* end of k1 loop */                  } // end of k1 loop
1407              } /* end of face 4 */              } // end of face 4
1408              if (m_faceOffset[5] > -1) {              if (m_faceOffset[5] > -1) {
1409  #pragma omp for nowait  #pragma omp for nowait
1410                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1=0; k1 < m_NE1; ++k1) {
1411                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
1412                          const register double* f_001 = in.getSampleDataRO(INDEX3(k0,k1,m_N2-1, m_N0,m_N1));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,m_N2-2, m_N0,m_N1)), numComp*sizeof(double));
1413                          const register double* f_101 = in.getSampleDataRO(INDEX3(k0+1,k1,m_N2-1, m_N0,m_N1));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));
1414                          const register double* f_011 = in.getSampleDataRO(INDEX3(k0,k1+1,m_N2-1, m_N0,m_N1));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,m_N2-2, m_N0,m_N1)), numComp*sizeof(double));
1415                          const register double* f_111 = in.getSampleDataRO(INDEX3(k0+1,k1+1,m_N2-1, m_N0,m_N1));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));
1416                          const register double* f_000 = in.getSampleDataRO(INDEX3(k0,k1,m_N2-2, m_N0,m_N1));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,m_N2-2, m_N0,m_N1)), numComp*sizeof(double));
1417                          const register double* f_110 = in.getSampleDataRO(INDEX3(k0+1,k1+1,m_N2-2, m_N0,m_N1));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));
1418                          const register double* f_010 = in.getSampleDataRO(INDEX3(k0,k1+1,m_N2-2, m_N0,m_N1));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,m_N2-2, m_N0,m_N1)), numComp*sizeof(double));
1419                          const register double* f_100 = in.getSampleDataRO(INDEX3(k0+1,k1,m_N2-2, m_N0,m_N1));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));
1420                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));
1421                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1422                              const double V0=((f_101[i]-f_001[i])*C6 + (f_111[i]-f_011[i])*C2) / h0;                              const double V0=((f_101[i]-f_001[i])*C6 + (f_111[i]-f_011[i])*C2) / h0;
# Line 600  void Brick::setToGradient(escript::Data& Line 1435  void Brick::setToGradient(escript::Data&
1435                              o[INDEX3(i,0,3,numComp,3)] = V1;                              o[INDEX3(i,0,3,numComp,3)] = V1;
1436                              o[INDEX3(i,1,3,numComp,3)] = V3;                              o[INDEX3(i,1,3,numComp,3)] = V3;
1437                              o[INDEX3(i,2,3,numComp,3)] = ((f_001[i]-f_000[i])*C0 + (f_111[i]-f_110[i])*C5 + (f_011[i]+f_101[i]-f_010[i]-f_100[i])*C1) / h2;                              o[INDEX3(i,2,3,numComp,3)] = ((f_001[i]-f_000[i])*C0 + (f_111[i]-f_110[i])*C5 + (f_011[i]+f_101[i]-f_010[i]-f_100[i])*C1) / h2;
1438                          } /* end of component loop i */                          } // end of component loop i
1439                      } /* end of k0 loop */                      } // end of k0 loop
1440                  } /* end of k1 loop */                  } // end of k1 loop
1441              } /* end of face 5 */              } // end of face 5
1442          } // end of parallel section          } // end of parallel section
         /* GENERATOR SNIP_GRAD_FACES BOTTOM */  
1443      } else if (out.getFunctionSpace().getTypeCode() == ReducedFaceElements) {      } else if (out.getFunctionSpace().getTypeCode() == ReducedFaceElements) {
1444          /*** GENERATOR SNIP_GRAD_REDUCED_FACES TOP */          out.requireWrite();
1445  #pragma omp parallel  #pragma omp parallel
1446          {          {
1447                vector<double> f_000(numComp);
1448                vector<double> f_001(numComp);
1449                vector<double> f_010(numComp);
1450                vector<double> f_011(numComp);
1451                vector<double> f_100(numComp);
1452                vector<double> f_101(numComp);
1453                vector<double> f_110(numComp);
1454                vector<double> f_111(numComp);
1455              if (m_faceOffset[0] > -1) {              if (m_faceOffset[0] > -1) {
1456  #pragma omp for nowait  #pragma omp for nowait
1457                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE2; ++k2) {
1458                      for (index_t k1=0; k1 < m_NE1; ++k1) {                      for (index_t k1=0; k1 < m_NE1; ++k1) {
1459                          const register double* f_000 = in.getSampleDataRO(INDEX3(0,k1,k2, m_N0,m_N1));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(0,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
1460                          const register double* f_001 = in.getSampleDataRO(INDEX3(0,k1,k2+1, m_N0,m_N1));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(0,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1461                          const register double* f_101 = in.getSampleDataRO(INDEX3(1,k1,k2+1, m_N0,m_N1));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(0,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
1462                          const register double* f_011 = in.getSampleDataRO(INDEX3(0,k1+1,k2+1, m_N0,m_N1));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(0,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1463                          const register double* f_100 = in.getSampleDataRO(INDEX3(1,k1,k2, m_N0,m_N1));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(1,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
1464                          const register double* f_110 = in.getSampleDataRO(INDEX3(1,k1+1,k2, m_N0,m_N1));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(1,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1465                          const register double* f_010 = in.getSampleDataRO(INDEX3(0,k1+1,k2, m_N0,m_N1));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(1,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
1466                          const register double* f_111 = in.getSampleDataRO(INDEX3(1,k1+1,k2+1, m_N0,m_N1));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(1,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1467                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));
1468                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1469                              o[INDEX3(i,0,0,numComp,3)] = (f_100[i]+f_101[i]+f_110[i]+f_111[i]-f_000[i]-f_001[i]-f_010[i]-f_011[i])*C3 / h0;                              o[INDEX3(i,0,0,numComp,3)] = (f_100[i]+f_101[i]+f_110[i]+f_111[i]-f_000[i]-f_001[i]-f_010[i]-f_011[i])*C3 / h0;
1470                              o[INDEX3(i,1,0,numComp,3)] = (f_010[i]+f_011[i]-f_000[i]-f_001[i])*C4 / h1;                              o[INDEX3(i,1,0,numComp,3)] = (f_010[i]+f_011[i]-f_000[i]-f_001[i])*C4 / h1;
1471                              o[INDEX3(i,2,0,numComp,3)] = (f_001[i]+f_011[i]-f_000[i]-f_010[i])*C4 / h2;                              o[INDEX3(i,2,0,numComp,3)] = (f_001[i]+f_011[i]-f_000[i]-f_010[i])*C4 / h2;
1472                          } /* end of component loop i */                          } // end of component loop i
1473                      } /* end of k1 loop */                      } // end of k1 loop
1474                  } /* end of k2 loop */                  } // end of k2 loop
1475              } /* end of face 0 */              } // end of face 0
1476              if (m_faceOffset[1] > -1) {              if (m_faceOffset[1] > -1) {
1477  #pragma omp for nowait  #pragma omp for nowait
1478                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE2; ++k2) {
1479                      for (index_t k1=0; k1 < m_NE1; ++k1) {                      for (index_t k1=0; k1 < m_NE1; ++k1) {
1480                          const register double* f_000 = in.getSampleDataRO(INDEX3(m_N0-2,k1,k2, m_N0,m_N1));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(m_N0-2,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
1481                          const register double* f_001 = in.getSampleDataRO(INDEX3(m_N0-2,k1,k2+1, m_N0,m_N1));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(m_N0-2,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1482                          const register double* f_101 = in.getSampleDataRO(INDEX3(m_N0-1,k1,k2+1, m_N0,m_N1));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(m_N0-2,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
1483                          const register double* f_011 = in.getSampleDataRO(INDEX3(m_N0-2,k1+1,k2+1, m_N0,m_N1));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(m_N0-2,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1484                          const register double* f_100 = in.getSampleDataRO(INDEX3(m_N0-1,k1,k2, m_N0,m_N1));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(m_N0-1,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
1485                          const register double* f_110 = in.getSampleDataRO(INDEX3(m_N0-1,k1+1,k2, m_N0,m_N1));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(m_N0-1,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1486                          const register double* f_010 = in.getSampleDataRO(INDEX3(m_N0-2,k1+1,k2, m_N0,m_N1));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(m_N0-1,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
1487                          const register double* f_111 = in.getSampleDataRO(INDEX3(m_N0-1,k1+1,k2+1, m_N0,m_N1));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(m_N0-1,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1488                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));
1489                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1490                              o[INDEX3(i,0,0,numComp,3)] = (f_100[i]+f_101[i]+f_110[i]+f_111[i]-f_000[i]-f_001[i]-f_010[i]-f_011[i])*C3 / h0;                              o[INDEX3(i,0,0,numComp,3)] = (f_100[i]+f_101[i]+f_110[i]+f_111[i]-f_000[i]-f_001[i]-f_010[i]-f_011[i])*C3 / h0;
1491                              o[INDEX3(i,1,0,numComp,3)] = (f_110[i]+f_111[i]-f_100[i]-f_101[i])*C4 / h1;                              o[INDEX3(i,1,0,numComp,3)] = (f_110[i]+f_111[i]-f_100[i]-f_101[i])*C4 / h1;
1492                              o[INDEX3(i,2,0,numComp,3)] = (f_101[i]+f_111[i]-f_100[i]-f_110[i])*C4 / h2;                              o[INDEX3(i,2,0,numComp,3)] = (f_101[i]+f_111[i]-f_100[i]-f_110[i])*C4 / h2;
1493                          } /* end of component loop i */                          } // end of component loop i
1494                      } /* end of k1 loop */                      } // end of k1 loop
1495                  } /* end of k2 loop */                  } // end of k2 loop
1496              } /* end of face 1 */              } // end of face 1
1497              if (m_faceOffset[2] > -1) {              if (m_faceOffset[2] > -1) {
1498  #pragma omp for nowait  #pragma omp for nowait
1499                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE2; ++k2) {
1500                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
1501                          const register double* f_000 = in.getSampleDataRO(INDEX3(k0,0,k2, m_N0,m_N1));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,0,k2, m_N0,m_N1)), numComp*sizeof(double));
1502                          const register double* f_001 = in.getSampleDataRO(INDEX3(k0,0,k2+1, m_N0,m_N1));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,0,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1503                          const register double* f_101 = in.getSampleDataRO(INDEX3(k0+1,0,k2+1, m_N0,m_N1));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,1,k2, m_N0,m_N1)), numComp*sizeof(double));
1504                          const register double* f_100 = in.getSampleDataRO(INDEX3(k0+1,0,k2, m_N0,m_N1));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1505                          const register double* f_011 = in.getSampleDataRO(INDEX3(k0,1,k2+1, m_N0,m_N1));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,0,k2, m_N0,m_N1)), numComp*sizeof(double));
1506                          const register double* f_110 = in.getSampleDataRO(INDEX3(k0+1,1,k2, m_N0,m_N1));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,0,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1507                          const register double* f_010 = in.getSampleDataRO(INDEX3(k0,1,k2, m_N0,m_N1));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,1,k2, m_N0,m_N1)), numComp*sizeof(double));
1508                          const register double* f_111 = in.getSampleDataRO(INDEX3(k0+1,1,k2+1, m_N0,m_N1));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1509                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));
1510                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1511                              o[INDEX3(i,0,0,numComp,3)] = (f_100[i]+f_101[i]-f_000[i]-f_001[i])*C4 / h0;                              o[INDEX3(i,0,0,numComp,3)] = (f_100[i]+f_101[i]-f_000[i]-f_001[i])*C4 / h0;
1512                              o[INDEX3(i,1,0,numComp,3)] = (f_010[i]+f_011[i]+f_110[i]+f_111[i]-f_000[i]-f_001[i]-f_100[i]-f_101[i])*C3 / h1;                              o[INDEX3(i,1,0,numComp,3)] = (f_010[i]+f_011[i]+f_110[i]+f_111[i]-f_000[i]-f_001[i]-f_100[i]-f_101[i])*C3 / h1;
1513                              o[INDEX3(i,2,0,numComp,3)] = (f_001[i]+f_101[i]-f_000[i]-f_100[i])*C4 / h2;                              o[INDEX3(i,2,0,numComp,3)] = (f_001[i]+f_101[i]-f_000[i]-f_100[i])*C4 / h2;
1514                          } /* end of component loop i */                          } // end of component loop i
1515                      } /* end of k0 loop */                      } // end of k0 loop
1516                  } /* end of k2 loop */                  } // end of k2 loop
1517              } /* end of face 2 */              } // end of face 2
1518              if (m_faceOffset[3] > -1) {              if (m_faceOffset[3] > -1) {
1519  #pragma omp for nowait  #pragma omp for nowait
1520                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE2; ++k2) {
1521                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
1522                          const register double* f_011 = in.getSampleDataRO(INDEX3(k0,m_N1-1,k2+1, m_N0,m_N1));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,m_N1-2,k2, m_N0,m_N1)), numComp*sizeof(double));
1523                          const register double* f_110 = in.getSampleDataRO(INDEX3(k0+1,m_N1-1,k2, m_N0,m_N1));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,m_N1-2,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1524                          const register double* f_010 = in.getSampleDataRO(INDEX3(k0,m_N1-1,k2, m_N0,m_N1));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,m_N1-1,k2, m_N0,m_N1)), numComp*sizeof(double));
1525                          const register double* f_111 = in.getSampleDataRO(INDEX3(k0+1,m_N1-1,k2+1, m_N0,m_N1));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,m_N1-1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1526                          const register double* f_000 = in.getSampleDataRO(INDEX3(k0,m_N1-2,k2, m_N0,m_N1));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-2,k2, m_N0,m_N1)), numComp*sizeof(double));
1527                          const register double* f_101 = in.getSampleDataRO(INDEX3(k0+1,m_N1-2,k2+1, m_N0,m_N1));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-2,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1528                          const register double* f_001 = in.getSampleDataRO(INDEX3(k0,m_N1-2,k2+1, m_N0,m_N1));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-1,k2, m_N0,m_N1)), numComp*sizeof(double));
1529                          const register double* f_100 = in.getSampleDataRO(INDEX3(k0+1,m_N1-2,k2, m_N0,m_N1));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1530                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));
1531                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1532                              o[INDEX3(i,0,0,numComp,3)] = (f_110[i]+f_111[i]-f_010[i]-f_011[i])*C4 / h0;                              o[INDEX3(i,0,0,numComp,3)] = (f_110[i]+f_111[i]-f_010[i]-f_011[i])*C4 / h0;
1533                              o[INDEX3(i,1,0,numComp,3)] = (f_010[i]+f_011[i]+f_110[i]+f_111[i]-f_000[i]-f_001[i]-f_100[i]-f_101[i])*C3 / h1;                              o[INDEX3(i,1,0,numComp,3)] = (f_010[i]+f_011[i]+f_110[i]+f_111[i]-f_000[i]-f_001[i]-f_100[i]-f_101[i])*C3 / h1;
1534                              o[INDEX3(i,2,0,numComp,3)] = (f_011[i]+f_111[i]-f_010[i]-f_110[i])*C4 / h2;                              o[INDEX3(i,2,0,numComp,3)] = (f_011[i]+f_111[i]-f_010[i]-f_110[i])*C4 / h2;
1535                          } /* end of component loop i */                          } // end of component loop i
1536                      } /* end of k0 loop */                      } // end of k0 loop
1537                  } /* end of k2 loop */                  } // end of k2 loop
1538              } /* end of face 3 */              } // end of face 3
1539              if (m_faceOffset[4] > -1) {              if (m_faceOffset[4] > -1) {
1540  #pragma omp for nowait  #pragma omp for nowait
1541                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1=0; k1 < m_NE1; ++k1) {
1542                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
1543                          const register double* f_000 = in.getSampleDataRO(INDEX3(k0,k1,0, m_N0,m_N1));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,0, m_N0,m_N1)), numComp*sizeof(double));
1544                          const register double* f_100 = in.getSampleDataRO(INDEX3(k0+1,k1,0, m_N0,m_N1));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,1, m_N0,m_N1)), numComp*sizeof(double));
1545                          const register double* f_110 = in.getSampleDataRO(INDEX3(k0+1,k1+1,0, m_N0,m_N1));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,0, m_N0,m_N1)), numComp*sizeof(double));
1546                          const register double* f_010 = in.getSampleDataRO(INDEX3(k0,k1+1,0, m_N0,m_N1));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,1, m_N0,m_N1)), numComp*sizeof(double));
1547                          const register double* f_001 = in.getSampleDataRO(INDEX3(k0,k1,1, m_N0,m_N1));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,0, m_N0,m_N1)), numComp*sizeof(double));
1548                          const register double* f_101 = in.getSampleDataRO(INDEX3(k0+1,k1,1, m_N0,m_N1));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,1, m_N0,m_N1)), numComp*sizeof(double));
1549                          const register double* f_011 = in.getSampleDataRO(INDEX3(k0,k1+1,1, m_N0,m_N1));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,0, m_N0,m_N1)), numComp*sizeof(double));
1550                          const register double* f_111 = in.getSampleDataRO(INDEX3(k0+1,k1+1,1, m_N0,m_N1));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,1, m_N0,m_N1)), numComp*sizeof(double));
1551                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));
1552                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1553                              o[INDEX3(i,0,0,numComp,3)] = (f_100[i]+f_110[i]-f_000[i]-f_010[i])*C4 / h0;                              o[INDEX3(i,0,0,numComp,3)] = (f_100[i]+f_110[i]-f_000[i]-f_010[i])*C4 / h0;
1554                              o[INDEX3(i,1,0,numComp,3)] = (f_010[i]+f_110[i]-f_000[i]-f_100[i])*C4 / h1;                              o[INDEX3(i,1,0,numComp,3)] = (f_010[i]+f_110[i]-f_000[i]-f_100[i])*C4 / h1;
1555                              o[INDEX3(i,2,0,numComp,3)] = (f_001[i]+f_011[i]+f_101[i]+f_111[i]-f_000[i]-f_010[i]-f_100[i]-f_110[i])*C4 / h2;                              o[INDEX3(i,2,0,numComp,3)] = (f_001[i]+f_011[i]+f_101[i]+f_111[i]-f_000[i]-f_010[i]-f_100[i]-f_110[i])*C4 / h2;
1556                          } /* end of component loop i */                          } // end of component loop i
1557                      } /* end of k0 loop */                      } // end of k0 loop
1558                  } /* end of k1 loop */                  } // end of k1 loop
1559              } /* end of face 4 */              } // end of face 4
1560              if (m_faceOffset[5] > -1) {              if (m_faceOffset[5] > -1) {
1561  #pragma omp for nowait  #pragma omp for nowait
1562                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1=0; k1 < m_NE1; ++k1) {
1563                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
1564                          const register double* f_001 = in.getSampleDataRO(INDEX3(k0,k1,m_N2-1, m_N0,m_N1));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,m_N2-2, m_N0,m_N1)), numComp*sizeof(double));
1565                          const register double* f_101 = in.getSampleDataRO(INDEX3(k0+1,k1,m_N2-1, m_N0,m_N1));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));
1566                          const register double* f_011 = in.getSampleDataRO(INDEX3(k0,k1+1,m_N2-1, m_N0,m_N1));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,m_N2-2, m_N0,m_N1)), numComp*sizeof(double));
1567                          const register double* f_111 = in.getSampleDataRO(INDEX3(k0+1,k1+1,m_N2-1, m_N0,m_N1));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));
1568                          const register double* f_000 = in.getSampleDataRO(INDEX3(k0,k1,m_N2-2, m_N0,m_N1));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,m_N2-2, m_N0,m_N1)), numComp*sizeof(double));
1569                          const register double* f_100 = in.getSampleDataRO(INDEX3(k0+1,k1,m_N2-2, m_N0,m_N1));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));
1570                          const register double* f_110 = in.getSampleDataRO(INDEX3(k0+1,k1+1,m_N2-2, m_N0,m_N1));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,m_N2-2, m_N0,m_N1)), numComp*sizeof(double));
1571                          const register double* f_010 = in.getSampleDataRO(INDEX3(k0,k1+1,m_N2-2, m_N0,m_N1));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));
1572                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));
1573                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1574                              o[INDEX3(i,0,0,numComp,3)] = (f_101[i]+f_111[i]-f_001[i]-f_011[i])*C4 / h0;                              o[INDEX3(i,0,0,numComp,3)] = (f_101[i]+f_111[i]-f_001[i]-f_011[i])*C4 / h0;
1575                              o[INDEX3(i,1,0,numComp,3)] = (f_011[i]+f_111[i]-f_001[i]-f_101[i])*C4 / h1;                              o[INDEX3(i,1,0,numComp,3)] = (f_011[i]+f_111[i]-f_001[i]-f_101[i])*C4 / h1;
1576                              o[INDEX3(i,2,0,numComp,3)] = (f_001[i]+f_011[i]+f_101[i]+f_111[i]-f_000[i]-f_010[i]-f_100[i]-f_110[i])*C3 / h2;                              o[INDEX3(i,2,0,numComp,3)] = (f_001[i]+f_011[i]+f_101[i]+f_111[i]-f_000[i]-f_010[i]-f_100[i]-f_110[i])*C3 / h2;
1577                          } /* end of component loop i */                          } // end of component loop i
1578                      } /* end of k0 loop */                      } // end of k0 loop
1579                  } /* end of k1 loop */                  } // end of k1 loop
1580              } /* end of face 5 */              } // end of face 5
1581          } // end of parallel section          } // end of parallel section
         /* GENERATOR SNIP_GRAD_REDUCED_FACES BOTTOM */  
     } else {  
         stringstream msg;  
         msg << "setToGradient() not implemented for "  
             << functionSpaceTypeAsString(out.getFunctionSpace().getTypeCode());  
         throw RipleyException(msg.str());  
1582      }      }
1583  }  }
1584    
1585  void Brick::setToIntegrals(vector<double>& integrals, const escript::Data& arg) const  //protected
1586    void Brick::assembleIntegrate(vector<double>& integrals, escript::Data& arg) const
1587  {  {
1588      escript::Data& in = *const_cast<escript::Data*>(&arg);      const dim_t numComp = arg.getDataPointSize();
     const dim_t numComp = in.getDataPointSize();  
1589      const double h0 = m_l0/m_gNE0;      const double h0 = m_l0/m_gNE0;
1590      const double h1 = m_l1/m_gNE1;      const double h1 = m_l1/m_gNE1;
1591      const double h2 = m_l2/m_gNE2;      const double h2 = m_l2/m_gNE2;
1592      if (arg.getFunctionSpace().getTypeCode() == Elements) {      const index_t left = (m_offset0==0 ? 0 : 1);
1593        const index_t bottom = (m_offset1==0 ? 0 : 1);
1594        const index_t front = (m_offset2==0 ? 0 : 1);
1595        const int fs = arg.getFunctionSpace().getTypeCode();
1596        if (fs == Elements && arg.actsExpanded()) {
1597          const double w_0 = h0*h1*h2/8.;          const double w_0 = h0*h1*h2/8.;
1598  #pragma omp parallel  #pragma omp parallel
1599          {          {
1600              vector<double> int_local(numComp, 0);              vector<double> int_local(numComp, 0);
1601  #pragma omp for nowait  #pragma omp for nowait
1602              for (index_t k2 = 0; k2 < m_NE2; ++k2) {              for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {
1603                  for (index_t k1 = 0; k1 < m_NE1; ++k1) {                  for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {
1604                      for (index_t k0 = 0; k0 < m_NE0; ++k0) {                      for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {
1605                          const double* f = in.getSampleDataRO(INDEX3(k0, k1, k2, m_NE0, m_NE1));                          const double* f = arg.getSampleDataRO(INDEX3(k0, k1, k2, m_NE0, m_NE1));
1606                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1607                              const register double f_0 = f[INDEX2(i,0,numComp)];                              const double f_0 = f[INDEX2(i,0,numComp)];
1608                              const register double f_1 = f[INDEX2(i,1,numComp)];                              const double f_1 = f[INDEX2(i,1,numComp)];
1609                              const register double f_2 = f[INDEX2(i,2,numComp)];                              const double f_2 = f[INDEX2(i,2,numComp)];
1610                              const register double f_3 = f[INDEX2(i,3,numComp)];                              const double f_3 = f[INDEX2(i,3,numComp)];
1611                              const register double f_4 = f[INDEX2(i,4,numComp)];                              const double f_4 = f[INDEX2(i,4,numComp)];
1612                              const register double f_5 = f[INDEX2(i,5,numComp)];                              const double f_5 = f[INDEX2(i,5,numComp)];
1613                              const register double f_6 = f[INDEX2(i,6,numComp)];                              const double f_6 = f[INDEX2(i,6,numComp)];
1614                              const register double f_7 = f[INDEX2(i,7,numComp)];                              const double f_7 = f[INDEX2(i,7,numComp)];
1615                              int_local[i]+=(f_0+f_1+f_2+f_3+f_4+f_5+f_6+f_7)*w_0;                              int_local[i]+=(f_0+f_1+f_2+f_3+f_4+f_5+f_6+f_7)*w_0;
1616                          }  /* end of component loop i */                          }  // end of component loop i
1617                      } /* end of k0 loop */                      } // end of k0 loop
1618                  } /* end of k1 loop */                  } // end of k1 loop
1619              } /* end of k2 loop */              } // end of k2 loop
1620    
1621  #pragma omp critical  #pragma omp critical
1622              for (index_t i=0; i<numComp; i++)              for (index_t i=0; i<numComp; i++)
1623                  integrals[i]+=int_local[i];                  integrals[i]+=int_local[i];
1624          } // end of parallel section          } // end of parallel section
1625      } else if (arg.getFunctionSpace().getTypeCode() == ReducedElements) {  
1626        } else if (fs==ReducedElements || (fs==Elements && !arg.actsExpanded())) {
1627          const double w_0 = h0*h1*h2;          const double w_0 = h0*h1*h2;
1628  #pragma omp parallel  #pragma omp parallel
1629          {          {
1630              vector<double> int_local(numComp, 0);              vector<double> int_local(numComp, 0);
1631  #pragma omp for nowait  #pragma omp for nowait
1632              for (index_t k2 = 0; k2 < m_NE2; ++k2) {              for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {
1633                  for (index_t k1 = 0; k1 < m_NE1; ++k1) {                  for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {
1634                      for (index_t k0 = 0; k0 < m_NE0; ++k0) {                      for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {
1635                          const double* f = in.getSampleDataRO(INDEX3(k0, k1, k2, m_NE0, m_NE1));                          const double* f = arg.getSampleDataRO(INDEX3(k0, k1, k2, m_NE0, m_NE1));
1636                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1637                              int_local[i]+=f[i]*w_0;                              int_local[i]+=f[i]*w_0;
1638                          }  /* end of component loop i */                          }  // end of component loop i
1639                      } /* end of k0 loop */                      } // end of k0 loop
1640                  } /* end of k1 loop */                  } // end of k1 loop
1641              } /* end of k2 loop */              } // end of k2 loop
1642    
1643  #pragma omp critical  #pragma omp critical
1644              for (index_t i=0; i<numComp; i++)              for (index_t i=0; i<numComp; i++)
1645                  integrals[i]+=int_local[i];                  integrals[i]+=int_local[i];
1646          } // end of parallel section          } // end of parallel section
1647      } else if (arg.getFunctionSpace().getTypeCode() == FaceElements) {  
1648        } else if (fs == FaceElements && arg.actsExpanded()) {
1649          const double w_0 = h1*h2/4.;          const double w_0 = h1*h2/4.;
1650          const double w_1 = h0*h2/4.;          const double w_1 = h0*h2/4.;
1651          const double w_2 = h0*h1/4.;          const double w_2 = h0*h1/4.;
# Line 812  void Brick::setToIntegrals(vector<double Line 1654  void Brick::setToIntegrals(vector<double
1654              vector<double> int_local(numComp, 0);              vector<double> int_local(numComp, 0);
1655              if (m_faceOffset[0] > -1) {              if (m_faceOffset[0] > -1) {
1656  #pragma omp for nowait  #pragma omp for nowait
1657                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {
1658                      for (index_t k1=0; k1 < m_NE1; ++k1) {                      for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {
1659                          const double* f = in.getSampleDataRO(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));                          const double* f = arg.getSampleDataRO(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));
1660                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1661                              const register double f_0 = f[INDEX2(i,0,numComp)];                              const double f_0 = f[INDEX2(i,0,numComp)];
1662                              const register double f_1 = f[INDEX2(i,1,numComp)];                              const double f_1 = f[INDEX2(i,1,numComp)];
1663                              const register double f_2 = f[INDEX2(i,2,numComp)];                              const double f_2 = f[INDEX2(i,2,numComp)];
1664                              const register double f_3 = f[INDEX2(i,3,numComp)];                              const double f_3 = f[INDEX2(i,3,numComp)];
1665                              int_local[i]+=(f_0+f_1+f_2+f_3)*w_0;                              int_local[i]+=(f_0+f_1+f_2+f_3)*w_0;
1666                          }  /* end of component loop i */                          }  // end of component loop i
1667                      } /* end of k1 loop */                      } // end of k1 loop
1668                  } /* end of k2 loop */                  } // end of k2 loop
1669              }              }
1670    
1671              if (m_faceOffset[1] > -1) {              if (m_faceOffset[1] > -1) {
1672  #pragma omp for nowait  #pragma omp for nowait
1673                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {
1674                      for (index_t k1=0; k1 < m_NE1; ++k1) {                      for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {
1675                          const double* f = in.getSampleDataRO(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));                          const double* f = arg.getSampleDataRO(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));
1676                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1677                              const register double f_0 = f[INDEX2(i,0,numComp)];                              const double f_0 = f[INDEX2(i,0,numComp)];
1678                              const register double f_1 = f[INDEX2(i,1,numComp)];                              const double f_1 = f[INDEX2(i,1,numComp)];
1679                              const register double f_2 = f[INDEX2(i,2,numComp)];                              const double f_2 = f[INDEX2(i,2,numComp)];
1680                              const register double f_3 = f[INDEX2(i,3,numComp)];                              const double f_3 = f[INDEX2(i,3,numComp)];
1681                              int_local[i]+=(f_0+f_1+f_2+f_3)*w_0;                              int_local[i]+=(f_0+f_1+f_2+f_3)*w_0;
1682                          }  /* end of component loop i */                          }  // end of component loop i
1683                      } /* end of k1 loop */                      } // end of k1 loop
1684                  } /* end of k2 loop */                  } // end of k2 loop
1685              }              }
1686    
1687              if (m_faceOffset[2] > -1) {              if (m_faceOffset[2] > -1) {
1688  #pragma omp for nowait  #pragma omp for nowait
1689                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {
1690                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {
1691                          const double* f = in.getSampleDataRO(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));                          const double* f = arg.getSampleDataRO(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));
1692                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1693                              const register double f_0 = f[INDEX2(i,0,numComp)];                              const double f_0 = f[INDEX2(i,0,numComp)];
1694                              const register double f_1 = f[INDEX2(i,1,numComp)];                              const double f_1 = f[INDEX2(i,1,numComp)];
1695                              const register double f_2 = f[INDEX2(i,2,numComp)];                              const double f_2 = f[INDEX2(i,2,numComp)];
1696                              const register double f_3 = f[INDEX2(i,3,numComp)];                              const double f_3 = f[INDEX2(i,3,numComp)];
1697                              int_local[i]+=(f_0+f_1+f_2+f_3)*w_1;                              int_local[i]+=(f_0+f_1+f_2+f_3)*w_1;
1698                          }  /* end of component loop i */                          }  // end of component loop i
1699                      } /* end of k1 loop */                      } // end of k1 loop
1700                  } /* end of k2 loop */                  } // end of k2 loop
1701              }              }
1702    
1703              if (m_faceOffset[3] > -1) {              if (m_faceOffset[3] > -1) {
1704  #pragma omp for nowait  #pragma omp for nowait
1705                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {
1706                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {
1707                          const double* f = in.getSampleDataRO(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));                          const double* f = arg.getSampleDataRO(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));
1708                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1709                              const register double f_0 = f[INDEX2(i,0,numComp)];                              const double f_0 = f[INDEX2(i,0,numComp)];
1710                              const register double f_1 = f[INDEX2(i,1,numComp)];                              const double f_1 = f[INDEX2(i,1,numComp)];
1711                              const register double f_2 = f[INDEX2(i,2,numComp)];                              const double f_2 = f[INDEX2(i,2,numComp)];
1712                              const register double f_3 = f[INDEX2(i,3,numComp)];                              const double f_3 = f[INDEX2(i,3,numComp)];
1713                              int_local[i]+=(f_0+f_1+f_2+f_3)*w_1;                              int_local[i]+=(f_0+f_1+f_2+f_3)*w_1;
1714                          }  /* end of component loop i */                          }  // end of component loop i
1715                      } /* end of k1 loop */                      } // end of k1 loop
1716                  } /* end of k2 loop */                  } // end of k2 loop
1717              }              }
1718    
1719              if (m_faceOffset[4] > -1) {              if (m_faceOffset[4] > -1) {
1720  #pragma omp for nowait  #pragma omp for nowait
1721                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {
1722                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {
1723                          const double* f = in.getSampleDataRO(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));                          const double* f = arg.getSampleDataRO(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));
1724                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1725                              const register double f_0 = f[INDEX2(i,0,numComp)];                              const double f_0 = f[INDEX2(i,0,numComp)];
1726                              const register double f_1 = f[INDEX2(i,1,numComp)];                              const double f_1 = f[INDEX2(i,1,numComp)];
1727                              const register double f_2 = f[INDEX2(i,2,numComp)];                              const double f_2 = f[INDEX2(i,2,numComp)];
1728                              const register double f_3 = f[INDEX2(i,3,numComp)];                              const double f_3 = f[INDEX2(i,3,numComp)];
1729                              int_local[i]+=(f_0+f_1+f_2+f_3)*w_2;                              int_local[i]+=(f_0+f_1+f_2+f_3)*w_2;
1730                          }  /* end of component loop i */                          }  // end of component loop i
1731                      } /* end of k1 loop */                      } // end of k1 loop
1732                  } /* end of k2 loop */                  } // end of k2 loop
1733              }              }
1734    
1735              if (m_faceOffset[5] > -1) {              if (m_faceOffset[5] > -1) {
1736  #pragma omp for nowait  #pragma omp for nowait
1737                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {
1738                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {
1739                          const double* f = in.getSampleDataRO(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));                          const double* f = arg.getSampleDataRO(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));
1740                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1741                              const register double f_0 = f[INDEX2(i,0,numComp)];                              const double f_0 = f[INDEX2(i,0,numComp)];
1742                              const register double f_1 = f[INDEX2(i,1,numComp)];                              const double f_1 = f[INDEX2(i,1,numComp)];
1743                              const register double f_2 = f[INDEX2(i,2,numComp)];                              const double f_2 = f[INDEX2(i,2,numComp)];
1744                              const register double f_3 = f[INDEX2(i,3,numComp)];                              const double f_3 = f[INDEX2(i,3,numComp)];
1745                              int_local[i]+=(f_0+f_1+f_2+f_3)*w_2;                              int_local[i]+=(f_0+f_1+f_2+f_3)*w_2;
1746                          }  /* end of component loop i */                          }  // end of component loop i
1747                      } /* end of k1 loop */                      } // end of k1 loop
1748                  } /* end of k2 loop */                  } // end of k2 loop
1749              }              }
1750    
1751  #pragma omp critical  #pragma omp critical
# Line 911  void Brick::setToIntegrals(vector<double Line 1753  void Brick::setToIntegrals(vector<double
1753                  integrals[i]+=int_local[i];                  integrals[i]+=int_local[i];
1754          } // end of parallel section          } // end of parallel section
1755    
1756      } else if (arg.getFunctionSpace().getTypeCode() == ReducedFaceElements) {      } else if (fs==ReducedFaceElements || (fs==FaceElements && !arg.actsExpanded())) {
1757          const double w_0 = h1*h2;          const double w_0 = h1*h2;
1758          const double w_1 = h0*h2;          const double w_1 = h0*h2;
1759          const double w_2 = h0*h1;          const double w_2 = h0*h1;
# Line 920  void Brick::setToIntegrals(vector<double Line 1762  void Brick::setToIntegrals(vector<double
1762              vector<double> int_local(numComp, 0);              vector<double> int_local(numComp, 0);
1763              if (m_faceOffset[0] > -1) {              if (m_faceOffset[0] > -1) {
1764  #pragma omp for nowait  #pragma omp for nowait
1765                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {
1766                      for (index_t k1=0; k1 < m_NE1; ++k1) {                      for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {
1767                          const double* f = in.getSampleDataRO(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));                          const double* f = arg.getSampleDataRO(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));
1768                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1769                              int_local[i]+=f[i]*w_0;                              int_local[i]+=f[i]*w_0;
1770                          }  /* end of component loop i */                          }  // end of component loop i
1771                      } /* end of k1 loop */                      } // end of k1 loop
1772                  } /* end of k2 loop */                  } // end of k2 loop
1773              }              }
1774    
1775              if (m_faceOffset[1] > -1) {              if (m_faceOffset[1] > -1) {
1776  #pragma omp for nowait  #pragma omp for nowait
1777                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {
1778                      for (index_t k1=0; k1 < m_NE1; ++k1) {                      for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {
1779                          const double* f = in.getSampleDataRO(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));                          const double* f = arg.getSampleDataRO(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));
1780                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1781                              int_local[i]+=f[i]*w_0;                              int_local[i]+=f[i]*w_0;
1782                          }  /* end of component loop i */                          }  // end of component loop i
1783                      } /* end of k1 loop */                      } // end of k1 loop
1784                  } /* end of k2 loop */                  } // end of k2 loop
1785              }              }
1786    
1787              if (m_faceOffset[2] > -1) {              if (m_faceOffset[2] > -1) {
1788  #pragma omp for nowait  #pragma omp for nowait
1789                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {
1790                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {
1791                          const double* f = in.getSampleDataRO(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));                          const double* f = arg.getSampleDataRO(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));
1792                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1793                              int_local[i]+=f[i]*w_1;                              int_local[i]+=f[i]*w_1;
1794                          }  /* end of component loop i */                          }  // end of component loop i
1795                      } /* end of k1 loop */                      } // end of k1 loop
1796                  } /* end of k2 loop */                  } // end of k2 loop
1797              }              }
1798    
1799              if (m_faceOffset[3] > -1) {              if (m_faceOffset[3] > -1) {
1800  #pragma omp for nowait  #pragma omp for nowait
1801                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {
1802                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {
1803                          const double* f = in.getSampleDataRO(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));                          const double* f = arg.getSampleDataRO(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));
1804                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1805                              int_local[i]+=f[i]*w_1;                              int_local[i]+=f[i]*w_1;
1806                          }  /* end of component loop i */                          }  // end of component loop i
1807                      } /* end of k1 loop */                      } // end of k1 loop
1808                  } /* end of k2 loop */                  } // end of k2 loop
1809              }              }
1810    
1811              if (m_faceOffset[4] > -1) {              if (m_faceOffset[4] > -1) {
1812  #pragma omp for nowait  #pragma omp for nowait
1813                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {
1814                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {
1815                          const double* f = in.getSampleDataRO(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));                          const double* f = arg.getSampleDataRO(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));
1816                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1817                              int_local[i]+=f[i]*w_2;                              int_local[i]+=f[i]*w_2;
1818                          }  /* end of component loop i */                          }  // end of component loop i
1819                      } /* end of k1 loop */                      } // end of k1 loop
1820                  } /* end of k2 loop */                  } // end of k2 loop
1821              }              }
1822    
1823              if (m_faceOffset[5] > -1) {              if (m_faceOffset[5] > -1) {
1824  #pragma omp for nowait  #pragma omp for nowait
1825                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {
1826                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {
1827                          const double* f = in.getSampleDataRO(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));                          const double* f = arg.getSampleDataRO(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));
1828                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1829                              int_local[i]+=f[i]*w_2;                              int_local[i]+=f[i]*w_2;
1830                          }  /* end of component loop i */                          }  // end of component loop i
1831                      } /* end of k1 loop */                      } // end of k1 loop
1832                  } /* end of k2 loop */                  } // end of k2 loop
1833              }              }
1834    
1835  #pragma omp critical  #pragma omp critical
1836              for (index_t i=0; i<numComp; i++)              for (index_t i=0; i<numComp; i++)
1837                  integrals[i]+=int_local[i];                  integrals[i]+=int_local[i];
1838          } // end of parallel section          } // end of parallel section
1839        } // function space selector
     } else {  
         stringstream msg;  
         msg << "setToIntegrals() not implemented for "  
             << functionSpaceTypeAsString(arg.getFunctionSpace().getTypeCode());  
         throw RipleyException(msg.str());  
     }  
1840  }  }
1841    
1842  void Brick::setToNormal(escript::Data& out) const  //protected
1843    dim_t Brick::insertNeighbourNodes(IndexVector& index, index_t node) const
1844  {  {
1845      if (out.getFunctionSpace().getTypeCode() == FaceElements) {      const dim_t nDOF0 = (m_gNE0+1)/m_NX;
1846  #pragma omp parallel      const dim_t nDOF1 = (m_gNE1+1)/m_NY;
1847          {      const dim_t nDOF2 = (m_gNE2+1)/m_NZ;
1848              if (m_faceOffset[0] > -1) {      const int x=node%nDOF0;
1849  #pragma omp for nowait      const int y=node%(nDOF0*nDOF1)/nDOF0;
1850                  for (index_t k2 = 0; k2 < m_NE2; ++k2) {      const int z=node/(nDOF0*nDOF1);
1851                      for (index_t k1 = 0; k1 < m_NE1; ++k1) {      int num=0;
1852                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));      // loop through potential neighbours and add to index if positions are
1853                          // set vector at four quadrature points      // within bounds
1854                          *o++ = -1.; *o++ = 0.; *o++ = 0.;      for (int i2=-1; i2<2; i2++) {
1855                          *o++ = -1.; *o++ = 0.; *o++ = 0.;          for (int i1=-1; i1<2; i1++) {
1856                          *o++ = -1.; *o++ = 0.; *o++ = 0.;              for (int i0=-1; i0<2; i0++) {
1857                          *o++ = -1.; *o++ = 0.; *o = 0.;                  // skip node itself
1858                      }                  if (i0==0 && i1==0 && i2==0)
1859                  }                      continue;
1860              }                  // location of neighbour node
1861                    const int nx=x+i0;
1862              if (m_faceOffset[1] > -1) {                  const int ny=y+i1;
1863  #pragma omp for nowait                  const int nz=z+i2;
1864                  for (index_t k2 = 0; k2 < m_NE2; ++k2) {                  if (nx>=0 && ny>=0 && nz>=0
1865                      for (index_t k1 = 0; k1 < m_NE1; ++k1) {                          && nx<nDOF0 && ny<nDOF1 && nz<nDOF2) {
1866                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));                      index.push_back(nz*nDOF0*nDOF1+ny*nDOF0+nx);
1867                          // set vector at four quadrature points                      num++;
                         *o++ = 1.; *o++ = 0.; *o++ = 0.;  
                         *o++ = 1.; *o++ = 0.; *o++ = 0.;  
                         *o++ = 1.; *o++ = 0.; *o++ = 0.;  
                         *o++ = 1.; *o++ = 0.; *o = 0.;  
                     }  
                 }  
             }  
   
             if (m_faceOffset[2] > -1) {  
 #pragma omp for nowait  
                 for (index_t k2 = 0; k2 < m_NE2; ++k2) {  
                     for (index_t k0 = 0; k0 < m_NE0; ++k0) {  
                         double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));  
                         // set vector at four quadrature points  
                         *o++ = 0.; *o++ = -1.; *o++ = 0.;  
                         *o++ = 0.; *o++ = -1.; *o++ = 0.;  
                         *o++ = 0.; *o++ = -1.; *o++ = 0.;  
                         *o++ = 0.; *o++ = -1.; *o = 0.;  
                     }  
                 }  
             }  
   
             if (m_faceOffset[3] > -1) {  
 #pragma omp for nowait  
                 for (index_t k2 = 0; k2 < m_NE2; ++k2) {  
                     for (index_t k0 = 0; k0 < m_NE0; ++k0) {  
                         double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));  
                         // set vector at four quadrature points  
                         *o++ = 0.; *o++ = 1.; *o++ = 0.;  
                         *o++ = 0.; *o++ = 1.; *o++ = 0.;  
                         *o++ = 0.; *o++ = 1.; *o++ = 0.;  
                         *o++ = 0.; *o++ = 1.; *o = 0.;  
                     }  
                 }  
             }  
   
             if (m_faceOffset[4] > -1) {  
 #pragma omp for nowait  
                 for (index_t k1 = 0; k1 < m_NE1; ++k1) {  
                     for (index_t k0 = 0; k0 < m_NE0; ++k0) {  
                         double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));  
                         // set vector at four quadrature points  
                         *o++ = 0.; *o++ = 0.; *o++ = -1.;  
                         *o++ = 0.; *o++ = 0.; *o++ = -1.;  
                         *o++ = 0.; *o++ = 0.; *o++ = -1.;  
                         *o++ = 0.; *o++ = 0.; *o = -1.;  
                     }  
                 }  
             }  
   
             if (m_faceOffset[5] > -1) {  
 #pragma omp for nowait  
                 for (index_t k1 = 0; k1 < m_NE1; ++k1) {  
                     for (index_t k0 = 0; k0 < m_NE0; ++k0) {  
                         double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));  
                         // set vector at four quadrature points  
                         *o++ = 0.; *o++ = 0.; *o++ = 1.;  
                         *o++ = 0.; *o++ = 0.; *o++ = 1.;  
                         *o++ = 0.; *o++ = 0.; *o++ = 1.;  
                         *o++ = 0.; *o++ = 0.; *o = 1.;  
                     }  
                 }  
             }  
         } // end of parallel section  
     } else if (out.getFunctionSpace().getTypeCode() == ReducedFaceElements) {  
 #pragma omp parallel  
         {  
             if (m_faceOffset[0] > -1) {  
 #pragma omp for nowait  
                 for (index_t k2 = 0; k2 < m_NE2; ++k2) {  
                     for (index_t k1 = 0; k1 < m_NE1; ++k1) {  
                         double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));  
                         *o++ = -1.;  
                         *o++ = 0.;  
                         *o = 0.;  
                     }  
                 }  
             }  
   
             if (m_faceOffset[1] > -1) {  
 #pragma omp for nowait  
                 for (index_t k2 = 0; k2 < m_NE2; ++k2) {  
                     for (index_t k1 = 0; k1 < m_NE1; ++k1) {  
                         double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));  
                         *o++ = 1.;  
                         *o++ = 0.;  
                         *o = 0.;  
                     }  
1868                  }                  }
1869              }              }
   
             if (m_faceOffset[2] > -1) {  
 #pragma omp for nowait  
                 for (index_t k2 = 0; k2 < m_NE2; ++k2) {  
                     for (index_t k0 = 0; k0 < m_NE0; ++k0) {  
                         double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));  
                         *o++ = 0.;  
                         *o++ = -1.;  
                         *o = 0.;  
                     }  
                 }  
             }  
   
             if (m_faceOffset[3] > -1) {  
 #pragma omp for nowait  
                 for (index_t k2 = 0; k2 < m_NE2; ++k2) {  
                     for (index_t k0 = 0; k0 < m_NE0; ++k0) {  
                         double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));  
                         *o++ = 0.;  
                         *o++ = 1.;  
                         *o = 0.;  
                     }  
                 }  
             }  
   
             if (m_faceOffset[4] > -1) {  
 #pragma omp for nowait  
                 for (index_t k1 = 0; k1 < m_NE1; ++k1) {  
                     for (index_t k0 = 0; k0 < m_NE0; ++k0) {  
                         double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));  
                         *o++ = 0.;  
                         *o++ = 0.;  
                         *o = -1.;  
                     }  
                 }  
             }  
   
             if (m_faceOffset[5] > -1) {  
 #pragma omp for nowait  
                 for (index_t k1 = 0; k1 < m_NE1; ++k1) {  
                     for (index_t k0 = 0; k0 < m_NE0; ++k0) {  
                         double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));  
                         *o++ = 0.;  
                         *o++ = 0.;  
                         *o = 1.;  
                     }  
                 }  
             }  
         } // end of parallel section  
   
     } else {  
         stringstream msg;  
         msg << "setToNormal() not implemented for "  
             << functionSpaceTypeAsString(out.getFunctionSpace().getTypeCode());  
         throw RipleyException(msg.str());  
     }  
 }  
   
 Paso_SystemMatrixPattern* Brick::getPattern(bool reducedRowOrder,  
                                             bool reducedColOrder) const  
 {  
     if (reducedRowOrder || reducedColOrder)  
         throw RipleyException("getPattern() not implemented for reduced order");  
   
     throw RipleyException("getPattern() not implemented");  
 }  
   
 void Brick::Print_Mesh_Info(const bool full) const  
 {  
     RipleyDomain::Print_Mesh_Info(full);  
     if (full) {  
         cout << "     Id  Coordinates" << endl;  
         cout.precision(15);  
         cout.setf(ios::scientific, ios::floatfield);  
         pair<double,double> xdx = getFirstCoordAndSpacing(0);  
         pair<double,double> ydy = getFirstCoordAndSpacing(1);  
         pair<double,double> zdz = getFirstCoordAndSpacing(2);  
         for (index_t i=0; i < getNumNodes(); i++) {  
             cout << "  " << setw(5) << m_nodeId[i]  
                 << "  " << xdx.first+(i%m_N0)*xdx.second  
                 << "  " << ydy.first+(i%(m_N0*m_N1)/m_N0)*ydy.second  
                 << "  " << zdz.first+(i/(m_N0*m_N1))*zdz.second << endl;  
1870          }          }
1871      }      }
 }  
1872    
1873  IndexVector Brick::getNumNodesPerDim() const      return num;
 {  
     IndexVector ret;  
     ret.push_back(m_N0);  
     ret.push_back(m_N1);  
     ret.push_back(m_N2);  
     return ret;  
 }  
   
 IndexVector Brick::getNumElementsPerDim() const  
 {  
     IndexVector ret;  
     ret.push_back(m_NE0);  
     ret.push_back(m_NE1);  
     ret.push_back(m_NE2);  
     return ret;  
 }  
   
 IndexVector Brick::getNumFacesPerBoundary() const  
 {  
     IndexVector ret(6, 0);  
     //left  
     if (m_offset0==0)  
         ret[0]=m_NE1*m_NE2;  
     //right  
     if (m_mpiInfo->rank%m_NX==m_NX-1)  
         ret[1]=m_NE1*m_NE2;  
     //bottom  
     if (m_offset1==0)  
         ret[2]=m_NE0*m_NE2;  
     //top  
     if (m_mpiInfo->rank%(m_NX*m_NY)/m_NX==m_NY-1)  
         ret[3]=m_NE0*m_NE2;  
     //front  
     if (m_offset2==0)  
         ret[4]=m_NE0*m_NE1;  
     //back  
     if (m_mpiInfo->rank/(m_NX*m_NY)==m_NZ-1)  
         ret[5]=m_NE0*m_NE1;  
     return ret;  
 }  
   
 pair<double,double> Brick::getFirstCoordAndSpacing(dim_t dim) const  
 {  
     if (dim==0)  
         return pair<double,double>((m_l0*m_offset0)/m_gNE0, m_l0/m_gNE0);  
     else if (dim==1)  
         return pair<double,double>((m_l1*m_offset1)/m_gNE1, m_l1/m_gNE1);  
     else if (dim==2)  
         return pair<double,double>((m_l2*m_offset2)/m_gNE2, m_l2/m_gNE2);  
   
     throw RipleyException("getFirstCoordAndSpacing(): invalid argument");  
1874  }  }
1875    
1876  //protected  //protected
1877  dim_t Brick::getNumDOF() const  void Brick::nodesToDOF(escript::Data& out, escript::Data& in) const
1878  {  {
1879      return (m_gNE0+1)/m_NX*(m_gNE1+1)/m_NY*(m_gNE2+1)/m_NZ;      const dim_t numComp = in.getDataPointSize();
1880  }      out.requireWrite();
1881    
1882  //protected      const index_t left = (m_offset0==0 ? 0 : 1);
1883  dim_t Brick::getNumFaceElements() const      const index_t bottom = (m_offset1==0 ? 0 : 1);
1884  {      const index_t front = (m_offset2==0 ? 0 : 1);
1885      const IndexVector faces = getNumFacesPerBoundary();      const dim_t nDOF0 = (m_gNE0+1)/m_NX;
1886      dim_t n=0;      const dim_t nDOF1 = (m_gNE1+1)/m_NY;
1887      for (size_t i=0; i<faces.size(); i++)      const dim_t nDOF2 = (m_gNE2+1)/m_NZ;
1888          n+=faces[i];  #pragma omp parallel for
1889      return n;      for (index_t i=0; i<nDOF2; i++) {
1890            for (index_t j=0; j<nDOF1; j++) {
1891                for (index_t k=0; k<nDOF0; k++) {
1892                    const index_t n=k+left+(j+bottom)*m_N0+(i+front)*m_N0*m_N1;
1893                    const double* src=in.getSampleDataRO(n);
1894                    copy(src, src+numComp, out.getSampleDataRW(k+j*nDOF0+i*nDOF0*nDOF1));
1895                }
1896            }
1897        }
1898  }  }
1899    
1900  //protected  //protected
1901  void Brick::assembleCoordinates(escript::Data& arg) const  void Brick::dofToNodes(escript::Data& out, escript::Data& in) const
1902  {  {
1903      escriptDataC x = arg.getDataC();      const dim_t numComp = in.getDataPointSize();
1904      int numDim = m_numDim;      Paso_Coupler* coupler = Paso_Coupler_alloc(m_connector, numComp);
1905      if (!isDataPointShapeEqual(&x, 1, &numDim))      in.requireWrite();
1906          throw RipleyException("setToX: Invalid Data object shape");      Paso_Coupler_startCollect(coupler, in.getSampleDataRW(0));
1907      if (!numSamplesEqual(&x, 1, getNumNodes()))  
1908          throw RipleyException("setToX: Illegal number of samples in Data object");      const dim_t numDOF = getNumDOF();
1909        out.requireWrite();
1910        const double* buffer = Paso_Coupler_finishCollect(coupler);
1911    
     pair<double,double> xdx = getFirstCoordAndSpacing(0);  
     pair<double,double> ydy = getFirstCoordAndSpacing(1);  
     pair<double,double> zdz = getFirstCoordAndSpacing(2);  
     arg.requireWrite();  
1912  #pragma omp parallel for  #pragma omp parallel for
1913      for (dim_t i2 = 0; i2 < m_N2; i2++) {      for (index_t i=0; i<getNumNodes(); i++) {
1914          for (dim_t i1 = 0; i1 < m_N1; i1++) {          const double* src=(m_dofMap[i]<numDOF ?
1915              for (dim_t i0 = 0; i0 < m_N0; i0++) {                  in.getSampleDataRO(m_dofMap[i])
1916                  double* point = arg.getSampleDataRW(i0+m_N0*i1+m_N0*m_N1*i2);                  : &buffer[(m_dofMap[i]-numDOF)*numComp]);
1917                  point[0] = xdx.first+i0*xdx.second;          copy(src, src+numComp, out.getSampleDataRW(i));
                 point[1] = ydy.first+i1*ydy.second;  
                 point[2] = zdz.first+i2*zdz.second;  
             }  
         }  
1918      }      }
1919        Paso_Coupler_free(coupler);
1920  }  }
1921    
1922  //private  //private
# Line 1308  void Brick::populateSampleIds() Line 1926  void Brick::populateSampleIds()
1926      // globally      // globally
1927    
1928      // build node distribution vector first.      // build node distribution vector first.
1929      // rank i owns m_nodeDistribution[i+1]-nodeDistribution[i] nodes      // rank i owns m_nodeDistribution[i+1]-nodeDistribution[i] nodes which is
1930        // constant for all ranks in this implementation
1931      m_nodeDistribution.assign(m_mpiInfo->size+1, 0);      m_nodeDistribution.assign(m_mpiInfo->size+1, 0);
1932      const dim_t numDOF=getNumDOF();      const dim_t numDOF=getNumDOF();
1933      for (dim_t k=1; k<m_mpiInfo->size; k++) {      for (dim_t k=1; k<m_mpiInfo->size; k++) {
# Line 1342  void Brick::populateSampleIds() Line 1961  void Brick::populateSampleIds()
1961    
1962          // elements          // elements
1963  #pragma omp for nowait  #pragma omp for nowait
1964          for (dim_t k=0; k<getNumElements(); k++)          for (dim_t i2=0; i2<m_NE2; i2++) {
1965              m_elementId[k]=k;              for (dim_t i1=0; i1<m_NE1; i1++) {
1966                    for (dim_t i0=0; i0<m_NE0; i0++) {
1967                        m_elementId[i0+i1*m_NE0+i2*m_NE0*m_NE1] =
1968                            (m_offset2+i2)*m_gNE0*m_gNE1
1969                            +(m_offset1+i1)*m_gNE0
1970                            +m_offset0+i0;
1971                    }
1972                }
1973            }
1974    
1975          // face elements          // face elements
1976  #pragma omp for  #pragma omp for
# Line 1380  void Brick::populateSampleIds() Line 2007  void Brick::populateSampleIds()
2007      updateTagsInUse(FaceElements);      updateTagsInUse(FaceElements);
2008  }  }
2009    
2010    //private
2011    void Brick::createPattern()
2012    {
2013        const dim_t nDOF0 = (m_gNE0+1)/m_NX;
2014        const dim_t nDOF1 = (m_gNE1+1)/m_NY;
2015        const dim_t nDOF2 = (m_gNE2+1)/m_NZ;
2016        const index_t left = (m_offset0==0 ? 0 : 1);
2017        const index_t bottom = (m_offset1==0 ? 0 : 1);
2018        const index_t front = (m_offset2==0 ? 0 : 1);
2019    
2020        // populate node->DOF mapping with own degrees of freedom.
2021        // The rest is assigned in the loop further down
2022        m_dofMap.assign(getNumNodes(), 0);
2023    #pragma omp parallel for
2024        for (index_t i=front; i<front+nDOF2; i++) {
2025            for (index_t j=bottom; j<bottom+nDOF1; j++) {
2026                for (index_t k=left; k<left+nDOF0; k++) {
2027                    m_dofMap[i*m_N0*m_N1+j*m_N0+k]=(i-front)*nDOF0*nDOF1+(j-bottom)*nDOF0+k-left;
2028                }
2029            }
2030        }
2031    
2032        // build list of shared components and neighbours by looping through
2033        // all potential neighbouring ranks and checking if positions are
2034        // within bounds
2035        const dim_t numDOF=nDOF0*nDOF1*nDOF2;
2036        vector<IndexVector> colIndices(numDOF); // for the couple blocks
2037        RankVector neighbour;
2038        IndexVector offsetInShared(1,0);
2039        IndexVector sendShared, recvShared;
2040        int numShared=0;
2041        const int x=m_mpiInfo->rank%m_NX;
2042        const int y=m_mpiInfo->rank%(m_NX*m_NY)/m_NX;
2043        const int z=m_mpiInfo->rank/(m_NX*m_NY);
2044        for (int i2=-1; i2<2; i2++) {
2045            for (int i1=-1; i1<2; i1++) {
2046                for (int i0=-1; i0<2; i0++) {
2047                    // skip this rank
2048                    if (i0==0 && i1==0 && i2==0)
2049                        continue;
2050                    // location of neighbour rank
2051                    const int nx=x+i0;
2052                    const int ny=y+i1;
2053                    const int nz=z+i2;
2054                    if (nx>=0 && ny>=0 && nz>=0 && nx<m_NX && ny<m_NY && nz<m_NZ) {
2055                        neighbour.push_back(nz*m_NX*m_NY+ny*m_NX+nx);
2056                        if (i0==0 && i1==0) {
2057                            // sharing front or back plane
2058                            offsetInShared.push_back(offsetInShared.back()+nDOF0*nDOF1);
2059                            for (dim_t i=0; i<nDOF1; i++) {
2060                                const int firstDOF=(i2==-1 ? i*nDOF0
2061                                        : i*nDOF0 + nDOF0*nDOF1*(nDOF2-1));
2062                                const int firstNode=(i2==-1 ? left+(i+bottom)*m_N0
2063                                        : left+(i+bottom)*m_N0+m_N0*m_N1*(m_N2-1));
2064                                for (dim_t j=0; j<nDOF0; j++, numShared++) {
2065                                    sendShared.push_back(firstDOF+j);
2066                                    recvShared.push_back(numDOF+numShared);
2067                                    if (j>0) {
2068                                        if (i>0)
2069                                            colIndices[firstDOF+j-1-nDOF0].push_back(numShared);
2070                                        colIndices[firstDOF+j-1].push_back(numShared);
2071                                        if (i<nDOF1-1)
2072                                            colIndices[firstDOF+j-1+nDOF0].push_back(numShared);
2073                                    }
2074                                    if (i>0)
2075                                        colIndices[firstDOF+j-nDOF0].push_back(numShared);
2076                                    colIndices[firstDOF+j].push_back(numShared);
2077                                    if (i<nDOF1-1)
2078                                        colIndices[firstDOF+j+nDOF0].push_back(numShared);
2079                                    if (j<nDOF0-1) {
2080                                        if (i>0)
2081                                            colIndices[firstDOF+j+1-nDOF0].push_back(numShared);
2082                                        colIndices[firstDOF+j+1].push_back(numShared);
2083                                        if (i<nDOF1-1)
2084                                            colIndices[firstDOF+j+1+nDOF0].push_back(numShared);
2085                                    }
2086                                    m_dofMap[firstNode+j]=numDOF+numShared;
2087                                }
2088                            }
2089                        } else if (i0==0 && i2==0) {
2090                            // sharing top or bottom plane
2091                            offsetInShared.push_back(offsetInShared.back()+nDOF0*nDOF2);
2092                            for (dim_t i=0; i<nDOF2; i++) {
2093                                const int firstDOF=(i1==-1 ? i*nDOF0*nDOF1
2094                                        : nDOF0*((i+1)*nDOF1-1));
2095                                const int firstNode=(i1==-1 ?
2096                                        left+(i+front)*m_N0*m_N1
2097                                        : left+m_N0*((i+1+front)*m_N1-1));
2098                                for (dim_t j=0; j<nDOF0; j++, numShared++) {
2099                                    sendShared.push_back(firstDOF+j);
2100                                    recvShared.push_back(numDOF+numShared);
2101                                    if (j>0) {
2102                                        if (i>0)
2103                                            colIndices[firstDOF+j-1-nDOF0*nDOF1].push_back(numShared);
2104                                        colIndices[firstDOF+j-1].push_back(numShared);
2105                                        if (i<nDOF2-1)
2106                                            colIndices[firstDOF+j-1+nDOF0*nDOF1].push_back(numShared);
2107                                    }
2108                                    if (i>0)
2109                                        colIndices[firstDOF+j-nDOF0*nDOF1].push_back(numShared);
2110                                    colIndices[firstDOF+j].push_back(numShared);
2111                                    if (i<nDOF2-1)
2112                                        colIndices[firstDOF+j+nDOF0*nDOF1].push_back(numShared);
2113                                    if (j<nDOF0-1) {
2114                                        if (i>0)
2115                                            colIndices[firstDOF+j+1-nDOF0*nDOF1].push_back(numShared);
2116                                        colIndices[firstDOF+j+1].push_back(numShared);
2117                                        if (i<nDOF2-1)
2118                                            colIndices[firstDOF+j+1+nDOF0*nDOF1].push_back(numShared);
2119                                    }
2120                                    m_dofMap[firstNode+j]=numDOF+numShared;
2121                                }
2122                            }
2123                        } else if (i1==0 && i2==0) {
2124                            // sharing left or right plane
2125                            offsetInShared.push_back(offsetInShared.back()+nDOF1*nDOF2);
2126                            for (dim_t i=0; i<nDOF2; i++) {
2127                                const int firstDOF=(i0==-1 ? i*nDOF0*nDOF1
2128                                        : nDOF0*(1+i*nDOF1)-1);
2129                                const int firstNode=(i0==-1 ?
2130                                        (bottom+(i+front)*m_N1)*m_N0
2131                                        : (bottom+1+(i+front)*m_N1)*m_N0-1);
2132                                for (dim_t j=0; j<nDOF1; j++, numShared++) {
2133                                    sendShared.push_back(firstDOF+j*nDOF0);
2134                                    recvShared.push_back(numDOF+numShared);
2135                                    if (j>0) {
2136                                        if (i>0)
2137                                            colIndices[firstDOF+(j-1)*nDOF0-nDOF0*nDOF1].push_back(numShared);
2138                                        colIndices[firstDOF+(j-1)*nDOF0].push_back(numShared);
2139                                        if (i<nDOF2-1)
2140                                            colIndices[firstDOF+(j-1)*nDOF0+nDOF0*nDOF1].push_back(numShared);
2141                                    }
2142                                    if (i>0)
2143                                        colIndices[firstDOF+j*nDOF0-nDOF0*nDOF1].push_back(numShared);
2144                                    colIndices[firstDOF+j*nDOF0].push_back(numShared);
2145                                    if (i<nDOF2-1)
2146                                        colIndices[firstDOF+j*nDOF0+nDOF0*nDOF1].push_back(numShared);
2147                                    if (j<nDOF1-1) {
2148                                        if (i>0)
2149                                            colIndices[firstDOF+(j+1)*nDOF0-nDOF0*nDOF1].push_back(numShared);
2150                                        colIndices[firstDOF+(j+1)*nDOF0].push_back(numShared);
2151                                        if (i<nDOF2-1)
2152                                            colIndices[firstDOF+(j+1)*nDOF0+nDOF0*nDOF1].push_back(numShared);
2153                                    }
2154                                    m_dofMap[firstNode+j*m_N0]=numDOF+numShared;
2155                                }
2156                            }
2157                        } else if (i0==0) {
2158                            // sharing an edge in x direction
2159                            offsetInShared.push_back(offsetInShared.back()+nDOF0);
2160                            const int firstDOF=(i1+1)/2*nDOF0*(nDOF1-1)
2161                                               +(i2+1)/2*nDOF0*nDOF1*(nDOF2-1);
2162                            const int firstNode=left+(i1+1)/2*m_N0*(m_N1-1)
2163                                                +(i2+1)/2*m_N0*m_N1*(m_N2-1);
2164                            for (dim_t i=0; i<nDOF0; i++, numShared++) {
2165                                sendShared.push_back(firstDOF+i);
2166                                recvShared.push_back(numDOF+numShared);
2167                                if (i>0)
2168                                    colIndices[firstDOF+i-1].push_back(numShared);
2169                                colIndices[firstDOF+i].push_back(numShared);
2170                                if (i<nDOF0-1)
2171                                    colIndices[firstDOF+i+1].push_back(numShared);
2172                                m_dofMap[firstNode+i]=numDOF+numShared;
2173                            }
2174                        } else if (i1==0) {
2175                            // sharing an edge in y direction
2176                            offsetInShared.push_back(offsetInShared.back()+nDOF1);
2177                            const int firstDOF=(i0+1)/2*(nDOF0-1)
2178                                               +(i2+1)/2*nDOF0*nDOF1*(nDOF2-1);
2179                            const int firstNode=bottom*m_N0
2180                                                +(i0+1)/2*(m_N0-1)
2181                                                +(i2+1)/2*m_N0*m_N1*(m_N2-1);
2182                            for (dim_t i=0; i<nDOF1; i++, numShared++) {
2183                                sendShared.push_back(firstDOF+i*nDOF0);
2184                                recvShared.push_back(numDOF+numShared);
2185                                if (i>0)
2186                                    colIndices[firstDOF+(i-1)*nDOF0].push_back(numShared);
2187                                colIndices[firstDOF+i*nDOF0].push_back(numShared);
2188                                if (i<nDOF1-1)
2189                                    colIndices[firstDOF+(i+1)*nDOF0].push_back(numShared);
2190                                m_dofMap[firstNode+i*m_N0]=numDOF+numShared;
2191                            }
2192                        } else if (i2==0) {
2193                            // sharing an edge in z direction
2194                            offsetInShared.push_back(offsetInShared.back()+nDOF2);
2195                            const int firstDOF=(i0+1)/2*(nDOF0-1)
2196                                               +(i1+1)/2*nDOF0*(nDOF1-1);
2197                            const int firstNode=front*m_N0*m_N1
2198                                                +(i0+1)/2*(m_N0-1)
2199                                                +(i1+1)/2*m_N0*(m_N1-1);
2200                            for (dim_t i=0; i<nDOF2; i++, numShared++) {
2201                                sendShared.push_back(firstDOF+i*nDOF0*nDOF1);
2202                                recvShared.push_back(numDOF+numShared);
2203                                if (i>0)
2204                                    colIndices[firstDOF+(i-1)*nDOF0*nDOF1].push_back(numShared);
2205                                colIndices[firstDOF+i*nDOF0*nDOF1].push_back(numShared);
2206                                if (i<nDOF2-1)
2207                                    colIndices[firstDOF+(i+1)*nDOF0*nDOF1].push_back(numShared);
2208                                m_dofMap[firstNode+i*m_N0*m_N1]=numDOF+numShared;
2209                            }
2210                        } else {
2211                            // sharing a node
2212                            const int dof=(i0+1)/2*(nDOF0-1)
2213                                          +(i1+1)/2*nDOF0*(nDOF1-1)
2214                                          +(i2+1)/2*nDOF0*nDOF1*(nDOF2-1);
2215                            const int node=(i0+1)/2*(m_N0-1)
2216                                           +(i1+1)/2*m_N0*(m_N1-1)
2217                                           +(i2+1)/2*m_N0*m_N1*(m_N2-1);
2218                            offsetInShared.push_back(offsetInShared.back()+1);
2219                            sendShared.push_back(dof);
2220                            recvShared.push_back(numDOF+numShared);
2221                            colIndices[dof].push_back(numShared);
2222                            m_dofMap[node]=numDOF+numShared;
2223                            ++numShared;
2224                        }
2225                    }
2226                }
2227            }
2228        }
2229    
2230        // create connector
2231        Paso_SharedComponents *snd_shcomp = Paso_SharedComponents_alloc(
2232                numDOF, neighbour.size(), &neighbour[0], &sendShared[0],
2233                &offsetInShared[0], 1, 0, m_mpiInfo);
2234        Paso_SharedComponents *rcv_shcomp = Paso_SharedComponents_alloc(
2235                numDOF, neighbour.size(), &neighbour[0], &recvShared[0],
2236                &offsetInShared[0], 1, 0, m_mpiInfo);
2237        m_connector = Paso_Connector_alloc(snd_shcomp, rcv_shcomp);
2238        Paso_SharedComponents_free(snd_shcomp);
2239        Paso_SharedComponents_free(rcv_shcomp);
2240    
2241        // create main and couple blocks
2242        Paso_Pattern *mainPattern = createMainPattern();
2243        Paso_Pattern *colPattern, *rowPattern;
2244        createCouplePatterns(colIndices, numShared, &colPattern, &rowPattern);
2245    
2246        // allocate paso distribution
2247        Paso_Distribution* distribution = Paso_Distribution_alloc(m_mpiInfo,
2248                const_cast<index_t*>(&m_nodeDistribution[0]), 1, 0);
2249    
2250        // finally create the system matrix
2251        m_pattern = Paso_SystemMatrixPattern_alloc(MATRIX_FORMAT_DEFAULT,
2252                distribution, distribution, mainPattern, colPattern, rowPattern,
2253                m_connector, m_connector);
2254    
2255        Paso_Distribution_free(distribution);
2256    
2257        // useful debug output
2258        /*
2259        cout << "--- rcv_shcomp ---" << endl;
2260        cout << "numDOF=" << numDOF << ", numNeighbors=" << neighbour.size() << endl;
2261        for (size_t i=0; i<neighbour.size(); i++) {
2262            cout << "neighbor[" << i << "]=" << neighbour[i]
2263                << " offsetInShared[" << i+1 << "]=" << offsetInShared[i+1] << endl;
2264        }
2265        for (size_t i=0; i<recvShared.size(); i++) {
2266            cout << "shared[" << i << "]=" << recvShared[i] << endl;
2267        }
2268        cout << "--- snd_shcomp ---" << endl;
2269        for (size_t i=0; i<sendShared.size(); i++) {
2270            cout << "shared[" << i << "]=" << sendShared[i] << endl;
2271        }
2272        cout << "--- dofMap ---" << endl;
2273        for (size_t i=0; i<m_dofMap.size(); i++) {
2274            cout << "m_dofMap[" << i << "]=" << m_dofMap[i] << endl;
2275        }
2276        cout << "--- colIndices ---" << endl;
2277        for (size_t i=0; i<colIndices.size(); i++) {
2278            cout << "colIndices[" << i << "].size()=" << colIndices[i].size() << endl;
2279        }
2280        */
2281    
2282        /*
2283        cout << "--- main_pattern ---" << endl;
2284        cout << "M=" << mainPattern->numOutput << ", N=" << mainPattern->numInput << endl;
2285        for (size_t i=0; i<mainPattern->numOutput+1; i++) {
2286            cout << "ptr[" << i << "]=" << mainPattern->ptr[i] << endl;
2287        }
2288        for (size_t i=0; i<mainPattern->ptr[mainPattern->numOutput]; i++) {
2289            cout << "index[" << i << "]=" << mainPattern->index[i] << endl;
2290        }
2291        */
2292    
2293        /*
2294        cout << "--- colCouple_pattern ---" << endl;
2295        cout << "M=" << colPattern->numOutput << ", N=" << colPattern->numInput << endl;
2296        for (size_t i=0; i<colPattern->numOutput+1; i++) {
2297            cout << "ptr[" << i << "]=" << colPattern->ptr[i] << endl;
2298        }
2299        for (size_t i=0; i<colPattern->ptr[colPattern->numOutput]; i++) {
2300            cout << "index[" << i << "]=" << colPattern->index[i] << endl;
2301        }
2302        */
2303    
2304        /*
2305        cout << "--- rowCouple_pattern ---" << endl;
2306        cout << "M=" << rowPattern->numOutput << ", N=" << rowPattern->numInput << endl;
2307        for (size_t i=0; i<rowPattern->numOutput+1; i++) {
2308            cout << "ptr[" << i << "]=" << rowPattern->ptr[i] << endl;
2309        }
2310        for (size_t i=0; i<rowPattern->ptr[rowPattern->numOutput]; i++) {
2311            cout << "index[" << i << "]=" << rowPattern->index[i] << endl;
2312        }
2313        */
2314    
2315        Paso_Pattern_free(mainPattern);
2316        Paso_Pattern_free(colPattern);
2317        Paso_Pattern_free(rowPattern);
2318    }
2319    
2320    //private
2321    void Brick::addToMatrixAndRHS(Paso_SystemMatrix* S, escript::Data& F,
2322             const vector<double>& EM_S, const vector<double>& EM_F, bool addS,
2323             bool addF, index_t firstNode, dim_t nEq, dim_t nComp) const
2324    {
2325        IndexVector rowIndex;
2326        rowIndex.push_back(m_dofMap[firstNode]);
2327        rowIndex.push_back(m_dofMap[firstNode+1]);
2328        rowIndex.push_back(m_dofMap[firstNode+m_N0]);
2329        rowIndex.push_back(m_dofMap[firstNode+m_N0+1]);
2330        rowIndex.push_back(m_dofMap[firstNode+m_N0*m_N1]);
2331        rowIndex.push_back(m_dofMap[firstNode+m_N0*m_N1+1]);
2332        rowIndex.push_back(m_dofMap[firstNode+m_N0*(m_N1+1)]);
2333        rowIndex.push_back(m_dofMap[firstNode+m_N0*(m_N1+1)+1]);
2334        if (addF) {
2335            double *F_p=F.getSampleDataRW(0);
2336            for (index_t i=0; i<rowIndex.size(); i++) {
2337                if (rowIndex[i]<getNumDOF()) {
2338                    for (index_t eq=0; eq<nEq; eq++) {
2339                        F_p[INDEX2(eq, rowIndex[i], nEq)]+=EM_F[INDEX2(eq,i,nEq)];
2340                    }
2341                }
2342            }
2343        }
2344        if (addS) {
2345            addToSystemMatrix(S, rowIndex, nEq, rowIndex, nComp, EM_S);
2346        }
2347    }
2348    
2349  //protected  //protected
2350  void Brick::interpolateNodesOnElements(escript::Data& out, escript::Data& in,  void Brick::interpolateNodesOnElements(escript::Data& out, escript::Data& in,
2351                                         bool reduced) const                                         bool reduced) const
2352  {  {
2353      const dim_t numComp = in.getDataPointSize();      const dim_t numComp = in.getDataPointSize();
2354      if (reduced) {      if (reduced) {
2355          /*** GENERATOR SNIP_INTERPOLATE_REDUCED_ELEMENTS TOP */          out.requireWrite();
2356          const double c0 = .125;          const double c0 = .125;
2357  #pragma omp parallel for  #pragma omp parallel
2358          for (index_t k2=0; k2 < m_NE2; ++k2) {          {
2359              for (index_t k1=0; k1 < m_NE1; ++k1) {              vector<double> f_000(numComp);
2360                  for (index_t k0=0; k0 < m_NE0; ++k0) {              vector<double> f_001(numComp);
2361                      const register double* f_000 = in.getSampleDataRO(INDEX3(k0,k1,k2, m_N0,m_N1));              vector<double> f_010(numComp);
2362                      const register double* f_001 = in.getSampleDataRO(INDEX3(k0,k1,k2+1, m_N0,m_N1));              vector<double> f_011(numComp);
2363                      const register double* f_101 = in.getSampleDataRO(INDEX3(k0+1,k1,k2+1, m_N0,m_N1));              vector<double> f_100(numComp);
2364                      const register double* f_011 = in.getSampleDataRO(INDEX3(k0,k1+1,k2+1, m_N0,m_N1));              vector<double> f_101(numComp);
2365                      const register double* f_100 = in.getSampleDataRO(INDEX3(k0+1,k1,k2, m_N0,m_N1));              vector<double> f_110(numComp);
2366                      const register double* f_110 = in.getSampleDataRO(INDEX3(k0+1,k1+1,k2, m_N0,m_N1));              vector<double> f_111(numComp);
2367                      const register double* f_010 = in.getSampleDataRO(INDEX3(k0,k1+1,k2, m_N0,m_N1));  #pragma omp for
2368                      const register double* f_111 = in.getSampleDataRO(INDEX3(k0+1,k1+1,k2+1, m_N0,m_N1));              for (index_t k2=0; k2 < m_NE2; ++k2) {
2369                      double* o = out.getSampleDataRW(INDEX3(k0,k1,k2,m_NE0,m_NE1));                  for (index_t k1=0; k1 < m_NE1; ++k1) {
2370                      for (index_t i=0; i < numComp; ++i) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
2371                          o[INDEX2(i,numComp,0)] = c0*(f_000[i] + f_001[i] + f_010[i] + f_011[i] + f_100[i] + f_101[i] + f_110[i] + f_111[i]);                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
2372                      } /* end of component loop i */                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2373                  } /* end of k0 loop */                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
2374              } /* end of k1 loop */                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2375          } /* end of k2 loop */                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
2376          /* GENERATOR SNIP_INTERPOLATE_REDUCED_ELEMENTS BOTTOM */                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2377                            memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
2378                            memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2379                            double* o = out.getSampleDataRW(INDEX3(k0,k1,k2,m_NE0,m_NE1));
2380                            for (index_t i=0; i < numComp; ++i) {
2381                                o[INDEX2(i,numComp,0)] = c0*(f_000[i] + f_001[i] + f_010[i] + f_011[i] + f_100[i] + f_101[i] + f_110[i] + f_111[i]);
2382                            } // end of component loop i
2383                        } // end of k0 loop
2384                    } // end of k1 loop
2385                } // end of k2 loop
2386            } // end of parallel section
2387      } else {      } else {
2388          /*** GENERATOR SNIP_INTERPOLATE_ELEMENTS TOP */          out.requireWrite();
2389          const double c0 = .0094373878376559314545;          const double c0 = .0094373878376559314545;
2390          const double c1 = .035220810900864519624;          const double c1 = .035220810900864519624;
2391          const double c2 = .13144585576580214704;          const double c2 = .13144585576580214704;
2392          const double c3 = .49056261216234406855;          const double c3 = .49056261216234406855;
2393  #pragma omp parallel for  #pragma omp parallel
2394          for (index_t k2=0; k2 < m_NE2; ++k2) {          {
2395              for (index_t k1=0; k1 < m_NE1; ++k1) {              vector<double> f_000(numComp);
2396                  for (index_t k0=0; k0 < m_NE0; ++k0) {              vector<double> f_001(numComp);
2397                      const register double* f_000 = in.getSampleDataRO(INDEX3(k0,k1,k2, m_N0,m_N1));              vector<double> f_010(numComp);
2398                      const register double* f_001 = in.getSampleDataRO(INDEX3(k0,k1,k2+1, m_N0,m_N1));              vector<double> f_011(numComp);
2399                      const register double* f_101 = in.getSampleDataRO(INDEX3(k0+1,k1,k2+1, m_N0,m_N1));              vector<double> f_100(numComp);
2400                      const register double* f_011 = in.getSampleDataRO(INDEX3(k0,k1+1,k2+1, m_N0,m_N1));              vector<double> f_101(numComp);
2401                      const register double* f_110 = in.getSampleDataRO(INDEX3(k0+1,k1+1,k2, m_N0,m_N1));              vector<double> f_110(numComp);
2402                      const register double* f_010 = in.getSampleDataRO(INDEX3(k0,k1+1,k2, m_N0,m_N1));              vector<double> f_111(numComp);
2403                      const register double* f_100 = in.getSampleDataRO(INDEX3(k0+1,k1,k2, m_N0,m_N1));  #pragma omp for
2404                      const register double* f_111 = in.getSampleDataRO(INDEX3(k0+1,k1+1,k2+1, m_N0,m_N1));              for (index_t k2=0; k2 < m_NE2; ++k2) {
2405                      double* o = out.getSampleDataRW(INDEX3(k0,k1,k2,m_NE0,m_NE1));                  for (index_t k1=0; k1 < m_NE1; ++k1) {
2406                      for (index_t i=0; i < numComp; ++i) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
2407                          o[INDEX2(i,numComp,0)] = f_000[i]*c3 + f_111[i]*c0 + c2*(f_001[i] + f_010[i] + f_100[i]) + c1*(f_011[i] + f_101[i] + f_110[i]);                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
2408                          o[INDEX2(i,numComp,1)] = f_011[i]*c0 + f_100[i]*c3 + c2*(f_000[i] + f_101[i] + f_110[i]) + c1*(f_001[i] + f_010[i] + f_111[i]);                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2409                          o[INDEX2(i,numComp,2)] = f_010[i]*c3 + f_101[i]*c0 + c2*(f_000[i] + f_011[i] + f_110[i]) + c1*(f_001[i] + f_100[i] + f_111[i]);                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
2410                          o[INDEX2(i,numComp,3)] = f_001[i]*c0 + f_110[i]*c3 + c2*(f_010[i] + f_100[i] + f_111[i]) + c1*(f_000[i] + f_011[i] + f_101[i]);                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2411                          o[INDEX2(i,numComp,4)] = f_001[i]*c3 + f_110[i]*c0 + c2*(f_000[i] + f_011[i] + f_101[i]) + c1*(f_010[i] + f_100[i] + f_111[i]);                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
2412                          o[INDEX2(i,numComp,5)] = f_010[i]*c0 + f_101[i]*c3 + c2*(f_001[i] + f_100[i] + f_111[i]) + c1*(f_000[i] + f_011[i] + f_110[i]);                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2413                          o[INDEX2(i,numComp,6)] = f_011[i]*c3 + f_100[i]*c0 + c2*(f_001[i] + f_010[i] + f_111[i]) + c1*(f_000[i] + f_101[i] + f_110[i]);                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
2414                          o[INDEX2(i,numComp,7)] = f_000[i]*c0 + f_111[i]*c3 + c2*(f_011[i] + f_101[i] + f_110[i]) + c1*(f_001[i] + f_010[i] + f_100[i]);                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2415                      } /* end of component loop i */                          double* o = out.getSampleDataRW(INDEX3(k0,k1,k2,m_NE0,m_NE1));
2416                  } /* end of k0 loop */                          for (index_t i=0; i < numComp; ++i) {
2417              } /* end of k1 loop */                              o[INDEX2(i,numComp,0)] = f_000[i]*c3 + f_111[i]*c0 + c2*(f_001[i] + f_010[i] + f_100[i]) + c1*(f_011[i] + f_101[i] + f_110[i]);
2418          } /* end of k2 loop */                              o[INDEX2(i,numComp,1)] = f_011[i]*c0 + f_100[i]*c3 + c2*(f_000[i] + f_101[i] + f_110[i]) + c1*(f_001[i] + f_010[i] + f_111[i]);
2419          /* GENERATOR SNIP_INTERPOLATE_ELEMENTS BOTTOM */                              o[INDEX2(i,numComp,2)] = f_010[i]*c3 + f_101[i]*c0 + c2*(f_000[i] + f_011[i] + f_110[i]) + c1*(f_001[i] + f_100[i] + f_111[i]);
2420                                o[INDEX2(i,numComp,3)] = f_001[i]*c0 + f_110[i]*c3 + c2*(f_010[i] + f_100[i] + f_111[i]) + c1*(f_000[i] + f_011[i] + f_101[i]);
2421                                o[INDEX2(i,numComp,4)] = f_001[i]*c3 + f_110[i]*c0 + c2*(f_000[i] + f_011[i] + f_101[i]) + c1*(f_010[i] + f_100[i] + f_111[i]);
2422                                o[INDEX2(i,numComp,5)] = f_010[i]*c0 + f_101[i]*c3 + c2*(f_001[i] + f_100[i] + f_111[i]) + c1*(f_000[i] + f_011[i] + f_110[i]);
2423                                o[INDEX2(i,numComp,6)] = f_011[i]*c3 + f_100[i]*c0 + c2*(f_001[i] + f_010[i] + f_111[i]) + c1*(f_000[i] + f_101[i] + f_110[i]);
2424                                o[INDEX2(i,numComp,7)] = f_000[i]*c0 + f_111[i]*c3 + c2*(f_011[i] + f_101[i] + f_110[i]) + c1*(f_001[i] + f_010[i] + f_100[i]);
2425                            } // end of component loop i
2426                        } // end of k0 loop
2427                    } // end of k1 loop
2428                } // end of k2 loop
2429            } // end of parallel section
2430      }      }
2431  }  }
2432    
# Line 1450  void Brick::interpolateNodesOnFaces(escr Line 2436  void Brick::interpolateNodesOnFaces(escr
2436  {  {
2437      const dim_t numComp = in.getDataPointSize();      const dim_t numComp = in.getDataPointSize();
2438      if (reduced) {      if (reduced) {
2439            out.requireWrite();
2440          const double c0 = .25;          const double c0 = .25;
2441  #pragma omp parallel  #pragma omp parallel
2442          {          {
2443              /*** GENERATOR SNIP_INTERPOLATE_REDUCED_FACES TOP */              vector<double> f_000(numComp);
2444                vector<double> f_001(numComp);
2445                vector<double> f_010(numComp);
2446                vector<double> f_011(numComp);
2447                vector<double> f_100(numComp);
2448                vector<double> f_101(numComp);
2449                vector<double> f_110(numComp);
2450                vector<double> f_111(numComp);
2451              if (m_faceOffset[0] > -1) {              if (m_faceOffset[0] > -1) {
2452  #pragma omp for nowait  #pragma omp for nowait
2453                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE2; ++k2) {
2454                      for (index_t k1=0; k1 < m_NE1; ++k1) {                      for (index_t k1=0; k1 < m_NE1; ++k1) {
2455                          const register double* f_011 = in.getSampleDataRO(INDEX3(0,k1+1,k2+1, m_N0,m_N1));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(0,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
2456                          const register double* f_010 = in.getSampleDataRO(INDEX3(0,k1+1,k2, m_N0,m_N1));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(0,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2457                          const register double* f_001 = in.getSampleDataRO(INDEX3(0,k1,k2+1, m_N0,m_N1));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(0,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
2458                          const register double* f_000 = in.getSampleDataRO(INDEX3(0,k1,k2, m_N0,m_N1));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(0,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2459                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));
2460                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2461                              o[INDEX2(i,numComp,0)] = c0*(f_000[i] + f_001[i] + f_010[i] + f_011[i]);                              o[INDEX2(i,numComp,0)] = c0*(f_000[i] + f_001[i] + f_010[i] + f_011[i]);
2462                          } /* end of component loop i */                          } // end of component loop i
2463                      } /* end of k1 loop */                      } // end of k1 loop
2464                  } /* end of k2 loop */                  } // end of k2 loop
2465              } /* end of face 0 */              } // end of face 0
2466              if (m_faceOffset[1] > -1) {              if (m_faceOffset[1] > -1) {
2467  #pragma omp for nowait  #pragma omp for nowait
2468                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE2; ++k2) {
2469                      for (index_t k1=0; k1 < m_NE1; ++k1) {                      for (index_t k1=0; k1 < m_NE1; ++k1) {
2470                          const register double* f_110 = in.getSampleDataRO(INDEX3(m_N0-1,k1+1,k2, m_N0,m_N1));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(m_N0-1,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
2471                          const register double* f_100 = in.getSampleDataRO(INDEX3(m_N0-1,k1,k2, m_N0,m_N1));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(m_N0-1,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2472                          const register double* f_101 = in.getSampleDataRO(INDEX3(m_N0-1,k1,k2+1, m_N0,m_N1));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(m_N0-1,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
2473                          const register double* f_111 = in.getSampleDataRO(INDEX3(m_N0-1,k1+1,k2+1, m_N0,m_N1));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(m_N0-1,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2474                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));
2475                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2476                              o[INDEX2(i,numComp,0)] = c0*(f_100[i] + f_101[i] + f_110[i] + f_111[i]);                              o[INDEX2(i,numComp,0)] = c0*(f_100[i] + f_101[i] + f_110[i] + f_111[i]);
2477                          } /* end of component loop i */                          } // end of component loop i
2478                      } /* end of k1 loop */                      } // end of k1 loop
2479                  } /* end of k2 loop */                  } // end of k2 loop
2480              } /* end of face 1 */              } // end of face 1
2481              if (m_faceOffset[2] > -1) {              if (m_faceOffset[2] > -1) {
2482  #pragma omp for nowait  #pragma omp for nowait
2483                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE2; ++k2) {
2484                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
2485                          const register double* f_000 = in.getSampleDataRO(INDEX3(k0,0,k2, m_N0,m_N1));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,0,k2, m_N0,m_N1)), numComp*sizeof(double));
2486                          const register double* f_001 = in.getSampleDataRO(INDEX3(k0,0,k2+1, m_N0,m_N1));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,0,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2487                          const register double* f_101 = in.getSampleDataRO(INDEX3(k0+1,0,k2+1, m_N0,m_N1));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,0,k2, m_N0,m_N1)), numComp*sizeof(double));
2488                          const register double* f_100 = in.getSampleDataRO(INDEX3(k0+1,0,k2, m_N0,m_N1));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,0,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2489                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));
2490                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2491                              o[INDEX2(i,numComp,0)] = c0*(f_000[i] + f_001[i] + f_100[i] + f_101[i]);                              o[INDEX2(i,numComp,0)] = c0*(f_000[i] + f_001[i] + f_100[i] + f_101[i]);
2492                          } /* end of component loop i */                          } // end of component loop i
2493                      } /* end of k0 loop */                      } // end of k0 loop
2494                  } /* end of k2 loop */                  } // end of k2 loop
2495              } /* end of face 2 */              } // end of face 2
2496              if (m_faceOffset[3] > -1) {              if (m_faceOffset[3] > -1) {
2497  #pragma omp for nowait  #pragma omp for nowait
2498                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE2; ++k2) {
2499                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
2500                          const register double* f_110 = in.getSampleDataRO(INDEX3(k0+1,m_N1-1,k2, m_N0,m_N1));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,m_N1-1,k2, m_N0,m_N1)), numComp*sizeof(double));
2501                          const register double* f_011 = in.getSampleDataRO(INDEX3(k0,m_N1-1,k2+1, m_N0,m_N1));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,m_N1-1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2502                          const register double* f_010 = in.getSampleDataRO(INDEX3(k0,m_N1-1,k2, m_N0,m_N1));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-1,k2, m_N0,m_N1)), numComp*sizeof(double));
2503                          const register double* f_111 = in.getSampleDataRO(INDEX3(k0+1,m_N1-1,k2+1, m_N0,m_N1));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2504                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));
2505                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2506                              o[INDEX2(i,numComp,0)] = c0*(f_010[i] + f_011[i] + f_110[i] + f_111[i]);                              o[INDEX2(i,numComp,0)] = c0*(f_010[i] + f_011[i] + f_110[i] + f_111[i]);
2507                          } /* end of component loop i */                          } // end of component loop i
2508                      } /* end of k0 loop */                      } // end of k0 loop
2509                  } /* end of k2 loop */                  } // end of k2 loop
2510              } /* end of face 3 */              } // end of face 3
2511              if (m_faceOffset[4] > -1) {              if (m_faceOffset[4] > -1) {
2512  #pragma omp for nowait  #pragma omp for nowait
2513                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1=0; k1 < m_NE1; ++k1) {
2514                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
2515                          const register double* f_110 = in.getSampleDataRO(INDEX3(k0+1,k1+1,0, m_N0,m_N1));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,0, m_N0,m_N1)), numComp*sizeof(double));
2516                          const register double* f_010 = in.getSampleDataRO(INDEX3(k0,k1+1,0, m_N0,m_N1));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,0, m_N0,m_N1)), numComp*sizeof(double));
2517                          const register double* f_100 = in.getSampleDataRO(INDEX3(k0+1,k1,0, m_N0,m_N1));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,0, m_N0,m_N1)), numComp*sizeof(double));
2518                          const register double* f_000 = in.getSampleDataRO(INDEX3(k0,k1,0, m_N0,m_N1));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,0, m_N0,m_N1)), numComp*sizeof(double));
2519                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));
2520                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2521                              o[INDEX2(i,numComp,0)] = c0*(f_000[i] + f_010[i] + f_100[i] + f_110[i]);                              o[INDEX2(i,numComp,0)] = c0*(f_000[i] + f_010[i] + f_100[i] + f_110[i]);
2522                          } /* end of component loop i */                          } // end of component loop i
2523                      } /* end of k0 loop */                      } // end of k0 loop
2524                  } /* end of k1 loop */                  } // end of k1 loop
2525              } /* end of face 4 */              } // end of face 4
2526              if (m_faceOffset[5] > -1) {              if (m_faceOffset[5] > -1) {
2527  #pragma omp for nowait  #pragma omp for nowait
2528                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1=0; k1 < m_NE1; ++k1) {
2529                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
2530                          const register double* f_011 = in.getSampleDataRO(INDEX3(k0,k1+1,m_N2-1, m_N0,m_N1));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));
2531                          const register double* f_001 = in.getSampleDataRO(INDEX3(k0,k1,m_N2-1, m_N0,m_N1));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));
2532                          const register double* f_101 = in.getSampleDataRO(INDEX3(k0+1,k1,m_N2-1, m_N0,m_N1));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));
2533                          const register double* f_111 = in.getSampleDataRO(INDEX3(k0+1,k1+1,m_N2-1, m_N0,m_N1));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));
2534                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));
2535                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2536                              o[INDEX2(i,numComp,0)] = c0*(f_001[i] + f_011[i] + f_101[i] + f_111[i]);                              o[INDEX2(i,numComp,0)] = c0*(f_001[i] + f_011[i] + f_101[i] + f_111[i]);
2537                          } /* end of component loop i */                          } // end of component loop i
2538                      } /* end of k0 loop */                      } // end of k0 loop
2539                  } /* end of k1 loop */                  } // end of k1 loop
2540              } /* end of face 5 */              } // end of face 5
             /* GENERATOR SNIP_INTERPOLATE_REDUCED_FACES BOTTOM */  
2541          } // end of parallel section          } // end of parallel section
2542      } else {      } else {
2543            out.requireWrite();
2544          const double c0 = 0.044658198738520451079;          const double c0 = 0.044658198738520451079;
2545          const double c1 = 0.16666666666666666667;          const double c1 = 0.16666666666666666667;
2546          const double c2 = 0.62200846792814621559;          const double c2 = 0.62200846792814621559;
2547  #pragma omp parallel  #pragma omp parallel
2548          {          {
2549              /*** GENERATOR SNIP_INTERPOLATE_FACES TOP */              vector<double> f_000(numComp);
2550                vector<double> f_001(numComp);
2551                vector<double> f_010(numComp);
2552                vector<double> f_011(numComp);
2553                vector<double> f_100(numComp);
2554                vector<double> f_101(numComp);
2555                vector<double> f_110(numComp);
2556                vector<double> f_111(numComp);
2557              if (m_faceOffset[0] > -1) {              if (m_faceOffset[0] > -1) {
2558  #pragma omp for nowait  #pragma omp for nowait
2559                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE2; ++k2) {
2560                      for (index_t k1=0; k1 < m_NE1; ++k1) {                      for (index_t k1=0; k1 < m_NE1; ++k1) {
2561                          const register double* f_000 = in.getSampleDataRO(INDEX3(0,k1,k2, m_N0,m_N1));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(0,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
2562                          const register double* f_001 = in.getSampleDataRO(INDEX3(0,k1,k2+1, m_N0,m_N1));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(0,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2563                          const register double* f_011 = in.getSampleDataRO(INDEX3(0,k1+1,k2+1, m_N0,m_N1));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(0,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
2564                          const register double* f_010 = in.getSampleDataRO(INDEX3(0,k1+1,k2, m_N0,m_N1));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(0,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2565                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));
2566                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2567                              o[INDEX2(i,numComp,0)] = f_000[i]*c2 + f_011[i]*c0 + c1*(f_001[i] + f_010[i]);                              o[INDEX2(i,numComp,0)] = f_000[i]*c2 + f_011[i]*c0 + c1*(f_001[i] + f_010[i]);
2568                              o[INDEX2(i,numComp,1)] = f_001[i]*c0 + f_010[i]*c2 + c1*(f_000[i] + f_011[i]);                              o[INDEX2(i,numComp,1)] = f_001[i]*c0 + f_010[i]*c2 + c1*(f_000[i] + f_011[i]);
2569                              o[INDEX2(i,numComp,2)] = f_001[i]*c2 + f_010[i]*c0 + c1*(f_000[i] + f_011[i]);                              o[INDEX2(i,numComp,2)] = f_001[i]*c2 + f_010[i]*c0 + c1*(f_000[i] + f_011[i]);
2570                              o[INDEX2(i,numComp,3)] = f_000[i]*c0 + f_011[i]*c2 + c1*(f_001[i] + f_010[i]);                              o[INDEX2(i,numComp,3)] = f_000[i]*c0 + f_011[i]*c2 + c1*(f_001[i] + f_010[i]);
2571                          } /* end of component loop i */                          } // end of component loop i
2572                      } /* end of k1 loop */                      } // end of k1 loop
2573                  } /* end of k2 loop */                  } // end of k2 loop
2574              } /* end of face 0 */              } // end of face 0
2575              if (m_faceOffset[1] > -1) {              if (m_faceOffset[1] > -1) {
2576  #pragma omp for nowait  #pragma omp for nowait
2577                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE2; ++k2) {
2578                      for (index_t k1=0; k1 < m_NE1; ++k1) {                      for (index_t k1=0; k1 < m_NE1; ++k1) {
2579                          const register double* f_101 = in.getSampleDataRO(INDEX3(m_N0-1,k1,k2+1, m_N0,m_N1));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(m_N0-1,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
2580                          const register double* f_100 = in.getSampleDataRO(INDEX3(m_N0-1,k1,k2, m_N0,m_N1));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(m_N0-1,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2581                          const register double* f_110 = in.getSampleDataRO(INDEX3(m_N0-1,k1+1,k2, m_N0,m_N1));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(m_N0-1,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
2582                          const register double* f_111 = in.getSampleDataRO(INDEX3(m_N0-1,k1+1,k2+1, m_N0,m_N1));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(m_N0-1,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2583                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));
2584                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2585                              o[INDEX2(i,numComp,0)] = f_100[i]*c2 + f_111[i]*c0 + c1*(f_101[i] + f_110[i]);                              o[INDEX2(i,numComp,0)] = f_100[i]*c2 + f_111[i]*c0 + c1*(f_101[i] + f_110[i]);
2586                              o[INDEX2(i,numComp,1)] = f_101[i]*c0 + f_110[i]*c2 + c1*(f_100[i] + f_111[i]);                              o[INDEX2(i,numComp,1)] = f_101[i]*c0 + f_110[i]*c2 + c1*(f_100[i] + f_111[i]);
2587                              o[INDEX2(i,numComp,2)] = f_101[i]*c2 + f_110[i]*c0 + c1*(f_100[i] + f_111[i]);                              o[INDEX2(i,numComp,2)] = f_101[i]*c2 + f_110[i]*c0 + c1*(f_100[i] + f_111[i]);
2588                              o[INDEX2(i,numComp,3)] = f_100[i]*c0 + f_111[i]*c2 + c1*(f_101[i] + f_110[i]);                              o[INDEX2(i,numComp,3)] = f_100[i]*c0 + f_111[i]*c2 + c1*(f_101[i] + f_110[i]);
2589                          } /* end of component loop i */                          } // end of component loop i
2590                      } /* end of k1 loop */                      } // end of k1 loop
2591                  } /* end of k2 loop */                  } // end of k2 loop
2592              } /* end of face 1 */              } // end of face 1
2593              if (m_faceOffset[2] > -1) {              if (m_faceOffset[2] > -1) {
2594  #pragma omp for nowait  #pragma omp for nowait
2595                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE2; ++k2) {
2596                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
2597                          const register double* f_000 = in.getSampleDataRO(INDEX3(k0,0,k2, m_N0,m_N1));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,0,k2, m_N0,m_N1)), numComp*sizeof(double));
2598                          const register double* f_001 = in.getSampleDataRO(INDEX3(k0,0,k2+1, m_N0,m_N1));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,0,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2599                          const register double* f_101 = in.getSampleDataRO(INDEX3(k0+1,0,k2+1, m_N0,m_N1));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,0,k2, m_N0,m_N1)), numComp*sizeof(double));
2600                          const register double* f_100 = in.getSampleDataRO(INDEX3(k0+1,0,k2, m_N0,m_N1));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,0,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2601                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));
2602                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2603                              o[INDEX2(i,numComp,0)] = f_000[i]*c2 + f_101[i]*c0 + c1*(f_001[i] + f_100[i]);                              o[INDEX2(i,numComp,0)] = f_000[i]*c2 + f_101[i]*c0 + c1*(f_001[i] + f_100[i]);
2604                              o[INDEX2(i,numComp,1)] = f_001[i]*c0 + f_100[i]*c2 + c1*(f_000[i] + f_101[i]);                              o[INDEX2(i,numComp,1)] = f_001[i]*c0 + f_100[i]*c2 + c1*(f_000[i] + f_101[i]);
2605                              o[INDEX2(i,numComp,2)] = f_001[i]*c2 + f_100[i]*c0 + c1*(f_000[i] + f_101[i]);                              o[INDEX2(i,numComp,2)] = f_001[i]*c2 + f_100[i]*c0 + c1*(f_000[i] + f_101[i]);
2606                              o[INDEX2(i,numComp,3)] = f_000[i]*c0 + f_101[i]*c2 + c1*(f_001[i] + f_100[i]);                              o[INDEX2(i,numComp,3)] = f_000[i]*c0 + f_101[i]*c2 + c1*(f_001[i] + f_100[i]);
2607                          } /* end of component loop i */                          } // end of component loop i
2608                      } /* end of k0 loop */                      } // end of k0 loop
2609                  } /* end of k2 loop */                  } // end of k2 loop
2610              } /* end of face 2 */              } // end of face 2
2611              if (m_faceOffset[3] > -1) {              if (m_faceOffset[3] > -1) {
2612  #pragma omp for nowait  #pragma omp for nowait
2613                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE2; ++k2) {
2614                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
2615                          const register double* f_110 = in.getSampleDataRO(INDEX3(k0+1,m_N1-1,k2, m_N0,m_N1));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,m_N1-1,k2, m_N0,m_N1)), numComp*sizeof(double));
2616                          const register double* f_011 = in.getSampleDataRO(INDEX3(k0,m_N1-1,k2+1, m_N0,m_N1));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,m_N1-1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2617                          const register double* f_010 = in.getSampleDataRO(INDEX3(k0,m_N1-1,k2, m_N0,m_N1));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-1,k2, m_N0,m_N1)), numComp*sizeof(double));
2618                          const register double* f_111 = in.getSampleDataRO(INDEX3(k0+1,m_N1-1,k2+1, m_N0,m_N1));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2619                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));
2620                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2621                              o[INDEX2(i,numComp,0)] = f_010[i]*c2 + f_111[i]*c0 + c1*(f_011[i] + f_110[i]);                              o[INDEX2(i,numComp,0)] = f_010[i]*c2 + f_111[i]*c0 + c1*(f_011[i] + f_110[i]);
2622                              o[INDEX2(i,numComp,1)] = f_011[i]*c0 + f_110[i]*c2 + c1*(f_010[i] + f_111[i]);                              o[INDEX2(i,numComp,1)] = f_011[i]*c0 + f_110[i]*c2 + c1*(f_010[i] + f_111[i]);
2623                              o[INDEX2(i,numComp,2)] = f_011[i]*c2 + f_110[i]*c0 + c1*(f_010[i] + f_111[i]);                              o[INDEX2(i,numComp,2)] = f_011[i]*c2 + f_110[i]*c0 + c1*(f_010[i] + f_111[i]);
2624                              o[INDEX2(i,numComp,3)] = f_010[i]*c0 + f_111[i]*c2 + c1*(f_011[i] + f_110[i]);                              o[INDEX2(i,numComp,3)] = f_010[i]*c0 + f_111[i]*c2 + c1*(f_011[i] + f_110[i]);
2625                          } /* end of component loop i */                          } // end of component loop i
2626                      } /* end of k0 loop */                      } // end of k0 loop
2627                  } /* end of k2 loop */                  } // end of k2 loop
2628              } /* end of face 3 */              } // end of face 3
2629              if (m_faceOffset[4] > -1) {              if (m_faceOffset[4] > -1) {
2630  #pragma omp for nowait  #pragma omp for nowait
2631                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1=0; k1 < m_NE1; ++k1) {
2632                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
2633                          const register double* f_000 = in.getSampleDataRO(INDEX3(k0,k1,0, m_N0,m_N1));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,0, m_N0,m_N1)), numComp*sizeof(double));
2634                          const register double* f_100 = in.getSampleDataRO(INDEX3(k0+1,k1,0, m_N0,m_N1));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,0, m_N0,m_N1)), numComp*sizeof(double));
2635                          const register double* f_110 = in.getSampleDataRO(INDEX3(k0+1,k1+1,0, m_N0,m_N1));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,0, m_N0,m_N1)), numComp*sizeof(double));
2636                          const register double* f_010 = in.getSampleDataRO(INDEX3(k0,k1+1,0, m_N0,m_N1));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,0, m_N0,m_N1)), numComp*sizeof(double));
2637                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));
2638                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2639                              o[INDEX2(i,numComp,0)] = f_000[i]*c2 + f_110[i]*c0 + c1*(f_010[i] + f_100[i]);                              o[INDEX2(i,numComp,0)] = f_000[i]*c2 + f_110[i]*c0 + c1*(f_010[i] + f_100[i]);
2640                              o[INDEX2(i,numComp,1)] = f_010[i]*c0 + f_100[i]*c2 + c1*(f_000[i] + f_110[i]);                              o[INDEX2(i,numComp,1)] = f_010[i]*c0 + f_100[i]*c2 + c1*(f_000[i] + f_110[i]);
2641                              o[INDEX2(i,numComp,2)] = f_010[i]*c2 + f_100[i]*c0 + c1*(f_000[i] + f_110[i]);                              o[INDEX2(i,numComp,2)] = f_010[i]*c2 + f_100[i]*c0 + c1*(f_000[i] + f_110[i]);
2642                              o[INDEX2(i,numComp,3)] = f_000[i]*c0 + f_110[i]*c2 + c1*(f_010[i] + f_100[i]);                              o[INDEX2(i,numComp,3)] = f_000[i]*c0 + f_110[i]*c2 + c1*(f_010[i] + f_100[i]);
2643                          } /* end of component loop i */                          } // end of component loop i
2644                      } /* end of k0 loop */                      } // end of k0 loop
2645                  } /* end of k1 loop */                  } // end of k1 loop
2646              } /* end of face 4 */              } // end of face 4
2647              if (m_faceOffset[5] > -1) {              if (m_faceOffset[5] > -1) {
2648  #pragma omp for nowait  #pragma omp for nowait
2649                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1=0; k1 < m_NE1; ++k1) {
2650                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
2651                          const register double* f_001 = in.getSampleDataRO(INDEX3(k0,k1,m_N2-1, m_N0,m_N1));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));
2652                          const register double* f_101 = in.getSampleDataRO(INDEX3(k0+1,k1,m_N2-1, m_N0,m_N1));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));
2653                          const register double* f_011 = in.getSampleDataRO(INDEX3(k0,k1+1,m_N2-1, m_N0,m_N1));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));
2654                          const register double* f_111 = in.getSampleDataRO(INDEX3(k0+1,k1+1,m_N2-1, m_N0,m_N1));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));
2655                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));
2656                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2657                              o[INDEX2(i,numComp,0)] = f_001[i]*c2 + f_111[i]*c0 + c1*(f_011[i] + f_101[i]);                              o[INDEX2(i,numComp,0)] = f_001[i]*c2 + f_111[i]*c0 + c1*(f_011[i] + f_101[i]);
2658                              o[INDEX2(i,numComp,1)] = f_011[i]*c0 + f_101[i]*c2 + c1*(f_001[i] + f_111[i]);                              o[INDEX2(i,numComp,1)] = f_011[i]*c0 + f_101[i]*c2 + c1*(f_001[i] + f_111[i]);
2659                              o[INDEX2(i,numComp,2)] = f_011[i]*c2 + f_101[i]*c0 + c1*(f_001[i] + f_111[i]);                              o[INDEX2(i,numComp,2)] = f_011[i]*c2 + f_101[i]*c0 + c1*(f_001[i] + f_111[i]);
2660                              o[INDEX2(i,numComp,3)] = f_001[i]*c0 + f_111[i]*c2 + c1*(f_011[i] + f_101[i]);                              o[INDEX2(i,numComp,3)] = f_001[i]*c0 + f_111[i]*c2 + c1*(f_011[i] + f_101[i]);
2661                          } /* end of component loop i */                          } // end of component loop i
2662                      } /* end of k0 loop */                      } // end of k0 loop
2663                  } /* end of k1 loop */                  } // end of k1 loop
2664              } /* end of face 5 */              } // end of face 5
             /* GENERATOR SNIP_INTERPOLATE_FACES BOTTOM */  
2665          } // end of parallel section          } // end of parallel section
2666      }      }
2667  }  }
2668    
2669  //protected  //protected
2670  void Brick::nodesToDOF(escript::Data& out, escript::Data& in) const  void Brick::assemblePDESingle(Paso_SystemMatrix* mat, escript::Data& rhs,
2671            const escript::Data& A, const escript::Data& B,
2672            const escript::Data& C, const escript::Data& D,
2673            const escript::Data& X, const escript::Data& Y) const
2674  {  {
2675      const dim_t numComp = in.getDataPointSize();      const double h0 = m_l0/m_gNE0;
2676      out.requireWrite();      const double h1 = m_l1/m_gNE1;
2677        const double h2 = m_l2/m_gNE2;
2678        const double w0 = 0.0009303791403858427308*h1*h2/h0;
2679        const double w1 = 0.0009303791403858427308*h2;
2680        const double w2 = -0.00024929433932114870101*h1;
2681        const double w3 = 0.0009303791403858427308*h0*h2/h1;
2682        const double w4 = -0.00024929433932114870101*h0;
2683        const double w5 = 0.0009303791403858427308*h1;
2684        const double w6 = 0.0009303791403858427308*h0;
2685        const double w7 = -0.00024929433932114870101*h0*h1/h2;
2686        const double w8 = 0.0034722222222222222222*h2;
2687        const double w9 = -0.0009303791403858427308*h1;
2688        const double w10 = 0.012958509748503046158*h0*h2/h1;
2689        const double w11 = -0.0034722222222222222222*h0;
2690        const double w12 = 0.0034722222222222222222*h1;
2691        const double w13 = 0.012958509748503046158*h0;
2692        const double w14 = -0.0034722222222222222222*h0*h1/h2;
2693        const double w15 = 0.012958509748503046158*h1*h2/h0;
2694        const double w16 = -0.0034722222222222222222*h1;
2695        const double w17 = -0.0009303791403858427308*h0;
2696        const double w18 = 0.012958509748503046158*h1;
2697        const double w19 = 0.0034722222222222222222*h0;
2698        const double w20 = 0.012958509748503046158*h2;
2699        const double w21 = -0.012958509748503046158*h1;
2700        const double w22 = -0.012958509748503046158*h0;
2701        const double w23 = 0.04836181677178996241*h1;
2702        const double w24 = 0.04836181677178996241*h0;
2703        const double w25 = -0.04836181677178996241*h0*h1/h2;
2704        const double w26 = 0.00024929433932114870101*h1;
2705        const double w27 = 0.00024929433932114870101*h0;
2706        const double w28 = -0.04836181677178996241*h1;
2707        const double w29 = -0.04836181677178996241*h0;
2708        const double w30 = -0.0009303791403858427308*h1*h2/h0;
2709        const double w31 = -0.0009303791403858427308*h2;
2710        const double w32 = -0.0009303791403858427308*h0*h2/h1;
2711        const double w33 = 0.0034722222222222222222*h0*h1/h2;
2712        const double w34 = -0.0034722222222222222222*h2;
2713        const double w35 = -0.00024929433932114870101*h2;
2714        const double w36 = -0.012958509748503046158*h1*h2/h0;
2715        const double w37 = -0.012958509748503046158*h2;
2716        const double w38 = -0.012958509748503046158*h0*h2/h1;
2717        const double w39 = -0.04836181677178996241*h2;
2718        const double w40 = -0.0034722222222222222222*h0*h2/h1;
2719        const double w41 = 0.0009303791403858427308*h0*h1/h2;
2720        const double w42 = 0.04836181677178996241*h2;
2721        const double w43 = -0.04836181677178996241*h0*h2/h1;
2722        const double w44 = 0.012958509748503046158*h0*h1/h2;
2723        const double w45 = -0.00024929433932114870101*h0*h2/h1;
2724        const double w46 = 0.00024929433932114870101*h2;
2725        const double w47 = -0.0034722222222222222222*h1*h2/h0;
2726        const double w48 = -0.00024929433932114870101*h1*h2/h0;
2727        const double w49 = -0.04836181677178996241*h1*h2/h0;
2728        const double w50 = 0.0034722222222222222222*h0*h2/h1;
2729        const double w51 = -0.0009303791403858427308*h0*h1/h2;
2730        const double w52 = -0.012958509748503046158*h0*h1/h2;
2731        const double w53 = 0.0034722222222222222222*h1*h2/h0;
2732        const double w54 = 0.00024929433932114870101*h0*h1/h2;
2733        const double w55 = 0.04836181677178996241*h0*h2/h1;
2734        const double w56 = 0.04836181677178996241*h1*h2/h0;
2735        const double w57 = 0.04836181677178996241*h0*h1/h2;
2736        const double w58 = 0.00024929433932114870101*h1*h2/h0;
2737        const double w59 = 0.00024929433932114870101*h0*h2/h1;
2738        const double w60 = 0.055555555555555555556*h1*h2/h0;
2739        const double w61 = 0.041666666666666666667*h2;
2740        const double w62 = -0.083333333333333333333*h1;
2741        const double w63 = 0.055555555555555555556*h0*h2/h1;
2742        const double w64 = -0.083333333333333333333*h0;
2743        const double w65 = 0.083333333333333333333*h1;
2744        const double w66 = 0.083333333333333333333*h0;
2745        const double w67 = -0.11111111111111111111*h0*h1/h2;
2746        const double w68 = -0.055555555555555555556*h1*h2/h0;
2747        const double w69 = -0.083333333333333333333*h2;
2748        const double w70 = -0.041666666666666666667*h1;
2749        const double w71 = -0.055555555555555555556*h0*h2/h1;
2750        const double w72 = -0.041666666666666666667*h0;
2751        const double w73 = 0.041666666666666666667*h1;
2752        const double w74 = 0.041666666666666666667*h0;
2753        const double w75 = 0.027777777777777777778*h0*h1/h2;
2754        const double w76 = 0.083333333333333333333*h2;
2755        const double w77 = -0.11111111111111111111*h0*h2/h1;
2756        const double w78 = 0.055555555555555555556*h0*h1/h2;
2757        const double w79 = -0.11111111111111111111*h1*h2/h0;
2758        const double w80 = -0.027777777777777777778*h1*h2/h0;
2759        const double w81 = -0.041666666666666666667*h2;
2760        const double w82 = -0.027777777777777777778*h0*h2/h1;
2761        const double w83 = -0.027777777777777777778*h0*h1/h2;
2762        const double w84 = 0.027777777777777777778*h0*h2/h1;
2763        const double w85 = -0.055555555555555555556*h0*h1/h2;
2764        const double w86 = 0.11111111111111111111*h1*h2/h0;
2765        const double w87 = 0.11111111111111111111*h0*h2/h1;
2766        const double w88 = 0.11111111111111111111*h0*h1/h2;
2767        const double w89 = 0.027777777777777777778*h1*h2/h0;
2768        const double w90 = 0.0001966122466178319053*h1*h2;
2769        const double w91 = 0.0001966122466178319053*h0*h2;
2770        const double w92 = 0.0001966122466178319053*h0*h1;
2771        const double w93 = 0.0007337668937680108255*h1*h2;
2772        const double w94 = 0.0027384553284542113967*h0*h2;
2773        const double w95 = 0.0027384553284542113967*h0*h1;
2774        const double w96 = 0.0027384553284542113967*h1*h2;
2775        const double w97 = 0.0007337668937680108255*h0*h2;
2776        const double w98 = 0.010220054420048834761*h1*h2;
2777        const double w99 = 0.010220054420048834761*h0*h2;
2778        const double w100 = 0.038141762351741127649*h0*h1;
2779        const double w101 = 0.000052682092703316795705*h0*h1;
2780        const double w102 = 0.0007337668937680108255*h0*h1;
2781        const double w103 = 0.010220054420048834761*h0*h1;
2782        const double w104 = -0.0001966122466178319053*h1*h2;
2783        const double w105 = -0.0001966122466178319053*h0*h2;
2784        const double w106 = -0.0007337668937680108255*h1*h2;
2785        const double w107 = -0.0007337668937680108255*h0*h2;
2786        const double w108 = -0.0027384553284542113967*h1*h2;
2787        const double w109 = -0.0027384553284542113967*h0*h2;
2788        const double w110 = -0.010220054420048834761*h1*h2;
2789        const double w111 = -0.010220054420048834761*h0*h2;
2790        const double w112 = -0.0007337668937680108255*h0*h1;
2791        const double w113 = -0.010220054420048834761*h0*h1;
2792        const double w114 = -0.038141762351741127649*h0*h2;
2793        const double w115 = -0.000052682092703316795705*h0*h2;
2794        const double w116 = -0.0001966122466178319053*h0*h1;
2795        const double w117 = -0.0027384553284542113967*h0*h1;
2796        const double w118 = 0.000052682092703316795705*h0*h2;
2797        const double w119 = 0.038141762351741127649*h0*h2;
2798        const double w120 = 0.000052682092703316795705*h1*h2;
2799        const double w121 = 0.038141762351741127649*h1*h2;
2800        const double w122 = -0.000052682092703316795705*h0*h1;
2801        const double w123 = -0.038141762351741127649*h0*h1;
2802        const double w124 = -0.000052682092703316795705*h1*h2;
2803        const double w125 = -0.038141762351741127649*h1*h2;
2804        const double w126 = 0.027777777777777777778*h1*h2;
2805        const double w127 = 0.027777777777777777778*h0*h2;
2806        const double w128 = 0.055555555555555555556*h0*h1;
2807        const double w129 = -0.027777777777777777778*h1*h2;
2808        const double w130 = -0.027777777777777777778*h0*h2;
2809        const double w131 = 0.013888888888888888889*h0*h1;
2810        const double w132 = -0.055555555555555555556*h0*h2;
2811        const double w133 = -0.027777777777777777778*h0*h1;
2812        const double w134 = 0.055555555555555555556*h0*h2;
2813        const double w135 = 0.027777777777777777778*h0*h1;
2814        const double w136 = -0.013888888888888888889*h0*h1;
2815        const double w137 = 0.055555555555555555556*h1*h2;
2816        const double w138 = -0.013888888888888888889*h1*h2;
2817        const double w139 = -0.013888888888888888889*h0*h2;
2818        const double w140 = -0.055555555555555555556*h0*h1;
2819        const double w141 = 0.013888888888888888889*h1*h2;
2820        const double w142 = 0.013888888888888888889*h0*h2;
2821        const double w143 = -0.055555555555555555556*h1*h2;
2822        const double w144 = 0.000041549056553524783501*h0*h1*h2;
2823        const double w145 = 0.0005787037037037037037*h0*h1*h2;
2824        const double w146 = 0.0080603027952983270684*h0*h1*h2;
2825        const double w147 = 0.0001550631900643071218*h0*h1*h2;
2826        const double w148 = 0.002159751624750507693*h0*h1*h2;
2827        const double w149 = 0.03008145955644280058*h0*h1*h2;
2828        const double w150 = 0.000011133036149792012204*h0*h1*h2;
2829        const double w151 = 0.018518518518518518519*h0*h1*h2;
2830        const double w152 = 0.0092592592592592592592*h0*h1*h2;
2831        const double w153 = 0.0046296296296296296296*h0*h1*h2;
2832        const double w154 = 0.037037037037037037037*h0*h1*h2;
2833        const double w155 = -0.077751058491018276949*h1*h2;
2834        const double w156 = -0.077751058491018276949*h0*h2;
2835        const double w157 = -0.077751058491018276949*h0*h1;
2836        const double w158 = -0.020833333333333333333*h0*h2;
2837        const double w159 = -0.020833333333333333333*h0*h1;
2838        const double w160 = -0.020833333333333333333*h1*h2;
2839        const double w161 = -0.0055822748423150563848*h0*h1;
2840        const double w162 = -0.0055822748423150563848*h0*h2;
2841        const double w163 = -0.0055822748423150563848*h1*h2;
2842        const double w164 = 0.077751058491018276949*h1*h2;
2843        const double w165 = 0.020833333333333333333*h1*h2;
2844        const double w166 = 0.0055822748423150563848*h1*h2;
2845        const double w167 = 0.077751058491018276949*h0*h2;
2846        const double w168 = 0.020833333333333333333*h0*h2;
2847        const double w169 = 0.0055822748423150563848*h0*h2;
2848        const double w170 = 0.077751058491018276949*h0*h1;
2849        const double w171 = 0.020833333333333333333*h0*h1;
2850        const double w172 = 0.0055822748423150563848*h0*h1;
2851        const double w173 = -0.25*h1*h2;
2852        const double w174 = -0.25*h0*h2;
2853        const double w175 = -0.25*h0*h1;
2854        const double w176 = 0.25*h1*h2;
2855        const double w177 = 0.25*h0*h2;
2856        const double w178 = 0.25*h0*h1;
2857        const double w179 = 0.061320326520293008568*h0*h1*h2;
2858        const double w180 = 0.01643073197072526838*h0*h1*h2;
2859        const double w181 = 0.004402601362608064953*h0*h1*h2;
2860        const double w182 = 0.0011796734797069914318*h0*h1*h2;
2861        const double w183 = 0.125*h0*h1*h2;
2862    
2863      const index_t left = (m_offset0==0 ? 0 : 1);      rhs.requireWrite();
2864      const index_t bottom = (m_offset1==0 ? 0 : 1);  #pragma omp parallel
2865      const index_t front = (m_offset2==0 ? 0 : 1);      {
2866      const index_t right = (m_mpiInfo->rank%m_NX==m_NX-1 ? m_N0 : m_N0-1);          for (index_t k2_0=0; k2_0<2; k2_0++) { // colouring
2867      const index_t top = (m_mpiInfo->rank%(m_NX*m_NY)/m_NX==m_NY-1 ? m_N1 : m_N1-1);  #pragma omp for
2868      const index_t back = (m_mpiInfo->rank/(m_NX*m_NY)==m_NZ-1 ? m_N2 : m_N2-1);              for (index_t k2=k2_0; k2<m_NE2; k2+=2) {
2869      index_t n=0;                  for (index_t k1=0; k1<m_NE1; ++k1) {
2870      for (index_t i=front; i<back; i++) {                      for (index_t k0=0; k0<m_NE0; ++k0)  {
2871          for (index_t j=bottom; j<top; j++) {                          bool add_EM_S=false;
2872              for (index_t k=left; k<right; k++, n++) {                          bool add_EM_F=false;
2873                  const double* src=in.getSampleDataRO(k+j*m_N0+i*m_N0*m_N1);                          vector<double> EM_S(8*8, 0);
2874                  copy(src, src+numComp, out.getSampleDataRW(n));                          vector<double> EM_F(8, 0);
2875              }                          const index_t e = k0 + m_NE0*k1 + m_NE0*m_NE1*k2;
2876          }                          ///////////////
2877                            // process A //
2878                            ///////////////
2879                            if (!A.isEmpty()) {
2880                                add_EM_S=true;
2881                                const double* A_p=const_cast<escript::Data*>(&A)->getSampleDataRO(e);
2882                                if (A.actsExpanded()) {
2883                                    const double A_00_0 = A_p[INDEX3(0,0,0,3,3)];
2884                                    const double A_01_0 = A_p[INDEX3(0,1,0,3,3)];
2885                                    const double A_02_0 = A_p[INDEX3(0,2,0,3,3)];
2886                                    const double A_10_0 = A_p[INDEX3(1,0,0,3,3)];
2887                                    const double A_11_0 = A_p[INDEX3(1,1,0,3,3)];
2888                                    const double A_12_0 = A_p[INDEX3(1,2,0,3,3)];
2889                                    const double A_20_0 = A_p[INDEX3(2,0,0,3,3)];
2890                                    const double A_21_0 = A_p[INDEX3(2,1,0,3,3)];
2891                                    const double A_22_0 = A_p[INDEX3(2,2,0,3,3)];
2892                                    const double A_00_1 = A_p[INDEX3(0,0,1,3,3)];
2893                                    const double A_01_1 = A_p[INDEX3(0,1,1,3,3)];
2894                                    const double A_02_1 = A_p[INDEX3(0,2,1,3,3)];
2895                                    const double A_10_1 = A_p[INDEX3(1,0,1,3,3)];
2896                                    const double A_11_1 = A_p[INDEX3(1,1,1,3,3)];
2897                                    const double A_12_1 = A_p[INDEX3(1,2,1,3,3)];
2898                                    const double A_20_1 = A_p[INDEX3(2,0,1,3,3)];
2899                                    const double A_21_1 = A_p[INDEX3(2,1,1,3,3)];
2900                                    const double A_22_1 = A_p[INDEX3(2,2,1,3,3)];
2901                                    const double A_00_2 = A_p[INDEX3(0,0,2,3,3)];
2902                                    const double A_01_2 = A_p[INDEX3(0,1,2,3,3)];
2903                                    const double A_02_2 = A_p[INDEX3(0,2,2,3,3)];
2904                                    const double A_10_2 = A_p[INDEX3(1,0,2,3,3)];
2905                                    const double A_11_2 = A_p[INDEX3(1,1,2,3,3)];
2906                                    const double A_12_2 = A_p[INDEX3(1,2,2,3,3)];
2907                                    const double A_20_2 = A_p[INDEX3(2,0,2,3,3)];
2908                                    const double A_21_2 = A_p[INDEX3(2,1,2,3,3)];
2909                                    const double A_22_2 = A_p[INDEX3(2,2,2,3,3)];
2910                                    const double A_00_3 = A_p[INDEX3(0,0,3,3,3)];
2911                                    const double A_01_3 = A_p[INDEX3(0,1,3,3,3)];
2912                                    const double A_02_3 = A_p[INDEX3(0,2,3,3,3)];
2913                                    const double A_10_3 = A_p[INDEX3(1,0,3,3,3)];
2914                                    const double A_11_3 = A_p[INDEX3(1,1,3,3,3)];
2915                                    const double A_12_3 = A_p[INDEX3(1,2,3,3,3)];
2916                                    const double A_20_3 = A_p[INDEX3(2,0,3,3,3)];
2917                                    const double A_21_3 = A_p[INDEX3(2,1,3,3,3)];
2918                                    const double A_22_3 = A_p[INDEX3(2,2,3,3,3)];
2919                                    const double A_00_4 = A_p[INDEX3(0,0,4,3,3)];
2920                                    const double A_01_4 = A_p[INDEX3(0,1,4,3,3)];
2921                                    const double A_02_4 = A_p[INDEX3(0,2,4,3,3)];
2922                                    const double A_10_4 = A_p[INDEX3(1,0,4,3,3)];
2923                                    const double A_11_4 = A_p[INDEX3(1,1,4,3,3)];
2924                                    const double A_12_4 = A_p[INDEX3(1,2,4,3,3)];
2925                                    const double A_20_4 = A_p[INDEX3(2,0,4,3,3)];
2926                                    const double A_21_4 = A_p[INDEX3(2,1,4,3,3)];
2927                                    const double A_22_4 = A_p[INDEX3(2,2,4,3,3)];
2928                                    const double A_00_5 = A_p[INDEX3(0,0,5,3,3)];
2929                                    const double A_01_5 = A_p[INDEX3(0,1,5,3,3)];
2930                                    const double A_02_5 = A_p[INDEX3(0,2,5,3,3)];
2931                                    const double A_10_5 = A_p[INDEX3(1,0,5,3,3)];
2932                                    const double A_11_5 = A_p[INDEX3(1,1,5,3,3)];
2933                                    const double A_12_5 = A_p[INDEX3(1,2,5,3,3)];
2934                                    const double A_20_5 = A_p[INDEX3(2,0,5,3,3)];
2935                                    const double A_21_5 = A_p[INDEX3(2,1,5,3,3)];
2936                                    const double A_22_5 = A_p[INDEX3(2,2,5,3,3)];
2937                                    const double A_00_6 = A_p[INDEX3(0,0,6,3,3)];
2938                                    const double A_01_6 = A_p[INDEX3(0,1,6,3,3)];
2939                                    const double A_02_6 = A_p[INDEX3(0,2,6,3,3)];
2940                                    const double A_10_6 = A_p[INDEX3(1,0,6,3,3)];
2941                                    const double A_11_6 = A_p[INDEX3(1,1,6,3,3)];
2942                                    const double A_12_6 = A_p[INDEX3(1,2,6,3,3)];
2943                                    const double A_20_6 = A_p[INDEX3(2,0,6,3,3)];
2944                                    const double A_21_6 = A_p[INDEX3(2,1,6,3,3)];
2945                                    const double A_22_6 = A_p[INDEX3(2,2,6,3,3)];
2946                                    const double A_00_7 = A_p[INDEX3(0,0,7,3,3)];
2947                                    const double A_01_7 = A_p[INDEX3(0,1,7,3,3)];
2948                                    const double A_02_7 = A_p[INDEX3(0,2,7,3,3)];
2949                                    const double A_10_7 = A_p[INDEX3(1,0,7,3,3)];
2950                                    const double A_11_7 = A_p[INDEX3(1,1,7,3,3)];
2951                                    const double A_12_7 = A_p[INDEX3(1,2,7,3,3)];
2952                                    const double A_20_7 = A_p[INDEX3(2,0,7,3,3)];
2953                                    const double A_21_7 = A_p[INDEX3(2,1,7,3,3)];
2954                                    const double A_22_7 = A_p[INDEX3(2,2,7,3,3)];
2955                                    const double tmp160_0 = A_12_0 + A_12_6 + A_21_0 + A_21_6;
2956                                    const double tmp8_0 = A_21_0 + A_21_6;
2957                                    const double tmp135_0 = A_10_1 + A_10_2 + A_10_5 + A_10_6;
2958                                    const double tmp67_0 = A_02_2 + A_02_7;
2959                                    const double tmp211_0 = A_12_6 + A_21_6;
2960                                    const double tmp180_0 = A_10_2 + A_10_6;
2961                                    const double tmp37_0 = A_00_0 + A_00_1 + A_00_2 + A_00_3;
2962                                    const double tmp92_0 = A_11_0 + A_11_1 + A_11_2 + A_11_3 + A_11_4 + A_11_5 + A_11_6 + A_11_7;
2963                                    const double tmp195_0 = A_02_2 + A_20_2;
2964                                    const double tmp70_0 = A_01_0 + A_01_7;
2965                                    const double tmp139_0 = A_02_3 + A_02_4 + A_20_1 + A_20_6;
2966                                    const double tmp200_0 = A_12_3 + A_12_5 + A_21_3 + A_21_5;
2967                                    const double tmp60_0 = A_22_0 + A_22_2 + A_22_4 + A_22_6;
2968                                    const double tmp192_0 = A_01_5 + A_10_5;
2969                                    const double tmp46_0 = A_21_0 + A_21_7;
2970                                    const double tmp48_0 = A