/[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 3984 by caltinay, Fri Sep 21 06:41:54 2012 UTC
# Line 1  Line 1 
1    
2  /*******************************************************  /*****************************************************************************
3  *  *
4  * Copyright (c) 2003-2011 by University of Queensland  * Copyright (c) 2003-2012 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  #if USE_SILO  #if USE_SILO
# Line 29  using namespace std; Line 31  using namespace std;
31    
32  namespace ripley {  namespace ripley {
33    
34  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,
35               int d1, int d2) :               double x1, double y1, double z1, int d0, int d1, int d2) :
36      RipleyDomain(3),      RipleyDomain(3),
37      m_gNE0(n0),      m_x0(x0),
38      m_gNE1(n1),      m_y0(y0),
39      m_gNE2(n2),      m_z0(z0),
40      m_l0(l0),      m_l0(x1-x0),
41      m_l1(l1),      m_l1(y1-y0),
42      m_l2(l2),      m_l2(z1-z0)
     m_NX(d0),  
     m_NY(d1),  
     m_NZ(d2)  
43  {  {
44        // ignore subdivision parameters for serial run
45        if (m_mpiInfo->size == 1) {
46            d0=1;
47            d1=1;
48            d2=1;
49        }
50    
51        bool warn=false;
52        // if number of subdivisions is non-positive, try to subdivide by the same
53        // ratio as the number of elements
54        if (d0<=0 && d1<=0 && d2<=0) {
55            warn=true;
56            d0=(int)(pow(m_mpiInfo->size*(n0+1)*(n0+1)/((float)(n1+1)*(n2+1)), 1.f/3));
57            d1=(int)(d0*n1/(float)n0);
58            d2=m_mpiInfo->size/(d0*d1);
59            if (d0*d1*d2 != m_mpiInfo->size) {
60                // ratios not the same so leave "smallest" side undivided and try
61                // dividing 2 sides only
62                if (n0>=n1) {
63                    if (n1>=n2) {
64                        d0=d1=0;
65                        d2=1;
66                    } else {
67                        d0=d2=0;
68                        d1=1;
69                    }
70                } else {
71                    if (n0>=n2) {
72                        d0=d1=0;
73                        d2=1;
74                    } else {
75                        d0=1;
76                        d1=d2=0;
77                    }
78                }
79            }
80        }
81        if (d0<=0 && d1<=0) {
82            warn=true;
83            d0=int(sqrt(m_mpiInfo->size*(n0+1)/(float)(n1+1)));
84            d1=m_mpiInfo->size/d0;
85            if (d0*d1*d2 != m_mpiInfo->size) {
86                // ratios not the same so subdivide side with more elements only
87                if (n0>n1) {
88                    d0=0;
89                    d1=1;
90                } else {
91                    d0=1;
92                    d1=0;
93                }
94            }
95        } else if (d0<=0 && d2<=0) {
96            warn=true;
97            d0=int(sqrt(m_mpiInfo->size*(n0+1)/(float)(n2+1)));
98            d2=m_mpiInfo->size/d0;
99            if (d0*d1*d2 != m_mpiInfo->size) {
100                // ratios not the same so subdivide side with more elements only
101                if (n0>n2) {
102                    d0=0;
103                    d2=1;
104                } else {
105                    d0=1;
106                    d2=0;
107                }
108            }
109        } else if (d1<=0 && d2<=0) {
110            warn=true;
111            d1=int(sqrt(m_mpiInfo->size*(n1+1)/(float)(n2+1)));
112            d2=m_mpiInfo->size/d1;
113            if (d0*d1*d2 != m_mpiInfo->size) {
114                // ratios not the same so subdivide side with more elements only
115                if (n1>n2) {
116                    d1=0;
117                    d2=1;
118                } else {
119                    d1=1;
120                    d2=0;
121                }
122            }
123        }
124        if (d0<=0) {
125            // d1,d2 are preset, determine d0
126            d0=m_mpiInfo->size/(d1*d2);
127        } else if (d1<=0) {
128            // d0,d2 are preset, determine d1
129            d1=m_mpiInfo->size/(d0*d2);
130        } else if (d2<=0) {
131            // d0,d1 are preset, determine d2
132            d2=m_mpiInfo->size/(d0*d1);
133        }
134    
135        m_NX=d0;
136        m_NY=d1;
137        m_NZ=d2;
138    
139      // ensure number of subdivisions is valid and nodes can be distributed      // ensure number of subdivisions is valid and nodes can be distributed
140      // among number of ranks      // among number of ranks
141      if (m_NX*m_NY*m_NZ != m_mpiInfo->size)      if (m_NX*m_NY*m_NZ != m_mpiInfo->size)
142          throw RipleyException("Invalid number of spatial subdivisions");          throw RipleyException("Invalid number of spatial subdivisions");
143    
144      if ((n0+1)%m_NX > 0 || (n1+1)%m_NY > 0 || (n2+1)%m_NZ > 0)      if (warn) {
145          throw RipleyException("Number of elements+1 must be separable into number of ranks in each dimension");          cout << "Warning: Automatic domain subdivision (d0=" << d0 << ", d1="
146                << d1 << ", d2=" << d2 << "). This may not be optimal!" << endl;
147        }
148    
149        if ((n0+1)%m_NX > 0) {
150            double Dx=m_l0/n0;
151            n0=(int)round((float)(n0+1)/d0+0.5)*d0-1;
152            m_l0=Dx*n0;
153            cout << "Warning: Adjusted number of elements and length. N0="
154                << n0 << ", l0=" << m_l0 << endl;
155        }
156        if ((n1+1)%m_NY > 0) {
157            double Dy=m_l1/n1;
158            n1=(int)round((float)(n1+1)/d1+0.5)*d1-1;
159            m_l1=Dy*n1;
160            cout << "Warning: Adjusted number of elements and length. N1="
161                << n1 << ", l1=" << m_l1 << endl;
162        }
163        if ((n2+1)%m_NZ > 0) {
164            double Dz=m_l2/n2;
165            n2=(int)round((float)(n2+1)/d2+0.5)*d2-1;
166            m_l2=Dz*n2;
167            cout << "Warning: Adjusted number of elements and length. N2="
168                << n2 << ", l2=" << m_l2 << endl;
169        }
170    
171        m_gNE0=n0;
172        m_gNE1=n1;
173        m_gNE2=n2;
174    
175      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))
176          throw RipleyException("Too few elements for the number of ranks");          throw RipleyException("Too few elements for the number of ranks");
177    
178      // local number of elements (including overlap)      // local number of elements (including overlap)
179      m_NE0 = (m_NX>1 ? (n0+1)/m_NX : n0);      m_NE0 = m_ownNE0 = (m_NX>1 ? (n0+1)/m_NX : n0);
180      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)
181          m_NE0++;          m_NE0++;
182      m_NE1 = (m_NY>1 ? (n1+1)/m_NY : n1);      else if (m_NX>1 && m_mpiInfo->rank%m_NX==m_NX-1)
183            m_ownNE0--;
184    
185        m_NE1 = m_ownNE1 = (m_NY>1 ? (n1+1)/m_NY : n1);
186      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)
187          m_NE1++;          m_NE1++;
188      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)
189            m_ownNE1--;
190    
191        m_NE2 = m_ownNE2 = (m_NZ>1 ? (n2+1)/m_NZ : n2);
192      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)
193          m_NE2++;          m_NE2++;
194        else if (m_NZ>1 && m_mpiInfo->rank/(m_NX*m_NY)==m_NZ-1)
195            m_ownNE2--;
196    
197      // local number of nodes      // local number of nodes
198      m_N0 = m_NE0+1;      m_N0 = m_NE0+1;
# Line 81  Brick::Brick(int n0, int n1, int n2, dou Line 211  Brick::Brick(int n0, int n1, int n2, dou
211          m_offset2--;          m_offset2--;
212    
213      populateSampleIds();      populateSampleIds();
214        createPattern();
215  }  }
216    
217    
218  Brick::~Brick()  Brick::~Brick()
219  {  {
220        Paso_SystemMatrixPattern_free(m_pattern);
221        Paso_Connector_free(m_connector);
222  }  }
223    
224  string Brick::getDescription() const  string Brick::getDescription() const
# Line 99  bool Brick::operator==(const AbstractDom Line 232  bool Brick::operator==(const AbstractDom
232      if (o) {      if (o) {
233          return (RipleyDomain::operator==(other) &&          return (RipleyDomain::operator==(other) &&
234                  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
235                    && m_x0==o->m_x0 && m_y0==o->m_y0 && m_z0==o->m_z0
236                  && 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
237                  && 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);
238      }      }
# Line 106  bool Brick::operator==(const AbstractDom Line 240  bool Brick::operator==(const AbstractDom
240      return false;      return false;
241  }  }
242    
243    void Brick::readBinaryGrid(escript::Data& out, string filename,
244                               const vector<int>& first,
245                               const vector<int>& numValues) const
246    {
247        // check destination function space
248        int myN0, myN1, myN2;
249        if (out.getFunctionSpace().getTypeCode() == Nodes) {
250            myN0 = m_N0;
251            myN1 = m_N1;
252            myN2 = m_N2;
253        } else if (out.getFunctionSpace().getTypeCode() == Elements ||
254                    out.getFunctionSpace().getTypeCode() == ReducedElements) {
255            myN0 = m_NE0;
256            myN1 = m_NE1;
257            myN2 = m_NE2;
258        } else
259            throw RipleyException("readBinaryGrid(): invalid function space for output data object");
260    
261        // check file existence and size
262        ifstream f(filename.c_str(), ifstream::binary);
263        if (f.fail()) {
264            throw RipleyException("readBinaryGrid(): cannot open file");
265        }
266        f.seekg(0, ios::end);
267        const int numComp = out.getDataPointSize();
268        const int filesize = f.tellg();
269        const int reqsize = numValues[0]*numValues[1]*numValues[2]*numComp*sizeof(float);
270        if (filesize < reqsize) {
271            f.close();
272            throw RipleyException("readBinaryGrid(): not enough data in file");
273        }
274    
275        // check if this rank contributes anything
276        if (first[0] >= m_offset0+myN0 || first[0]+numValues[0] <= m_offset0 ||
277                first[1] >= m_offset1+myN1 || first[1]+numValues[1] <= m_offset1 ||
278                first[2] >= m_offset2+myN2 || first[2]+numValues[2] <= m_offset2) {
279            f.close();
280            return;
281        }
282    
283        // now determine how much this rank has to write
284    
285        // first coordinates in data object to write to
286        const int first0 = max(0, first[0]-m_offset0);
287        const int first1 = max(0, first[1]-m_offset1);
288        const int first2 = max(0, first[2]-m_offset2);
289        // indices to first value in file
290        const int idx0 = max(0, m_offset0-first[0]);
291        const int idx1 = max(0, m_offset1-first[1]);
292        const int idx2 = max(0, m_offset2-first[2]);
293        // number of values to write
294        const int num0 = min(numValues[0]-idx0, myN0-first0);
295        const int num1 = min(numValues[1]-idx1, myN1-first1);
296        const int num2 = min(numValues[2]-idx2, myN2-first2);
297    
298        out.requireWrite();
299        vector<float> values(num0*numComp);
300        const int dpp = out.getNumDataPointsPerSample();
301    
302        // whether the y-coordinate runs top-down (invert=true) or bottom-up (false)
303        bool invertY=true;
304    
305        for (index_t z=0; z<num2; z++) {
306            for (index_t y=0; y<num1; y++) {
307                const int fileofs = numComp*(idx0+(idx1+y)*numValues[0]+(idx2+z)*numValues[0]*numValues[1]);
308                f.seekg(fileofs*sizeof(float));
309                f.read((char*)&values[0], num0*numComp*sizeof(float));
310                int dataIndex;
311                if (invertY)
312                    dataIndex = first0+(first1+num1-1-y)*myN0+(first2+z)*myN0*myN1;
313                else
314                    dataIndex = first0+(first1+y)*myN0+(first2+z)*myN0*myN1;
315    
316                for (index_t x=0; x<num0; x++) {
317                    double* dest = out.getSampleDataRW(dataIndex+x);
318                    for (index_t c=0; c<numComp; c++) {
319                        for (index_t q=0; q<dpp; q++) {
320                            *dest++ = static_cast<double>(values[x*numComp+c]);
321                        }
322                    }
323                }
324            }
325        }
326    
327        f.close();
328    }
329    
330  void Brick::dump(const string& fileName) const  void Brick::dump(const string& fileName) const
331  {  {
332  #if USE_SILO  #if USE_SILO
# Line 114  void Brick::dump(const string& fileName) Line 335  void Brick::dump(const string& fileName)
335          fn+=".silo";          fn+=".silo";
336      }      }
337    
     const int NUM_SILO_FILES = 1;  
     const char* blockDirFmt = "/block%04d";  
338      int driver=DB_HDF5;          int driver=DB_HDF5;    
339      string siloPath;      string siloPath;
340      DBfile* dbfile = NULL;      DBfile* dbfile = NULL;
341    
342  #ifdef ESYS_MPI  #ifdef ESYS_MPI
343      PMPIO_baton_t* baton = NULL;      PMPIO_baton_t* baton = NULL;
344        const int NUM_SILO_FILES = 1;
345        const char* blockDirFmt = "/block%04d";
346  #endif  #endif
347    
348      if (m_mpiInfo->size > 1) {      if (m_mpiInfo->size > 1) {
# Line 247  void Brick::dump(const string& fileName) Line 468  void Brick::dump(const string& fileName)
468      }      }
469    
470  #else // USE_SILO  #else // USE_SILO
471      throw RipleyException("dump(): no Silo support");      throw RipleyException("dump: no Silo support");
472  #endif  #endif
473  }  }
474    
# Line 257  const int* Brick::borrowSampleReferenceI Line 478  const int* Brick::borrowSampleReferenceI
478          case Nodes:          case Nodes:
479          case ReducedNodes: //FIXME: reduced          case ReducedNodes: //FIXME: reduced
480              return &m_nodeId[0];              return &m_nodeId[0];
481          case DegreesOfFreedom: //FIXME          case DegreesOfFreedom:
482          case ReducedDegreesOfFreedom: //FIXME          case ReducedDegreesOfFreedom: //FIXME: reduced
483              return &m_dofId[0];              return &m_dofId[0];
484          case Elements:          case Elements:
485          case ReducedElements:          case ReducedElements:
486              return &m_elementId[0];              return &m_elementId[0];
487            case FaceElements:
488          case ReducedFaceElements:          case ReducedFaceElements:
489              return &m_faceId[0];              return &m_faceId[0];
490          default:          default:
# Line 270  const int* Brick::borrowSampleReferenceI Line 492  const int* Brick::borrowSampleReferenceI
492      }      }
493    
494      stringstream msg;      stringstream msg;
495      msg << "borrowSampleReferenceIDs() not implemented for function space type "      msg << "borrowSampleReferenceIDs: invalid function space type "<<fsType;
         << fsType;  
496      throw RipleyException(msg.str());      throw RipleyException(msg.str());
497  }  }
498    
499  bool Brick::ownSample(int fsCode, index_t id) const  bool Brick::ownSample(int fsType, index_t id) const
500  {  {
501  #ifdef ESYS_MPI      if (getMPISize()==1)
502      if (fsCode == Nodes) {          return true;
503          const index_t left = (m_offset0==0 ? 0 : 1);  
504          const index_t bottom = (m_offset1==0 ? 0 : 1);      switch (fsType) {
505          const index_t front = (m_offset2==0 ? 0 : 1);          case Nodes:
506          const index_t right = (m_mpiInfo->rank%m_NX==m_NX-1 ? m_N0 : m_N0-1);          case ReducedNodes: //FIXME: reduced
507          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());
508          const index_t back = (m_mpiInfo->rank/(m_NX*m_NY)==m_NZ-1 ? m_N2 : m_N2-1);          case DegreesOfFreedom:
509          const index_t x=id%m_N0;          case ReducedDegreesOfFreedom:
510          const index_t y=id%(m_N0*m_N1)/m_N0;              return true;
511          const index_t z=id/(m_N0*m_N1);          case Elements:
512          return (x>=left && x<right && y>=bottom && y<top && z>=front && z<back);          case ReducedElements:
513                {
514                    // check ownership of element's _last_ node
515                    const index_t x=id%m_NE0 + 1;
516                    const index_t y=id%(m_NE0*m_NE1)/m_NE0 + 1;
517                    const index_t z=id/(m_NE0*m_NE1) + 1;
518                    return (m_dofMap[x + m_N0*y +m_N0*m_N1*z] < getNumDOF());
519                }
520            case FaceElements:
521            case ReducedFaceElements:
522                {
523                    // check ownership of face element's last node
524                    const IndexVector faces = getNumFacesPerBoundary();
525                    dim_t n=0;
526                    for (size_t i=0; i<faces.size(); i++) {
527                        n+=faces[i];
528                        if (id<n) {
529                            const index_t j=id-n+faces[i];
530                            if (i>=4) { // front or back
531                                const index_t first=(i==4 ? 0 : m_N0*m_N1*(m_N2-1));
532                                return (m_dofMap[first+j%m_NE0+1+(j/m_NE0+1)*m_N0] < getNumDOF());
533                            } else if (i>=2) { // bottom or top
534                                const index_t first=(i==2 ? 0 : m_N0*(m_N1-1));
535                                return (m_dofMap[first+j%m_NE0+1+(j/m_NE0+1)*m_N0*m_N1] < getNumDOF());
536                            } else { // left or right
537                                const index_t first=(i==0 ? 0 : m_N0-1);
538                                return (m_dofMap[first+(j%m_NE1+1)*m_N0+(j/m_NE1+1)*m_N0*m_N1] < getNumDOF());
539                            }
540                        }
541                    }
542                    return false;
543                }
544            default:
545                break;
546        }
547    
548        stringstream msg;
549        msg << "ownSample: invalid function space type " << fsType;
550        throw RipleyException(msg.str());
551    }
552    
553    void Brick::setToNormal(escript::Data& out) const
554    {
555        if (out.getFunctionSpace().getTypeCode() == FaceElements) {
556            out.requireWrite();
557    #pragma omp parallel
558            {
559                if (m_faceOffset[0] > -1) {
560    #pragma omp for nowait
561                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
562                        for (index_t k1 = 0; k1 < m_NE1; ++k1) {
563                            double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));
564                            // set vector at four quadrature points
565                            *o++ = -1.; *o++ = 0.; *o++ = 0.;
566                            *o++ = -1.; *o++ = 0.; *o++ = 0.;
567                            *o++ = -1.; *o++ = 0.; *o++ = 0.;
568                            *o++ = -1.; *o++ = 0.; *o = 0.;
569                        }
570                    }
571                }
572    
573                if (m_faceOffset[1] > -1) {
574    #pragma omp for nowait
575                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
576                        for (index_t k1 = 0; k1 < m_NE1; ++k1) {
577                            double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));
578                            // set vector at four quadrature points
579                            *o++ = 1.; *o++ = 0.; *o++ = 0.;
580                            *o++ = 1.; *o++ = 0.; *o++ = 0.;
581                            *o++ = 1.; *o++ = 0.; *o++ = 0.;
582                            *o++ = 1.; *o++ = 0.; *o = 0.;
583                        }
584                    }
585                }
586    
587                if (m_faceOffset[2] > -1) {
588    #pragma omp for nowait
589                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
590                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
591                            double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));
592                            // set vector at four quadrature points
593                            *o++ = 0.; *o++ = -1.; *o++ = 0.;
594                            *o++ = 0.; *o++ = -1.; *o++ = 0.;
595                            *o++ = 0.; *o++ = -1.; *o++ = 0.;
596                            *o++ = 0.; *o++ = -1.; *o = 0.;
597                        }
598                    }
599                }
600    
601                if (m_faceOffset[3] > -1) {
602    #pragma omp for nowait
603                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
604                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
605                            double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));
606                            // set vector at four quadrature points
607                            *o++ = 0.; *o++ = 1.; *o++ = 0.;
608                            *o++ = 0.; *o++ = 1.; *o++ = 0.;
609                            *o++ = 0.; *o++ = 1.; *o++ = 0.;
610                            *o++ = 0.; *o++ = 1.; *o = 0.;
611                        }
612                    }
613                }
614    
615                if (m_faceOffset[4] > -1) {
616    #pragma omp for nowait
617                    for (index_t k1 = 0; k1 < m_NE1; ++k1) {
618                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
619                            double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));
620                            // set vector at four quadrature points
621                            *o++ = 0.; *o++ = 0.; *o++ = -1.;
622                            *o++ = 0.; *o++ = 0.; *o++ = -1.;
623                            *o++ = 0.; *o++ = 0.; *o++ = -1.;
624                            *o++ = 0.; *o++ = 0.; *o = -1.;
625                        }
626                    }
627                }
628    
629                if (m_faceOffset[5] > -1) {
630    #pragma omp for nowait
631                    for (index_t k1 = 0; k1 < m_NE1; ++k1) {
632                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
633                            double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));
634                            // set vector at four quadrature points
635                            *o++ = 0.; *o++ = 0.; *o++ = 1.;
636                            *o++ = 0.; *o++ = 0.; *o++ = 1.;
637                            *o++ = 0.; *o++ = 0.; *o++ = 1.;
638                            *o++ = 0.; *o++ = 0.; *o = 1.;
639                        }
640                    }
641                }
642            } // end of parallel section
643        } else if (out.getFunctionSpace().getTypeCode() == ReducedFaceElements) {
644            out.requireWrite();
645    #pragma omp parallel
646            {
647                if (m_faceOffset[0] > -1) {
648    #pragma omp for nowait
649                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
650                        for (index_t k1 = 0; k1 < m_NE1; ++k1) {
651                            double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));
652                            *o++ = -1.;
653                            *o++ = 0.;
654                            *o = 0.;
655                        }
656                    }
657                }
658    
659                if (m_faceOffset[1] > -1) {
660    #pragma omp for nowait
661                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
662                        for (index_t k1 = 0; k1 < m_NE1; ++k1) {
663                            double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));
664                            *o++ = 1.;
665                            *o++ = 0.;
666                            *o = 0.;
667                        }
668                    }
669                }
670    
671                if (m_faceOffset[2] > -1) {
672    #pragma omp for nowait
673                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
674                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
675                            double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));
676                            *o++ = 0.;
677                            *o++ = -1.;
678                            *o = 0.;
679                        }
680                    }
681                }
682    
683                if (m_faceOffset[3] > -1) {
684    #pragma omp for nowait
685                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
686                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
687                            double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));
688                            *o++ = 0.;
689                            *o++ = 1.;
690                            *o = 0.;
691                        }
692                    }
693                }
694    
695                if (m_faceOffset[4] > -1) {
696    #pragma omp for nowait
697                    for (index_t k1 = 0; k1 < m_NE1; ++k1) {
698                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
699                            double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));
700                            *o++ = 0.;
701                            *o++ = 0.;
702                            *o = -1.;
703                        }
704                    }
705                }
706    
707                if (m_faceOffset[5] > -1) {
708    #pragma omp for nowait
709                    for (index_t k1 = 0; k1 < m_NE1; ++k1) {
710                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
711                            double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));
712                            *o++ = 0.;
713                            *o++ = 0.;
714                            *o = 1.;
715                        }
716                    }
717                }
718            } // end of parallel section
719    
720      } else {      } else {
721          stringstream msg;          stringstream msg;
722          msg << "ownSample() not implemented for "          msg << "setToNormal: invalid function space type "
723              << functionSpaceTypeAsString(fsCode);              << out.getFunctionSpace().getTypeCode();
724          throw RipleyException(msg.str());          throw RipleyException(msg.str());
725      }      }
 #else  
     return true;  
 #endif  
726  }  }
727    
728  void Brick::setToGradient(escript::Data& out, const escript::Data& cIn) const  void Brick::setToSize(escript::Data& out) const
729    {
730        if (out.getFunctionSpace().getTypeCode() == Elements
731                || out.getFunctionSpace().getTypeCode() == ReducedElements) {
732            out.requireWrite();
733            const dim_t numQuad=out.getNumDataPointsPerSample();
734            const double xSize=getFirstCoordAndSpacing(0).second;
735            const double ySize=getFirstCoordAndSpacing(1).second;
736            const double zSize=getFirstCoordAndSpacing(2).second;
737            const double size=sqrt(xSize*xSize+ySize*ySize+zSize*zSize);
738    #pragma omp parallel for
739            for (index_t k = 0; k < getNumElements(); ++k) {
740                double* o = out.getSampleDataRW(k);
741                fill(o, o+numQuad, size);
742            }
743        } else if (out.getFunctionSpace().getTypeCode() == FaceElements
744                || out.getFunctionSpace().getTypeCode() == ReducedFaceElements) {
745            out.requireWrite();
746            const dim_t numQuad=out.getNumDataPointsPerSample();
747            const double xSize=getFirstCoordAndSpacing(0).second;
748            const double ySize=getFirstCoordAndSpacing(1).second;
749            const double zSize=getFirstCoordAndSpacing(2).second;
750    #pragma omp parallel
751            {
752                if (m_faceOffset[0] > -1) {
753                    const double size=min(ySize,zSize);
754    #pragma omp for nowait
755                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
756                        for (index_t k1 = 0; k1 < m_NE1; ++k1) {
757                            double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));
758                            fill(o, o+numQuad, size);
759                        }
760                    }
761                }
762    
763                if (m_faceOffset[1] > -1) {
764                    const double size=min(ySize,zSize);
765    #pragma omp for nowait
766                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
767                        for (index_t k1 = 0; k1 < m_NE1; ++k1) {
768                            double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));
769                            fill(o, o+numQuad, size);
770                        }
771                    }
772                }
773    
774                if (m_faceOffset[2] > -1) {
775                    const double size=min(xSize,zSize);
776    #pragma omp for nowait
777                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
778                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
779                            double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));
780                            fill(o, o+numQuad, size);
781                        }
782                    }
783                }
784    
785                if (m_faceOffset[3] > -1) {
786                    const double size=min(xSize,zSize);
787    #pragma omp for nowait
788                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
789                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
790                            double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));
791                            fill(o, o+numQuad, size);
792                        }
793                    }
794                }
795    
796                if (m_faceOffset[4] > -1) {
797                    const double size=min(xSize,ySize);
798    #pragma omp for nowait
799                    for (index_t k1 = 0; k1 < m_NE1; ++k1) {
800                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
801                            double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));
802                            fill(o, o+numQuad, size);
803                        }
804                    }
805                }
806    
807                if (m_faceOffset[5] > -1) {
808                    const double size=min(xSize,ySize);
809    #pragma omp for nowait
810                    for (index_t k1 = 0; k1 < m_NE1; ++k1) {
811                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
812                            double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));
813                            fill(o, o+numQuad, size);
814                        }
815                    }
816                }
817            } // end of parallel section
818    
819        } else {
820            stringstream msg;
821            msg << "setToSize: invalid function space type "
822                << out.getFunctionSpace().getTypeCode();
823            throw RipleyException(msg.str());
824        }
825    }
826    
827    Paso_SystemMatrixPattern* Brick::getPattern(bool reducedRowOrder,
828                                                bool reducedColOrder) const
829    {
830        /* FIXME: reduced
831        if (reducedRowOrder || reducedColOrder)
832            throw RipleyException("getPattern() not implemented for reduced order");
833        */
834        return m_pattern;
835    }
836    
837    void Brick::Print_Mesh_Info(const bool full) const
838    {
839        RipleyDomain::Print_Mesh_Info(full);
840        if (full) {
841            cout << "     Id  Coordinates" << endl;
842            cout.precision(15);
843            cout.setf(ios::scientific, ios::floatfield);
844            pair<double,double> xdx = getFirstCoordAndSpacing(0);
845            pair<double,double> ydy = getFirstCoordAndSpacing(1);
846            pair<double,double> zdz = getFirstCoordAndSpacing(2);
847            for (index_t i=0; i < getNumNodes(); i++) {
848                cout << "  " << setw(5) << m_nodeId[i]
849                    << "  " << xdx.first+(i%m_N0)*xdx.second
850                    << "  " << ydy.first+(i%(m_N0*m_N1)/m_N0)*ydy.second
851                    << "  " << zdz.first+(i/(m_N0*m_N1))*zdz.second << endl;
852            }
853        }
854    }
855    
856    IndexVector Brick::getNumNodesPerDim() const
857    {
858        IndexVector ret;
859        ret.push_back(m_N0);
860        ret.push_back(m_N1);
861        ret.push_back(m_N2);
862        return ret;
863    }
864    
865    IndexVector Brick::getNumElementsPerDim() const
866    {
867        IndexVector ret;
868        ret.push_back(m_NE0);
869        ret.push_back(m_NE1);
870        ret.push_back(m_NE2);
871        return ret;
872    }
873    
874    IndexVector Brick::getNumFacesPerBoundary() const
875    {
876        IndexVector ret(6, 0);
877        //left
878        if (m_offset0==0)
879            ret[0]=m_NE1*m_NE2;
880        //right
881        if (m_mpiInfo->rank%m_NX==m_NX-1)
882            ret[1]=m_NE1*m_NE2;
883        //bottom
884        if (m_offset1==0)
885            ret[2]=m_NE0*m_NE2;
886        //top
887        if (m_mpiInfo->rank%(m_NX*m_NY)/m_NX==m_NY-1)
888            ret[3]=m_NE0*m_NE2;
889        //front
890        if (m_offset2==0)
891            ret[4]=m_NE0*m_NE1;
892        //back
893        if (m_mpiInfo->rank/(m_NX*m_NY)==m_NZ-1)
894            ret[5]=m_NE0*m_NE1;
895        return ret;
896    }
897    
898    IndexVector Brick::getNumSubdivisionsPerDim() const
899    {
900        IndexVector ret;
901        ret.push_back(m_NX);
902        ret.push_back(m_NY);
903        ret.push_back(m_NZ);
904        return ret;
905    }
906    
907    pair<double,double> Brick::getFirstCoordAndSpacing(dim_t dim) const
908    {
909        if (dim==0)
910            return pair<double,double>(m_x0+(m_l0*m_offset0)/m_gNE0, m_l0/m_gNE0);
911        else if (dim==1)
912            return pair<double,double>(m_y0+(m_l1*m_offset1)/m_gNE1, m_l1/m_gNE1);
913        else if (dim==2)
914            return pair<double,double>(m_z0+(m_l2*m_offset2)/m_gNE2, m_l2/m_gNE2);
915    
916        throw RipleyException("getFirstCoordAndSpacing: invalid argument");
917    }
918    
919    //protected
920    dim_t Brick::getNumDOF() const
921    {
922        return (m_gNE0+1)/m_NX*(m_gNE1+1)/m_NY*(m_gNE2+1)/m_NZ;
923    }
924    
925    //protected
926    dim_t Brick::getNumFaceElements() const
927    {
928        const IndexVector faces = getNumFacesPerBoundary();
929        dim_t n=0;
930        for (size_t i=0; i<faces.size(); i++)
931            n+=faces[i];
932        return n;
933    }
934    
935    //protected
936    void Brick::assembleCoordinates(escript::Data& arg) const
937    {
938        escriptDataC x = arg.getDataC();
939        int numDim = m_numDim;
940        if (!isDataPointShapeEqual(&x, 1, &numDim))
941            throw RipleyException("setToX: Invalid Data object shape");
942        if (!numSamplesEqual(&x, 1, getNumNodes()))
943            throw RipleyException("setToX: Illegal number of samples in Data object");
944    
945        pair<double,double> xdx = getFirstCoordAndSpacing(0);
946        pair<double,double> ydy = getFirstCoordAndSpacing(1);
947        pair<double,double> zdz = getFirstCoordAndSpacing(2);
948        arg.requireWrite();
949    #pragma omp parallel for
950        for (dim_t i2 = 0; i2 < m_N2; i2++) {
951            for (dim_t i1 = 0; i1 < m_N1; i1++) {
952                for (dim_t i0 = 0; i0 < m_N0; i0++) {
953                    double* point = arg.getSampleDataRW(i0+m_N0*i1+m_N0*m_N1*i2);
954                    point[0] = xdx.first+i0*xdx.second;
955                    point[1] = ydy.first+i1*ydy.second;
956                    point[2] = zdz.first+i2*zdz.second;
957                }
958            }
959        }
960    }
961    
962    //protected
963    void Brick::assembleGradient(escript::Data& out, escript::Data& in) const
964  {  {
     escript::Data& in = *const_cast<escript::Data*>(&cIn);  
965      const dim_t numComp = in.getDataPointSize();      const dim_t numComp = in.getDataPointSize();
966      const double h0 = m_l0/m_gNE0;      const double h0 = m_l0/m_gNE0;
967      const double h1 = m_l1/m_gNE1;      const double h1 = m_l1/m_gNE1;
968      const double h2 = m_l1/m_gNE2;      const double h2 = m_l2/m_gNE2;
969      const double C0 = .044658198738520451079;      const double C0 = .044658198738520451079;
970      const double C1 = .16666666666666666667;      const double C1 = .16666666666666666667;
971      const double C2 = .21132486540518711775;      const double C2 = .21132486540518711775;
# Line 317  void Brick::setToGradient(escript::Data& Line 975  void Brick::setToGradient(escript::Data&
975      const double C6 = .78867513459481288225;      const double C6 = .78867513459481288225;
976    
977      if (out.getFunctionSpace().getTypeCode() == Elements) {      if (out.getFunctionSpace().getTypeCode() == Elements) {
978          /*** GENERATOR SNIP_GRAD_ELEMENTS TOP */          out.requireWrite();
979  #pragma omp parallel for  #pragma omp parallel
980          for (index_t k2=0; k2 < m_NE2; ++k2) {          {
981              for (index_t k1=0; k1 < m_NE1; ++k1) {              vector<double> f_000(numComp);
982                  for (index_t k0=0; k0 < m_NE0; ++k0) {              vector<double> f_001(numComp);
983                      const register double* f_000 = in.getSampleDataRO(INDEX3(k0,k1,k2, m_N0,m_N1));              vector<double> f_010(numComp);
984                      const register double* f_001 = in.getSampleDataRO(INDEX3(k0,k1,k2+1, m_N0,m_N1));              vector<double> f_011(numComp);
985                      const register double* f_101 = in.getSampleDataRO(INDEX3(k0+1,k1,k2+1, m_N0,m_N1));              vector<double> f_100(numComp);
986                      const register double* f_111 = in.getSampleDataRO(INDEX3(k0+1,k1+1,k2+1, m_N0,m_N1));              vector<double> f_101(numComp);
987                      const register double* f_110 = in.getSampleDataRO(INDEX3(k0+1,k1+1,k2, m_N0,m_N1));              vector<double> f_110(numComp);
988                      const register double* f_011 = in.getSampleDataRO(INDEX3(k0,k1+1,k2+1, m_N0,m_N1));              vector<double> f_111(numComp);
989                      const register double* f_010 = in.getSampleDataRO(INDEX3(k0,k1+1,k2, m_N0,m_N1));  #pragma omp for
990                      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) {
991                      double* o = out.getSampleDataRW(INDEX3(k0,k1,k2,m_NE0,m_NE1));                  for (index_t k1=0; k1 < m_NE1; ++k1) {
992                      for (index_t i=0; i < numComp; ++i) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
993                          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));
994                          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));
995                          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));
996                          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));
997                          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));
998                          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));
999                          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));
1000                          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));
1001                          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));
1002                          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) {
1003                          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;
1004                          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;
1005                          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;
1006                          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;
1007                          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;
1008                          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;
1009                          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;
1010                          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;
1011                          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;
1012                          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;
1013                          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;
1014                          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;
1015                          o[INDEX3(i,1,3,numComp,3)] = V5;                              o[INDEX3(i,0,0,numComp,3)] = V0;
1016                          o[INDEX3(i,2,3,numComp,3)] = V11;                              o[INDEX3(i,1,0,numComp,3)] = V4;
1017                          o[INDEX3(i,0,4,numComp,3)] = V2;                              o[INDEX3(i,2,0,numComp,3)] = V8;
1018                          o[INDEX3(i,1,4,numComp,3)] = V6;                              o[INDEX3(i,0,1,numComp,3)] = V0;
1019                          o[INDEX3(i,2,4,numComp,3)] = V8;                              o[INDEX3(i,1,1,numComp,3)] = V5;
1020                          o[INDEX3(i,0,5,numComp,3)] = V2;                              o[INDEX3(i,2,1,numComp,3)] = V9;
1021                          o[INDEX3(i,1,5,numComp,3)] = V7;                              o[INDEX3(i,0,2,numComp,3)] = V1;
1022                          o[INDEX3(i,2,5,numComp,3)] = V9;                              o[INDEX3(i,1,2,numComp,3)] = V4;
1023                          o[INDEX3(i,0,6,numComp,3)] = V3;                              o[INDEX3(i,2,2,numComp,3)] = V10;
1024                          o[INDEX3(i,1,6,numComp,3)] = V6;                              o[INDEX3(i,0,3,numComp,3)] = V1;
1025                          o[INDEX3(i,2,6,numComp,3)] = V10;                              o[INDEX3(i,1,3,numComp,3)] = V5;
1026                          o[INDEX3(i,0,7,numComp,3)] = V3;                              o[INDEX3(i,2,3,numComp,3)] = V11;
1027                          o[INDEX3(i,1,7,numComp,3)] = V7;                              o[INDEX3(i,0,4,numComp,3)] = V2;
1028                          o[INDEX3(i,2,7,numComp,3)] = V11;                              o[INDEX3(i,1,4,numComp,3)] = V6;
1029                      } /* end of component loop i */                              o[INDEX3(i,2,4,numComp,3)] = V8;
1030                  } /* end of k0 loop */                              o[INDEX3(i,0,5,numComp,3)] = V2;
1031              } /* end of k1 loop */                              o[INDEX3(i,1,5,numComp,3)] = V7;
1032          } /* end of k2 loop */                              o[INDEX3(i,2,5,numComp,3)] = V9;
1033          /* GENERATOR SNIP_GRAD_ELEMENTS BOTTOM */                              o[INDEX3(i,0,6,numComp,3)] = V3;
1034                                o[INDEX3(i,1,6,numComp,3)] = V6;
1035                                o[INDEX3(i,2,6,numComp,3)] = V10;
1036                                o[INDEX3(i,0,7,numComp,3)] = V3;
1037                                o[INDEX3(i,1,7,numComp,3)] = V7;
1038                                o[INDEX3(i,2,7,numComp,3)] = V11;
1039                            } // end of component loop i
1040                        } // end of k0 loop
1041                    } // end of k1 loop
1042                } // end of k2 loop
1043            } // end of parallel section
1044      } else if (out.getFunctionSpace().getTypeCode() == ReducedElements) {      } else if (out.getFunctionSpace().getTypeCode() == ReducedElements) {
1045          /*** GENERATOR SNIP_GRAD_REDUCED_ELEMENTS TOP */          out.requireWrite();
1046  #pragma omp parallel for  #pragma omp parallel
1047          for (index_t k2=0; k2 < m_NE2; ++k2) {          {
1048              for (index_t k1=0; k1 < m_NE1; ++k1) {              vector<double> f_000(numComp);
1049                  for (index_t k0=0; k0 < m_NE0; ++k0) {              vector<double> f_001(numComp);
1050                      const register double* f_000 = in.getSampleDataRO(INDEX3(k0,k1,k2, m_N0,m_N1));              vector<double> f_010(numComp);
1051                      const register double* f_001 = in.getSampleDataRO(INDEX3(k0,k1,k2+1, m_N0,m_N1));              vector<double> f_011(numComp);
1052                      const register double* f_101 = in.getSampleDataRO(INDEX3(k0+1,k1,k2+1, m_N0,m_N1));              vector<double> f_100(numComp);
1053                      const register double* f_011 = in.getSampleDataRO(INDEX3(k0,k1+1,k2+1, m_N0,m_N1));              vector<double> f_101(numComp);
1054                      const register double* f_100 = in.getSampleDataRO(INDEX3(k0+1,k1,k2, m_N0,m_N1));              vector<double> f_110(numComp);
1055                      const register double* f_110 = in.getSampleDataRO(INDEX3(k0+1,k1+1,k2, m_N0,m_N1));              vector<double> f_111(numComp);
1056                      const register double* f_010 = in.getSampleDataRO(INDEX3(k0,k1+1,k2, m_N0,m_N1));  #pragma omp for
1057                      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) {
1058                      double* o = out.getSampleDataRW(INDEX3(k0,k1,k2,m_NE0,m_NE1));                  for (index_t k1=0; k1 < m_NE1; ++k1) {
1059                      for (index_t i=0; i < numComp; ++i) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
1060                          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));
1061                          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));
1062                          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));
1063                      } /* end of component loop i */                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1064                  } /* end of k0 loop */                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
1065              } /* end of k1 loop */                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1066          } /* end of k2 loop */                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
1067          /* 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));
1068                            double* o = out.getSampleDataRW(INDEX3(k0,k1,k2,m_NE0,m_NE1));
1069                            for (index_t i=0; i < numComp; ++i) {
1070                                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;
1071                                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;
1072                                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;
1073                            } // end of component loop i
1074                        } // end of k0 loop
1075                    } // end of k1 loop
1076                } // end of k2 loop
1077            } // end of parallel section
1078      } else if (out.getFunctionSpace().getTypeCode() == FaceElements) {      } else if (out.getFunctionSpace().getTypeCode() == FaceElements) {
1079          /*** GENERATOR SNIP_GRAD_FACES TOP */          out.requireWrite();
1080  #pragma omp parallel  #pragma omp parallel
1081          {          {
1082                vector<double> f_000(numComp);
1083                vector<double> f_001(numComp);
1084                vector<double> f_010(numComp);
1085                vector<double> f_011(numComp);
1086                vector<double> f_100(numComp);
1087                vector<double> f_101(numComp);
1088                vector<double> f_110(numComp);
1089                vector<double> f_111(numComp);
1090              if (m_faceOffset[0] > -1) {              if (m_faceOffset[0] > -1) {
1091  #pragma omp for nowait  #pragma omp for nowait
1092                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE2; ++k2) {
1093                      for (index_t k1=0; k1 < m_NE1; ++k1) {                      for (index_t k1=0; k1 < m_NE1; ++k1) {
1094                          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));
1095                          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));
1096                          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));
1097                          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));
1098                          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));
1099                          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));
1100                          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));
1101                          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));
1102                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));
1103                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1104                              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 1117  void Brick::setToGradient(escript::Data&
1117                              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;
1118                              o[INDEX3(i,1,3,numComp,3)] = V1;                              o[INDEX3(i,1,3,numComp,3)] = V1;
1119                              o[INDEX3(i,2,3,numComp,3)] = V3;                              o[INDEX3(i,2,3,numComp,3)] = V3;
1120                          } /* end of component loop i */                          } // end of component loop i
1121                      } /* end of k1 loop */                      } // end of k1 loop
1122                  } /* end of k2 loop */                  } // end of k2 loop
1123              } /* end of face 0 */              } // end of face 0
1124              if (m_faceOffset[1] > -1) {              if (m_faceOffset[1] > -1) {
1125  #pragma omp for nowait  #pragma omp for nowait
1126                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE2; ++k2) {
1127                      for (index_t k1=0; k1 < m_NE1; ++k1) {                      for (index_t k1=0; k1 < m_NE1; ++k1) {
1128                          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));
1129                          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));
1130                          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));
1131                          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));
1132                          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));
1133                          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));
1134                          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));
1135                          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));
1136                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));
1137                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1138                              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 1151  void Brick::setToGradient(escript::Data&
1151                              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;
1152                              o[INDEX3(i,1,3,numComp,3)] = V1;                              o[INDEX3(i,1,3,numComp,3)] = V1;
1153                              o[INDEX3(i,2,3,numComp,3)] = V3;                              o[INDEX3(i,2,3,numComp,3)] = V3;
1154                          } /* end of component loop i */                          } // end of component loop i
1155                      } /* end of k1 loop */                      } // end of k1 loop
1156                  } /* end of k2 loop */                  } // end of k2 loop
1157              } /* end of face 1 */              } // end of face 1
1158              if (m_faceOffset[2] > -1) {              if (m_faceOffset[2] > -1) {
1159  #pragma omp for nowait  #pragma omp for nowait
1160                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE2; ++k2) {
1161                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
1162                          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));
1163                          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));
1164                          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));
1165                          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));
1166                          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));
1167                          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));
1168                          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));
1169                          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));
1170                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));
1171                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1172                              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 1184  void Brick::setToGradient(escript::Data&
1184                              o[INDEX3(i,0,3,numComp,3)] = V0;                              o[INDEX3(i,0,3,numComp,3)] = V0;
1185                              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;
1186                              o[INDEX3(i,2,3,numComp,3)] = V2;                              o[INDEX3(i,2,3,numComp,3)] = V2;
1187                          } /* end of component loop i */                          } // end of component loop i
1188                      } /* end of k0 loop */                      } // end of k0 loop
1189                  } /* end of k2 loop */                  } // end of k2 loop
1190              } /* end of face 2 */              } // end of face 2
1191              if (m_faceOffset[3] > -1) {              if (m_faceOffset[3] > -1) {
1192  #pragma omp for nowait  #pragma omp for nowait
1193                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE2; ++k2) {
1194                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
1195                          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));
1196                          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));
1197                          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));
1198                          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));
1199                          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));
1200                          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));
1201                          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));
1202                          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));
1203                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));
1204                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1205                              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 1218  void Brick::setToGradient(escript::Data&
1218                              o[INDEX3(i,0,3,numComp,3)] = V1;                              o[INDEX3(i,0,3,numComp,3)] = V1;
1219                              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;
1220                              o[INDEX3(i,2,3,numComp,3)] = V3;                              o[INDEX3(i,2,3,numComp,3)] = V3;
1221                          } /* end of component loop i */                          } // end of component loop i
1222                      } /* end of k0 loop */                      } // end of k0 loop
1223                  } /* end of k2 loop */                  } // end of k2 loop
1224              } /* end of face 3 */              } // end of face 3
1225              if (m_faceOffset[4] > -1) {              if (m_faceOffset[4] > -1) {
1226  #pragma omp for nowait  #pragma omp for nowait
1227                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1=0; k1 < m_NE1; ++k1) {
1228                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
1229                          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));
1230                          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));
1231                          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));
1232                          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));
1233                          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));
1234                          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));
1235                          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));
1236                          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));
1237                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));
1238                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1239                              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 1252  void Brick::setToGradient(escript::Data&
1252                              o[INDEX3(i,0,3,numComp,3)] = V1;                              o[INDEX3(i,0,3,numComp,3)] = V1;
1253                              o[INDEX3(i,1,3,numComp,3)] = V3;                              o[INDEX3(i,1,3,numComp,3)] = V3;
1254                              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;
1255                          } /* end of component loop i */                          } // end of component loop i
1256                      } /* end of k0 loop */                      } // end of k0 loop
1257                  } /* end of k1 loop */                  } // end of k1 loop
1258              } /* end of face 4 */              } // end of face 4
1259              if (m_faceOffset[5] > -1) {              if (m_faceOffset[5] > -1) {
1260  #pragma omp for nowait  #pragma omp for nowait
1261                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1=0; k1 < m_NE1; ++k1) {
1262                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
1263                          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));
1264                          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));
1265                          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));
1266                          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));
1267                          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));
1268                          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));
1269                          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));
1270                          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));
1271                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));
1272                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1273                              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 1286  void Brick::setToGradient(escript::Data&
1286                              o[INDEX3(i,0,3,numComp,3)] = V1;                              o[INDEX3(i,0,3,numComp,3)] = V1;
1287                              o[INDEX3(i,1,3,numComp,3)] = V3;                              o[INDEX3(i,1,3,numComp,3)] = V3;
1288                              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;
1289                          } /* end of component loop i */                          } // end of component loop i
1290                      } /* end of k0 loop */                      } // end of k0 loop
1291                  } /* end of k1 loop */                  } // end of k1 loop
1292              } /* end of face 5 */              } // end of face 5
1293          } // end of parallel section          } // end of parallel section
         /* GENERATOR SNIP_GRAD_FACES BOTTOM */  
1294      } else if (out.getFunctionSpace().getTypeCode() == ReducedFaceElements) {      } else if (out.getFunctionSpace().getTypeCode() == ReducedFaceElements) {
1295          /*** GENERATOR SNIP_GRAD_REDUCED_FACES TOP */          out.requireWrite();
1296  #pragma omp parallel  #pragma omp parallel
1297          {          {
1298                vector<double> f_000(numComp);
1299                vector<double> f_001(numComp);
1300                vector<double> f_010(numComp);
1301                vector<double> f_011(numComp);
1302                vector<double> f_100(numComp);
1303                vector<double> f_101(numComp);
1304                vector<double> f_110(numComp);
1305                vector<double> f_111(numComp);
1306              if (m_faceOffset[0] > -1) {              if (m_faceOffset[0] > -1) {
1307  #pragma omp for nowait  #pragma omp for nowait
1308                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE2; ++k2) {
1309                      for (index_t k1=0; k1 < m_NE1; ++k1) {                      for (index_t k1=0; k1 < m_NE1; ++k1) {
1310                          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));
1311                          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));
1312                          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));
1313                          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));
1314                          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));
1315                          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));
1316                          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));
1317                          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));
1318                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));
1319                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1320                              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;
1321                              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;
1322                              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;
1323                          } /* end of component loop i */                          } // end of component loop i
1324                      } /* end of k1 loop */                      } // end of k1 loop
1325                  } /* end of k2 loop */                  } // end of k2 loop
1326              } /* end of face 0 */              } // end of face 0
1327              if (m_faceOffset[1] > -1) {              if (m_faceOffset[1] > -1) {
1328  #pragma omp for nowait  #pragma omp for nowait
1329                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE2; ++k2) {
1330                      for (index_t k1=0; k1 < m_NE1; ++k1) {                      for (index_t k1=0; k1 < m_NE1; ++k1) {
1331                          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));
1332                          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));
1333                          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));
1334                          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));
1335                          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));
1336                          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));
1337                          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));
1338                          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));
1339                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));
1340                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1341                              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;
1342                              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;
1343                              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;
1344                          } /* end of component loop i */                          } // end of component loop i
1345                      } /* end of k1 loop */                      } // end of k1 loop
1346                  } /* end of k2 loop */                  } // end of k2 loop
1347              } /* end of face 1 */              } // end of face 1
1348              if (m_faceOffset[2] > -1) {              if (m_faceOffset[2] > -1) {
1349  #pragma omp for nowait  #pragma omp for nowait
1350                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE2; ++k2) {
1351                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
1352                          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));
1353                          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));
1354                          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));
1355                          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));
1356                          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));
1357                          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));
1358                          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));
1359                          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));
1360                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));
1361                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1362                              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;
1363                              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;
1364                              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;
1365                          } /* end of component loop i */                          } // end of component loop i
1366                      } /* end of k0 loop */                      } // end of k0 loop
1367                  } /* end of k2 loop */                  } // end of k2 loop
1368              } /* end of face 2 */              } // end of face 2
1369              if (m_faceOffset[3] > -1) {              if (m_faceOffset[3] > -1) {
1370  #pragma omp for nowait  #pragma omp for nowait
1371                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE2; ++k2) {
1372                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
1373                          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));
1374                          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));
1375                          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));
1376                          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));
1377                          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));
1378                          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));
1379                          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));
1380                          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));
1381                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));
1382                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1383                              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;
1384                              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;
1385                              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;
1386                          } /* end of component loop i */                          } // end of component loop i
1387                      } /* end of k0 loop */                      } // end of k0 loop
1388                  } /* end of k2 loop */                  } // end of k2 loop
1389              } /* end of face 3 */              } // end of face 3
1390              if (m_faceOffset[4] > -1) {              if (m_faceOffset[4] > -1) {
1391  #pragma omp for nowait  #pragma omp for nowait
1392                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1=0; k1 < m_NE1; ++k1) {
1393                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
1394                          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));
1395                          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));
1396                          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));
1397                          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));
1398                          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));
1399                          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));
1400                          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));
1401                          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));
1402                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));
1403                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1404                              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;
1405                              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;
1406                              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;
1407                          } /* end of component loop i */                          } // end of component loop i
1408                      } /* end of k0 loop */                      } // end of k0 loop
1409                  } /* end of k1 loop */                  } // end of k1 loop
1410              } /* end of face 4 */              } // end of face 4
1411              if (m_faceOffset[5] > -1) {              if (m_faceOffset[5] > -1) {
1412  #pragma omp for nowait  #pragma omp for nowait
1413                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1=0; k1 < m_NE1; ++k1) {
1414                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
1415                          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));
1416                          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));
1417                          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));
1418                          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));
1419                          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));
1420                          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));
1421                          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));
1422                          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));
1423                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));
1424                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1425                              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;
1426                              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;
1427                              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;
1428                          } /* end of component loop i */                          } // end of component loop i
1429                      } /* end of k0 loop */                      } // end of k0 loop
1430                  } /* end of k1 loop */                  } // end of k1 loop
1431              } /* end of face 5 */              } // end of face 5
1432          } // 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());  
1433      }      }
1434  }  }
1435    
1436  void Brick::setToIntegrals(vector<double>& integrals, const escript::Data& arg) const  //protected
1437    void Brick::assembleIntegrate(vector<double>& integrals, escript::Data& arg) const
1438  {  {
1439      escript::Data& in = *const_cast<escript::Data*>(&arg);      const dim_t numComp = arg.getDataPointSize();
     const dim_t numComp = in.getDataPointSize();  
1440      const double h0 = m_l0/m_gNE0;      const double h0 = m_l0/m_gNE0;
1441      const double h1 = m_l1/m_gNE1;      const double h1 = m_l1/m_gNE1;
1442      const double h2 = m_l2/m_gNE2;      const double h2 = m_l2/m_gNE2;
1443      if (arg.getFunctionSpace().getTypeCode() == Elements) {      const index_t left = (m_offset0==0 ? 0 : 1);
1444        const index_t bottom = (m_offset1==0 ? 0 : 1);
1445        const index_t front = (m_offset2==0 ? 0 : 1);
1446        const int fs = arg.getFunctionSpace().getTypeCode();
1447        if (fs == Elements && arg.actsExpanded()) {
1448          const double w_0 = h0*h1*h2/8.;          const double w_0 = h0*h1*h2/8.;
1449  #pragma omp parallel  #pragma omp parallel
1450          {          {
1451              vector<double> int_local(numComp, 0);              vector<double> int_local(numComp, 0);
1452  #pragma omp for nowait  #pragma omp for nowait
1453              for (index_t k2 = 0; k2 < m_NE2; ++k2) {              for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {
1454                  for (index_t k1 = 0; k1 < m_NE1; ++k1) {                  for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {
1455                      for (index_t k0 = 0; k0 < m_NE0; ++k0) {                      for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {
1456                          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));
1457                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1458                              const register double f_0 = f[INDEX2(i,0,numComp)];                              const double f_0 = f[INDEX2(i,0,numComp)];
1459                              const register double f_1 = f[INDEX2(i,1,numComp)];                              const double f_1 = f[INDEX2(i,1,numComp)];
1460                              const register double f_2 = f[INDEX2(i,2,numComp)];                              const double f_2 = f[INDEX2(i,2,numComp)];
1461                              const register double f_3 = f[INDEX2(i,3,numComp)];                              const double f_3 = f[INDEX2(i,3,numComp)];
1462                              const register double f_4 = f[INDEX2(i,4,numComp)];                              const double f_4 = f[INDEX2(i,4,numComp)];
1463                              const register double f_5 = f[INDEX2(i,5,numComp)];                              const double f_5 = f[INDEX2(i,5,numComp)];
1464                              const register double f_6 = f[INDEX2(i,6,numComp)];                              const double f_6 = f[INDEX2(i,6,numComp)];
1465                              const register double f_7 = f[INDEX2(i,7,numComp)];                              const double f_7 = f[INDEX2(i,7,numComp)];
1466                              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;
1467                          }  /* end of component loop i */                          }  // end of component loop i
1468                      } /* end of k0 loop */                      } // end of k0 loop
1469                  } /* end of k1 loop */                  } // end of k1 loop
1470              } /* end of k2 loop */              } // end of k2 loop
1471    
1472  #pragma omp critical  #pragma omp critical
1473              for (index_t i=0; i<numComp; i++)              for (index_t i=0; i<numComp; i++)
1474                  integrals[i]+=int_local[i];                  integrals[i]+=int_local[i];
1475          } // end of parallel section          } // end of parallel section
1476      } else if (arg.getFunctionSpace().getTypeCode() == ReducedElements) {  
1477        } else if (fs==ReducedElements || (fs==Elements && !arg.actsExpanded())) {
1478          const double w_0 = h0*h1*h2;          const double w_0 = h0*h1*h2;
1479  #pragma omp parallel  #pragma omp parallel
1480          {          {
1481              vector<double> int_local(numComp, 0);              vector<double> int_local(numComp, 0);
1482  #pragma omp for nowait  #pragma omp for nowait
1483              for (index_t k2 = 0; k2 < m_NE2; ++k2) {              for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {
1484                  for (index_t k1 = 0; k1 < m_NE1; ++k1) {                  for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {
1485                      for (index_t k0 = 0; k0 < m_NE0; ++k0) {                      for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {
1486                          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));
1487                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1488                              int_local[i]+=f[i]*w_0;                              int_local[i]+=f[i]*w_0;
1489                          }  /* end of component loop i */                          }  // end of component loop i
1490                      } /* end of k0 loop */                      } // end of k0 loop
1491                  } /* end of k1 loop */                  } // end of k1 loop
1492              } /* end of k2 loop */              } // end of k2 loop
1493    
1494  #pragma omp critical  #pragma omp critical
1495              for (index_t i=0; i<numComp; i++)              for (index_t i=0; i<numComp; i++)
1496                  integrals[i]+=int_local[i];                  integrals[i]+=int_local[i];
1497          } // end of parallel section          } // end of parallel section
1498      } else if (arg.getFunctionSpace().getTypeCode() == FaceElements) {  
1499        } else if (fs == FaceElements && arg.actsExpanded()) {
1500          const double w_0 = h1*h2/4.;          const double w_0 = h1*h2/4.;
1501          const double w_1 = h0*h2/4.;          const double w_1 = h0*h2/4.;
1502          const double w_2 = h0*h1/4.;          const double w_2 = h0*h1/4.;
# Line 812  void Brick::setToIntegrals(vector<double Line 1505  void Brick::setToIntegrals(vector<double
1505              vector<double> int_local(numComp, 0);              vector<double> int_local(numComp, 0);
1506              if (m_faceOffset[0] > -1) {              if (m_faceOffset[0] > -1) {
1507  #pragma omp for nowait  #pragma omp for nowait
1508                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {
1509                      for (index_t k1=0; k1 < m_NE1; ++k1) {                      for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {
1510                          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));
1511                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1512                              const register double f_0 = f[INDEX2(i,0,numComp)];                              const double f_0 = f[INDEX2(i,0,numComp)];
1513                              const register double f_1 = f[INDEX2(i,1,numComp)];                              const double f_1 = f[INDEX2(i,1,numComp)];
1514                              const register double f_2 = f[INDEX2(i,2,numComp)];                              const double f_2 = f[INDEX2(i,2,numComp)];
1515                              const register double f_3 = f[INDEX2(i,3,numComp)];                              const double f_3 = f[INDEX2(i,3,numComp)];
1516                              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;
1517                          }  /* end of component loop i */                          }  // end of component loop i
1518                      } /* end of k1 loop */                      } // end of k1 loop
1519                  } /* end of k2 loop */                  } // end of k2 loop
1520              }              }
1521    
1522              if (m_faceOffset[1] > -1) {              if (m_faceOffset[1] > -1) {
1523  #pragma omp for nowait  #pragma omp for nowait
1524                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {
1525                      for (index_t k1=0; k1 < m_NE1; ++k1) {                      for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {
1526                          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));
1527                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1528                              const register double f_0 = f[INDEX2(i,0,numComp)];                              const double f_0 = f[INDEX2(i,0,numComp)];
1529                              const register double f_1 = f[INDEX2(i,1,numComp)];                              const double f_1 = f[INDEX2(i,1,numComp)];
1530                              const register double f_2 = f[INDEX2(i,2,numComp)];                              const double f_2 = f[INDEX2(i,2,numComp)];
1531                              const register double f_3 = f[INDEX2(i,3,numComp)];                              const double f_3 = f[INDEX2(i,3,numComp)];
1532                              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;
1533                          }  /* end of component loop i */                          }  // end of component loop i
1534                      } /* end of k1 loop */                      } // end of k1 loop
1535                  } /* end of k2 loop */                  } // end of k2 loop
1536              }              }
1537    
1538              if (m_faceOffset[2] > -1) {              if (m_faceOffset[2] > -1) {
1539  #pragma omp for nowait  #pragma omp for nowait
1540                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {
1541                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {
1542                          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));
1543                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1544                              const register double f_0 = f[INDEX2(i,0,numComp)];                              const double f_0 = f[INDEX2(i,0,numComp)];
1545                              const register double f_1 = f[INDEX2(i,1,numComp)];                              const double f_1 = f[INDEX2(i,1,numComp)];
1546                              const register double f_2 = f[INDEX2(i,2,numComp)];                              const double f_2 = f[INDEX2(i,2,numComp)];
1547                              const register double f_3 = f[INDEX2(i,3,numComp)];                              const double f_3 = f[INDEX2(i,3,numComp)];
1548                              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;
1549                          }  /* end of component loop i */                          }  // end of component loop i
1550                      } /* end of k1 loop */                      } // end of k1 loop
1551                  } /* end of k2 loop */                  } // end of k2 loop
1552              }              }
1553    
1554              if (m_faceOffset[3] > -1) {              if (m_faceOffset[3] > -1) {
1555  #pragma omp for nowait  #pragma omp for nowait
1556                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {
1557                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {
1558                          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));
1559                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1560                              const register double f_0 = f[INDEX2(i,0,numComp)];                              const double f_0 = f[INDEX2(i,0,numComp)];
1561                              const register double f_1 = f[INDEX2(i,1,numComp)];                              const double f_1 = f[INDEX2(i,1,numComp)];
1562                              const register double f_2 = f[INDEX2(i,2,numComp)];                              const double f_2 = f[INDEX2(i,2,numComp)];
1563                              const register double f_3 = f[INDEX2(i,3,numComp)];                              const double f_3 = f[INDEX2(i,3,numComp)];
1564                              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;
1565                          }  /* end of component loop i */                          }  // end of component loop i
1566                      } /* end of k1 loop */                      } // end of k1 loop
1567                  } /* end of k2 loop */                  } // end of k2 loop
1568              }              }
1569    
1570              if (m_faceOffset[4] > -1) {              if (m_faceOffset[4] > -1) {
1571  #pragma omp for nowait  #pragma omp for nowait
1572                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {
1573                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {
1574                          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));
1575                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1576                              const register double f_0 = f[INDEX2(i,0,numComp)];                              const double f_0 = f[INDEX2(i,0,numComp)];
1577                              const register double f_1 = f[INDEX2(i,1,numComp)];                              const double f_1 = f[INDEX2(i,1,numComp)];
1578                              const register double f_2 = f[INDEX2(i,2,numComp)];                              const double f_2 = f[INDEX2(i,2,numComp)];
1579                              const register double f_3 = f[INDEX2(i,3,numComp)];                              const double f_3 = f[INDEX2(i,3,numComp)];
1580                              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;
1581                          }  /* end of component loop i */                          }  // end of component loop i
1582                      } /* end of k1 loop */                      } // end of k1 loop
1583                  } /* end of k2 loop */                  } // end of k2 loop
1584              }              }
1585    
1586              if (m_faceOffset[5] > -1) {              if (m_faceOffset[5] > -1) {
1587  #pragma omp for nowait  #pragma omp for nowait
1588                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {
1589                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {
1590                          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));
1591                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1592                              const register double f_0 = f[INDEX2(i,0,numComp)];                              const double f_0 = f[INDEX2(i,0,numComp)];
1593                              const register double f_1 = f[INDEX2(i,1,numComp)];                              const double f_1 = f[INDEX2(i,1,numComp)];
1594                              const register double f_2 = f[INDEX2(i,2,numComp)];                              const double f_2 = f[INDEX2(i,2,numComp)];
1595                              const register double f_3 = f[INDEX2(i,3,numComp)];                              const double f_3 = f[INDEX2(i,3,numComp)];
1596                              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;
1597                          }  /* end of component loop i */                          }  // end of component loop i
1598                      } /* end of k1 loop */                      } // end of k1 loop
1599                  } /* end of k2 loop */                  } // end of k2 loop
1600              }              }
1601    
1602  #pragma omp critical  #pragma omp critical
# Line 911  void Brick::setToIntegrals(vector<double Line 1604  void Brick::setToIntegrals(vector<double
1604                  integrals[i]+=int_local[i];                  integrals[i]+=int_local[i];
1605          } // end of parallel section          } // end of parallel section
1606    
1607      } else if (arg.getFunctionSpace().getTypeCode() == ReducedFaceElements) {      } else if (fs==ReducedFaceElements || (fs==FaceElements && !arg.actsExpanded())) {
1608          const double w_0 = h1*h2;          const double w_0 = h1*h2;
1609          const double w_1 = h0*h2;          const double w_1 = h0*h2;
1610          const double w_2 = h0*h1;          const double w_2 = h0*h1;
# Line 920  void Brick::setToIntegrals(vector<double Line 1613  void Brick::setToIntegrals(vector<double
1613              vector<double> int_local(numComp, 0);              vector<double> int_local(numComp, 0);
1614              if (m_faceOffset[0] > -1) {              if (m_faceOffset[0] > -1) {
1615  #pragma omp for nowait  #pragma omp for nowait
1616                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {
1617                      for (index_t k1=0; k1 < m_NE1; ++k1) {                      for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {
1618                          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));
1619                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1620                              int_local[i]+=f[i]*w_0;                              int_local[i]+=f[i]*w_0;
1621                          }  /* end of component loop i */                          }  // end of component loop i
1622                      } /* end of k1 loop */                      } // end of k1 loop
1623                  } /* end of k2 loop */                  } // end of k2 loop
1624              }              }
1625    
1626              if (m_faceOffset[1] > -1) {              if (m_faceOffset[1] > -1) {
1627  #pragma omp for nowait  #pragma omp for nowait
1628                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {
1629                      for (index_t k1=0; k1 < m_NE1; ++k1) {                      for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {
1630                          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));
1631                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1632                              int_local[i]+=f[i]*w_0;                              int_local[i]+=f[i]*w_0;
1633                          }  /* end of component loop i */                          }  // end of component loop i
1634                      } /* end of k1 loop */                      } // end of k1 loop
1635                  } /* end of k2 loop */                  } // end of k2 loop
1636              }              }
1637    
1638              if (m_faceOffset[2] > -1) {              if (m_faceOffset[2] > -1) {
1639  #pragma omp for nowait  #pragma omp for nowait
1640                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {
1641                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {
1642                          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));
1643                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1644                              int_local[i]+=f[i]*w_1;                              int_local[i]+=f[i]*w_1;
1645                          }  /* end of component loop i */                          }  // end of component loop i
1646                      } /* end of k1 loop */                      } // end of k1 loop
1647                  } /* end of k2 loop */                  } // end of k2 loop
1648              }              }
1649    
1650              if (m_faceOffset[3] > -1) {              if (m_faceOffset[3] > -1) {
1651  #pragma omp for nowait  #pragma omp for nowait
1652                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {
1653                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {
1654                          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));
1655                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1656                              int_local[i]+=f[i]*w_1;                              int_local[i]+=f[i]*w_1;
1657                          }  /* end of component loop i */                          }  // end of component loop i
1658                      } /* end of k1 loop */                      } // end of k1 loop
1659                  } /* end of k2 loop */                  } // end of k2 loop
1660              }              }
1661    
1662              if (m_faceOffset[4] > -1) {              if (m_faceOffset[4] > -1) {
1663  #pragma omp for nowait  #pragma omp for nowait
1664                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {
1665                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {
1666                          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));
1667                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1668                              int_local[i]+=f[i]*w_2;                              int_local[i]+=f[i]*w_2;
1669                          }  /* end of component loop i */                          }  // end of component loop i
1670                      } /* end of k1 loop */                      } // end of k1 loop
1671                  } /* end of k2 loop */                  } // end of k2 loop
1672              }              }
1673    
1674              if (m_faceOffset[5] > -1) {              if (m_faceOffset[5] > -1) {
1675  #pragma omp for nowait  #pragma omp for nowait
1676                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {
1677                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {
1678                          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));
1679                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1680                              int_local[i]+=f[i]*w_2;                              int_local[i]+=f[i]*w_2;
1681                          }  /* end of component loop i */                          }  // end of component loop i
1682                      } /* end of k1 loop */                      } // end of k1 loop
1683                  } /* end of k2 loop */                  } // end of k2 loop
1684              }              }
1685    
1686  #pragma omp critical  #pragma omp critical
1687              for (index_t i=0; i<numComp; i++)              for (index_t i=0; i<numComp; i++)
1688                  integrals[i]+=int_local[i];                  integrals[i]+=int_local[i];
1689          } // end of parallel section          } // end of parallel section
1690        } // function space selector
     } else {  
         stringstream msg;  
         msg << "setToIntegrals() not implemented for "  
             << functionSpaceTypeAsString(arg.getFunctionSpace().getTypeCode());  
         throw RipleyException(msg.str());  
     }  
1691  }  }
1692    
1693  void Brick::setToNormal(escript::Data& out) const  //protected
1694    dim_t Brick::insertNeighbourNodes(IndexVector& index, index_t node) const
1695  {  {
1696      if (out.getFunctionSpace().getTypeCode() == FaceElements) {      const dim_t nDOF0 = (m_gNE0+1)/m_NX;
1697  #pragma omp parallel      const dim_t nDOF1 = (m_gNE1+1)/m_NY;
1698          {      const dim_t nDOF2 = (m_gNE2+1)/m_NZ;
1699              if (m_faceOffset[0] > -1) {      const int x=node%nDOF0;
1700  #pragma omp for nowait      const int y=node%(nDOF0*nDOF1)/nDOF0;
1701                  for (index_t k2 = 0; k2 < m_NE2; ++k2) {      const int z=node/(nDOF0*nDOF1);
1702                      for (index_t k1 = 0; k1 < m_NE1; ++k1) {      int num=0;
1703                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));      // loop through potential neighbours and add to index if positions are
1704                          // set vector at four quadrature points      // within bounds
1705                          *o++ = -1.; *o++ = 0.; *o++ = 0.;      for (int i2=-1; i2<2; i2++) {
1706                          *o++ = -1.; *o++ = 0.; *o++ = 0.;          for (int i1=-1; i1<2; i1++) {
1707                          *o++ = -1.; *o++ = 0.; *o++ = 0.;              for (int i0=-1; i0<2; i0++) {
1708                          *o++ = -1.; *o++ = 0.; *o = 0.;                  // skip node itself
1709                      }                  if (i0==0 && i1==0 && i2==0)
1710                  }                      continue;
1711              }                  // location of neighbour node
1712                    const int nx=x+i0;
1713              if (m_faceOffset[1] > -1) {                  const int ny=y+i1;
1714  #pragma omp for nowait                  const int nz=z+i2;
1715                  for (index_t k2 = 0; k2 < m_NE2; ++k2) {                  if (nx>=0 && ny>=0 && nz>=0
1716                      for (index_t k1 = 0; k1 < m_NE1; ++k1) {                          && nx<nDOF0 && ny<nDOF1 && nz<nDOF2) {
1717                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));                      index.push_back(nz*nDOF0*nDOF1+ny*nDOF0+nx);
1718                          // 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.;  
                     }  
                 }  
             }  
   
             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.;  
                     }  
1719                  }                  }
1720              }              }
         } // 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;  
1721          }          }
1722      }      }
 }  
1723    
1724  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");  
1725  }  }
1726    
1727  //protected  //protected
1728  dim_t Brick::getNumDOF() const  void Brick::nodesToDOF(escript::Data& out, escript::Data& in) const
1729  {  {
1730      return (m_gNE0+1)/m_NX*(m_gNE1+1)/m_NY*(m_gNE2+1)/m_NZ;      const dim_t numComp = in.getDataPointSize();
1731  }      out.requireWrite();
1732    
1733  //protected      const index_t left = (m_offset0==0 ? 0 : 1);
1734  dim_t Brick::getNumFaceElements() const      const index_t bottom = (m_offset1==0 ? 0 : 1);
1735  {      const index_t front = (m_offset2==0 ? 0 : 1);
1736      const IndexVector faces = getNumFacesPerBoundary();      const dim_t nDOF0 = (m_gNE0+1)/m_NX;
1737      dim_t n=0;      const dim_t nDOF1 = (m_gNE1+1)/m_NY;
1738      for (size_t i=0; i<faces.size(); i++)      const dim_t nDOF2 = (m_gNE2+1)/m_NZ;
1739          n+=faces[i];  #pragma omp parallel for
1740      return n;      for (index_t i=0; i<nDOF2; i++) {
1741            for (index_t j=0; j<nDOF1; j++) {
1742                for (index_t k=0; k<nDOF0; k++) {
1743                    const index_t n=k+left+(j+bottom)*m_N0+(i+front)*m_N0*m_N1;
1744                    const double* src=in.getSampleDataRO(n);
1745                    copy(src, src+numComp, out.getSampleDataRW(k+j*nDOF0+i*nDOF0*nDOF1));
1746                }
1747            }
1748        }
1749  }  }
1750    
1751  //protected  //protected
1752  void Brick::assembleCoordinates(escript::Data& arg) const  void Brick::dofToNodes(escript::Data& out, escript::Data& in) const
1753  {  {
1754      escriptDataC x = arg.getDataC();      const dim_t numComp = in.getDataPointSize();
1755      int numDim = m_numDim;      Paso_Coupler* coupler = Paso_Coupler_alloc(m_connector, numComp);
1756      if (!isDataPointShapeEqual(&x, 1, &numDim))      in.requireWrite();
1757          throw RipleyException("setToX: Invalid Data object shape");      Paso_Coupler_startCollect(coupler, in.getSampleDataRW(0));
1758      if (!numSamplesEqual(&x, 1, getNumNodes()))  
1759          throw RipleyException("setToX: Illegal number of samples in Data object");      const dim_t numDOF = getNumDOF();
1760        out.requireWrite();
1761        const double* buffer = Paso_Coupler_finishCollect(coupler);
1762    
     pair<double,double> xdx = getFirstCoordAndSpacing(0);  
     pair<double,double> ydy = getFirstCoordAndSpacing(1);  
     pair<double,double> zdz = getFirstCoordAndSpacing(2);  
     arg.requireWrite();  
1763  #pragma omp parallel for  #pragma omp parallel for
1764      for (dim_t i2 = 0; i2 < m_N2; i2++) {      for (index_t i=0; i<getNumNodes(); i++) {
1765          for (dim_t i1 = 0; i1 < m_N1; i1++) {          const double* src=(m_dofMap[i]<numDOF ?
1766              for (dim_t i0 = 0; i0 < m_N0; i0++) {                  in.getSampleDataRO(m_dofMap[i])
1767                  double* point = arg.getSampleDataRW(i0+m_N0*i1+m_N0*m_N1*i2);                  : &buffer[(m_dofMap[i]-numDOF)*numComp]);
1768                  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;  
             }  
         }  
1769      }      }
1770  }  }
1771    
# Line 1308  void Brick::populateSampleIds() Line 1776  void Brick::populateSampleIds()
1776      // globally      // globally
1777    
1778      // build node distribution vector first.      // build node distribution vector first.
1779      // rank i owns m_nodeDistribution[i+1]-nodeDistribution[i] nodes      // rank i owns m_nodeDistribution[i+1]-nodeDistribution[i] nodes which is
1780        // constant for all ranks in this implementation
1781      m_nodeDistribution.assign(m_mpiInfo->size+1, 0);      m_nodeDistribution.assign(m_mpiInfo->size+1, 0);
1782      const dim_t numDOF=getNumDOF();      const dim_t numDOF=getNumDOF();
1783      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 1811  void Brick::populateSampleIds()
1811    
1812          // elements          // elements
1813  #pragma omp for nowait  #pragma omp for nowait
1814          for (dim_t k=0; k<getNumElements(); k++)          for (dim_t i2=0; i2<m_NE2; i2++) {
1815              m_elementId[k]=k;              for (dim_t i1=0; i1<m_NE1; i1++) {
1816                    for (dim_t i0=0; i0<m_NE0; i0++) {
1817                        m_elementId[i0+i1*m_NE0+i2*m_NE0*m_NE1] =
1818                            (m_offset2+i2)*m_gNE0*m_gNE1
1819                            +(m_offset1+i1)*m_gNE0
1820                            +m_offset0+i0;
1821                    }
1822                }
1823            }
1824    
1825          // face elements          // face elements
1826  #pragma omp for  #pragma omp for
# Line 1380  void Brick::populateSampleIds() Line 1857  void Brick::populateSampleIds()
1857      updateTagsInUse(FaceElements);      updateTagsInUse(FaceElements);
1858  }  }
1859    
1860    //private
1861    void Brick::createPattern()
1862    {
1863        const dim_t nDOF0 = (m_gNE0+1)/m_NX;
1864        const dim_t nDOF1 = (m_gNE1+1)/m_NY;
1865        const dim_t nDOF2 = (m_gNE2+1)/m_NZ;
1866        const index_t left = (m_offset0==0 ? 0 : 1);
1867        const index_t bottom = (m_offset1==0 ? 0 : 1);
1868        const index_t front = (m_offset2==0 ? 0 : 1);
1869    
1870        // populate node->DOF mapping with own degrees of freedom.
1871        // The rest is assigned in the loop further down
1872        m_dofMap.assign(getNumNodes(), 0);
1873    #pragma omp parallel for
1874        for (index_t i=front; i<front+nDOF2; i++) {
1875            for (index_t j=bottom; j<bottom+nDOF1; j++) {
1876                for (index_t k=left; k<left+nDOF0; k++) {
1877                    m_dofMap[i*m_N0*m_N1+j*m_N0+k]=(i-front)*nDOF0*nDOF1+(j-bottom)*nDOF0+k-left;
1878                }
1879            }
1880        }
1881    
1882        // build list of shared components and neighbours by looping through
1883        // all potential neighbouring ranks and checking if positions are
1884        // within bounds
1885        const dim_t numDOF=nDOF0*nDOF1*nDOF2;
1886        vector<IndexVector> colIndices(numDOF); // for the couple blocks
1887        RankVector neighbour;
1888        IndexVector offsetInShared(1,0);
1889        IndexVector sendShared, recvShared;
1890        int numShared=0;
1891        const int x=m_mpiInfo->rank%m_NX;
1892        const int y=m_mpiInfo->rank%(m_NX*m_NY)/m_NX;
1893        const int z=m_mpiInfo->rank/(m_NX*m_NY);
1894        for (int i2=-1; i2<2; i2++) {
1895            for (int i1=-1; i1<2; i1++) {
1896                for (int i0=-1; i0<2; i0++) {
1897                    // skip this rank
1898                    if (i0==0 && i1==0 && i2==0)
1899                        continue;
1900                    // location of neighbour rank
1901                    const int nx=x+i0;
1902                    const int ny=y+i1;
1903                    const int nz=z+i2;
1904                    if (nx>=0 && ny>=0 && nz>=0 && nx<m_NX && ny<m_NY && nz<m_NZ) {
1905                        neighbour.push_back(nz*m_NX*m_NY+ny*m_NX+nx);
1906                        if (i0==0 && i1==0) {
1907                            // sharing front or back plane
1908                            offsetInShared.push_back(offsetInShared.back()+nDOF0*nDOF1);
1909                            for (dim_t i=0; i<nDOF1; i++) {
1910                                const int firstDOF=(i2==-1 ? i*nDOF0
1911                                        : i*nDOF0 + nDOF0*nDOF1*(nDOF2-1));
1912                                const int firstNode=(i2==-1 ? left+(i+bottom)*m_N0
1913                                        : left+(i+bottom)*m_N0+m_N0*m_N1*(m_N2-1));
1914                                for (dim_t j=0; j<nDOF0; j++, numShared++) {
1915                                    sendShared.push_back(firstDOF+j);
1916                                    recvShared.push_back(numDOF+numShared);
1917                                    if (j>0) {
1918                                        if (i>0)
1919                                            colIndices[firstDOF+j-1-nDOF0].push_back(numShared);
1920                                        colIndices[firstDOF+j-1].push_back(numShared);
1921                                        if (i<nDOF1-1)
1922                                            colIndices[firstDOF+j-1+nDOF0].push_back(numShared);
1923                                    }
1924                                    if (i>0)
1925                                        colIndices[firstDOF+j-nDOF0].push_back(numShared);
1926                                    colIndices[firstDOF+j].push_back(numShared);
1927                                    if (i<nDOF1-1)
1928                                        colIndices[firstDOF+j+nDOF0].push_back(numShared);
1929                                    if (j<nDOF0-1) {
1930                                        if (i>0)
1931                                            colIndices[firstDOF+j+1-nDOF0].push_back(numShared);
1932                                        colIndices[firstDOF+j+1].push_back(numShared);
1933                                        if (i<nDOF1-1)
1934                                            colIndices[firstDOF+j+1+nDOF0].push_back(numShared);
1935                                    }
1936                                    m_dofMap[firstNode+j]=numDOF+numShared;
1937                                }
1938                            }
1939                        } else if (i0==0 && i2==0) {
1940                            // sharing top or bottom plane
1941                            offsetInShared.push_back(offsetInShared.back()+nDOF0*nDOF2);
1942                            for (dim_t i=0; i<nDOF2; i++) {
1943                                const int firstDOF=(i1==-1 ? i*nDOF0*nDOF1
1944                                        : nDOF0*((i+1)*nDOF1-1));
1945                                const int firstNode=(i1==-1 ?
1946                                        left+(i+front)*m_N0*m_N1
1947                                        : left+m_N0*((i+1+front)*m_N1-1));
1948                                for (dim_t j=0; j<nDOF0; j++, numShared++) {
1949                                    sendShared.push_back(firstDOF+j);
1950                                    recvShared.push_back(numDOF+numShared);
1951                                    if (j>0) {
1952                                        if (i>0)
1953                                            colIndices[firstDOF+j-1-nDOF0*nDOF1].push_back(numShared);
1954                                        colIndices[firstDOF+j-1].push_back(numShared);
1955                                        if (i<nDOF2-1)
1956                                            colIndices[firstDOF+j-1+nDOF0*nDOF1].push_back(numShared);
1957                                    }
1958                                    if (i>0)
1959                                        colIndices[firstDOF+j-nDOF0*nDOF1].push_back(numShared);
1960                                    colIndices[firstDOF+j].push_back(numShared);
1961                                    if (i<nDOF2-1)
1962                                        colIndices[firstDOF+j+nDOF0*nDOF1].push_back(numShared);
1963                                    if (j<nDOF0-1) {
1964                                        if (i>0)
1965                                            colIndices[firstDOF+j+1-nDOF0*nDOF1].push_back(numShared);
1966                                        colIndices[firstDOF+j+1].push_back(numShared);
1967                                        if (i<nDOF2-1)
1968                                            colIndices[firstDOF+j+1+nDOF0*nDOF1].push_back(numShared);
1969                                    }
1970                                    m_dofMap[firstNode+j]=numDOF+numShared;
1971                                }
1972                            }
1973                        } else if (i1==0 && i2==0) {
1974                            // sharing left or right plane
1975                            offsetInShared.push_back(offsetInShared.back()+nDOF1*nDOF2);
1976                            for (dim_t i=0; i<nDOF2; i++) {
1977                                const int firstDOF=(i0==-1 ? i*nDOF0*nDOF1
1978                                        : nDOF0*(1+i*nDOF1)-1);
1979                                const int firstNode=(i0==-1 ?
1980                                        (bottom+(i+front)*m_N1)*m_N0
1981                                        : (bottom+1+(i+front)*m_N1)*m_N0-1);
1982                                for (dim_t j=0; j<nDOF1; j++, numShared++) {
1983                                    sendShared.push_back(firstDOF+j*nDOF0);
1984                                    recvShared.push_back(numDOF+numShared);
1985                                    if (j>0) {
1986                                        if (i>0)
1987                                            colIndices[firstDOF+(j-1)*nDOF0-nDOF0*nDOF1].push_back(numShared);
1988                                        colIndices[firstDOF+(j-1)*nDOF0].push_back(numShared);
1989                                        if (i<nDOF2-1)
1990                                            colIndices[firstDOF+(j-1)*nDOF0+nDOF0*nDOF1].push_back(numShared);
1991                                    }
1992                                    if (i>0)
1993                                        colIndices[firstDOF+j*nDOF0-nDOF0*nDOF1].push_back(numShared);
1994                                    colIndices[firstDOF+j*nDOF0].push_back(numShared);
1995                                    if (i<nDOF2-1)
1996                                        colIndices[firstDOF+j*nDOF0+nDOF0*nDOF1].push_back(numShared);
1997                                    if (j<nDOF1-1) {
1998                                        if (i>0)
1999                                            colIndices[firstDOF+(j+1)*nDOF0-nDOF0*nDOF1].push_back(numShared);
2000                                        colIndices[firstDOF+(j+1)*nDOF0].push_back(numShared);
2001                                        if (i<nDOF2-1)
2002                                            colIndices[firstDOF+(j+1)*nDOF0+nDOF0*nDOF1].push_back(numShared);
2003                                    }
2004                                    m_dofMap[firstNode+j*m_N0]=numDOF+numShared;
2005                                }
2006                            }
2007                        } else if (i0==0) {
2008                            // sharing an edge in x direction
2009                            offsetInShared.push_back(offsetInShared.back()+nDOF0);
2010                            const int firstDOF=(i1+1)/2*nDOF0*(nDOF1-1)
2011                                               +(i2+1)/2*nDOF0*nDOF1*(nDOF2-1);
2012                            const int firstNode=left+(i1+1)/2*m_N0*(m_N1-1)
2013                                                +(i2+1)/2*m_N0*m_N1*(m_N2-1);
2014                            for (dim_t i=0; i<nDOF0; i++, numShared++) {
2015                                sendShared.push_back(firstDOF+i);
2016                                recvShared.push_back(numDOF+numShared);
2017                                if (i>0)
2018                                    colIndices[firstDOF+i-1].push_back(numShared);
2019                                colIndices[firstDOF+i].push_back(numShared);
2020                                if (i<nDOF0-1)
2021                                    colIndices[firstDOF+i+1].push_back(numShared);
2022                                m_dofMap[firstNode+i]=numDOF+numShared;
2023                            }
2024                        } else if (i1==0) {
2025                            // sharing an edge in y direction
2026                            offsetInShared.push_back(offsetInShared.back()+nDOF1);
2027                            const int firstDOF=(i0+1)/2*(nDOF0-1)
2028                                               +(i2+1)/2*nDOF0*nDOF1*(nDOF2-1);
2029                            const int firstNode=bottom*m_N0
2030                                                +(i0+1)/2*(m_N0-1)
2031                                                +(i2+1)/2*m_N0*m_N1*(m_N2-1);
2032                            for (dim_t i=0; i<nDOF1; i++, numShared++) {
2033                                sendShared.push_back(firstDOF+i*nDOF0);
2034                                recvShared.push_back(numDOF+numShared);
2035                                if (i>0)
2036                                    colIndices[firstDOF+(i-1)*nDOF0].push_back(numShared);
2037                                colIndices[firstDOF+i*nDOF0].push_back(numShared);
2038                                if (i<nDOF1-1)
2039                                    colIndices[firstDOF+(i+1)*nDOF0].push_back(numShared);
2040                                m_dofMap[firstNode+i*m_N0]=numDOF+numShared;
2041                            }
2042                        } else if (i2==0) {
2043                            // sharing an edge in z direction
2044                            offsetInShared.push_back(offsetInShared.back()+nDOF2);
2045                            const int firstDOF=(i0+1)/2*(nDOF0-1)
2046                                               +(i1+1)/2*nDOF0*(nDOF1-1);
2047                            const int firstNode=front*m_N0*m_N1
2048                                                +(i0+1)/2*(m_N0-1)
2049                                                +(i1+1)/2*m_N0*(m_N1-1);
2050                            for (dim_t i=0; i<nDOF2; i++, numShared++) {
2051                                sendShared.push_back(firstDOF+i*nDOF0*nDOF1);
2052                                recvShared.push_back(numDOF+numShared);
2053                                if (i>0)
2054                                    colIndices[firstDOF+(i-1)*nDOF0*nDOF1].push_back(numShared);
2055                                colIndices[firstDOF+i*nDOF0*nDOF1].push_back(numShared);
2056                                if (i<nDOF2-1)
2057                                    colIndices[firstDOF+(i+1)*nDOF0*nDOF1].push_back(numShared);
2058                                m_dofMap[firstNode+i*m_N0*m_N1]=numDOF+numShared;
2059                            }
2060                        } else {
2061                            // sharing a node
2062                            const int dof=(i0+1)/2*(nDOF0-1)
2063                                          +(i1+1)/2*nDOF0*(nDOF1-1)
2064                                          +(i2+1)/2*nDOF0*nDOF1*(nDOF2-1);
2065                            const int node=(i0+1)/2*(m_N0-1)
2066                                           +(i1+1)/2*m_N0*(m_N1-1)
2067                                           +(i2+1)/2*m_N0*m_N1*(m_N2-1);
2068                            offsetInShared.push_back(offsetInShared.back()+1);
2069                            sendShared.push_back(dof);
2070                            recvShared.push_back(numDOF+numShared);
2071                            colIndices[dof].push_back(numShared);
2072                            m_dofMap[node]=numDOF+numShared;
2073                            ++numShared;
2074                        }
2075                    }
2076                }
2077            }
2078        }
2079    
2080        // create connector
2081        Paso_SharedComponents *snd_shcomp = Paso_SharedComponents_alloc(
2082                numDOF, neighbour.size(), &neighbour[0], &sendShared[0],
2083                &offsetInShared[0], 1, 0, m_mpiInfo);
2084        Paso_SharedComponents *rcv_shcomp = Paso_SharedComponents_alloc(
2085                numDOF, neighbour.size(), &neighbour[0], &recvShared[0],
2086                &offsetInShared[0], 1, 0, m_mpiInfo);
2087        m_connector = Paso_Connector_alloc(snd_shcomp, rcv_shcomp);
2088        Paso_SharedComponents_free(snd_shcomp);
2089        Paso_SharedComponents_free(rcv_shcomp);
2090    
2091        // create main and couple blocks
2092        Paso_Pattern *mainPattern = createMainPattern();
2093        Paso_Pattern *colPattern, *rowPattern;
2094        createCouplePatterns(colIndices, numShared, &colPattern, &rowPattern);
2095    
2096        // allocate paso distribution
2097        Paso_Distribution* distribution = Paso_Distribution_alloc(m_mpiInfo,
2098                const_cast<index_t*>(&m_nodeDistribution[0]), 1, 0);
2099    
2100        // finally create the system matrix
2101        m_pattern = Paso_SystemMatrixPattern_alloc(MATRIX_FORMAT_DEFAULT,
2102                distribution, distribution, mainPattern, colPattern, rowPattern,
2103                m_connector, m_connector);
2104    
2105        Paso_Distribution_free(distribution);
2106    
2107        // useful debug output
2108        /*
2109        cout << "--- rcv_shcomp ---" << endl;
2110        cout << "numDOF=" << numDOF << ", numNeighbors=" << neighbour.size() << endl;
2111        for (size_t i=0; i<neighbour.size(); i++) {
2112            cout << "neighbor[" << i << "]=" << neighbour[i]
2113                << " offsetInShared[" << i+1 << "]=" << offsetInShared[i+1] << endl;
2114        }
2115        for (size_t i=0; i<recvShared.size(); i++) {
2116            cout << "shared[" << i << "]=" << recvShared[i] << endl;
2117        }
2118        cout << "--- snd_shcomp ---" << endl;
2119        for (size_t i=0; i<sendShared.size(); i++) {
2120            cout << "shared[" << i << "]=" << sendShared[i] << endl;
2121        }
2122        cout << "--- dofMap ---" << endl;
2123        for (size_t i=0; i<m_dofMap.size(); i++) {
2124            cout << "m_dofMap[" << i << "]=" << m_dofMap[i] << endl;
2125        }
2126        cout << "--- colIndices ---" << endl;
2127        for (size_t i=0; i<colIndices.size(); i++) {
2128            cout << "colIndices[" << i << "].size()=" << colIndices[i].size() << endl;
2129        }
2130        */
2131    
2132        /*
2133        cout << "--- main_pattern ---" << endl;
2134        cout << "M=" << mainPattern->numOutput << ", N=" << mainPattern->numInput << endl;
2135        for (size_t i=0; i<mainPattern->numOutput+1; i++) {
2136            cout << "ptr[" << i << "]=" << mainPattern->ptr[i] << endl;
2137        }
2138        for (size_t i=0; i<mainPattern->ptr[mainPattern->numOutput]; i++) {
2139            cout << "index[" << i << "]=" << mainPattern->index[i] << endl;
2140        }
2141        */
2142    
2143        /*
2144        cout << "--- colCouple_pattern ---" << endl;
2145        cout << "M=" << colPattern->numOutput << ", N=" << colPattern->numInput << endl;
2146        for (size_t i=0; i<colPattern->numOutput+1; i++) {
2147            cout << "ptr[" << i << "]=" << colPattern->ptr[i] << endl;
2148        }
2149        for (size_t i=0; i<colPattern->ptr[colPattern->numOutput]; i++) {
2150            cout << "index[" << i << "]=" << colPattern->index[i] << endl;
2151        }
2152        */
2153    
2154        /*
2155        cout << "--- rowCouple_pattern ---" << endl;
2156        cout << "M=" << rowPattern->numOutput << ", N=" << rowPattern->numInput << endl;
2157        for (size_t i=0; i<rowPattern->numOutput+1; i++) {
2158            cout << "ptr[" << i << "]=" << rowPattern->ptr[i] << endl;
2159        }
2160        for (size_t i=0; i<rowPattern->ptr[rowPattern->numOutput]; i++) {
2161            cout << "index[" << i << "]=" << rowPattern->index[i] << endl;
2162        }
2163        */
2164    
2165        Paso_Pattern_free(mainPattern);
2166        Paso_Pattern_free(colPattern);
2167        Paso_Pattern_free(rowPattern);
2168    }
2169    
2170    //private
2171    void Brick::addToMatrixAndRHS(Paso_SystemMatrix* S, escript::Data& F,
2172             const vector<double>& EM_S, const vector<double>& EM_F, bool addS,
2173             bool addF, index_t firstNode, dim_t nEq, dim_t nComp) const
2174    {
2175        IndexVector rowIndex;
2176        rowIndex.push_back(m_dofMap[firstNode]);
2177        rowIndex.push_back(m_dofMap[firstNode+1]);
2178        rowIndex.push_back(m_dofMap[firstNode+m_N0]);
2179        rowIndex.push_back(m_dofMap[firstNode+m_N0+1]);
2180        rowIndex.push_back(m_dofMap[firstNode+m_N0*m_N1]);
2181        rowIndex.push_back(m_dofMap[firstNode+m_N0*m_N1+1]);
2182        rowIndex.push_back(m_dofMap[firstNode+m_N0*(m_N1+1)]);
2183        rowIndex.push_back(m_dofMap[firstNode+m_N0*(m_N1+1)+1]);
2184        if (addF) {
2185            double *F_p=F.getSampleDataRW(0);
2186            for (index_t i=0; i<rowIndex.size(); i++) {
2187                if (rowIndex[i]<getNumDOF()) {
2188                    for (index_t eq=0; eq<nEq; eq++) {
2189                        F_p[INDEX2(eq, rowIndex[i], nEq)]+=EM_F[INDEX2(eq,i,nEq)];
2190                    }
2191                }
2192            }
2193        }
2194        if (addS) {
2195            addToSystemMatrix(S, rowIndex, nEq, rowIndex, nComp, EM_S);
2196        }
2197    }
2198    
2199  //protected  //protected
2200  void Brick::interpolateNodesOnElements(escript::Data& out, escript::Data& in,  void Brick::interpolateNodesOnElements(escript::Data& out, escript::Data& in,
2201                                         bool reduced) const                                         bool reduced) const
2202  {  {
2203      const dim_t numComp = in.getDataPointSize();      const dim_t numComp = in.getDataPointSize();
2204      if (reduced) {      if (reduced) {
2205          /*** GENERATOR SNIP_INTERPOLATE_REDUCED_ELEMENTS TOP */          out.requireWrite();
2206          const double c0 = .125;          const double c0 = .125;
2207  #pragma omp parallel for  #pragma omp parallel
2208          for (index_t k2=0; k2 < m_NE2; ++k2) {          {
2209              for (index_t k1=0; k1 < m_NE1; ++k1) {              vector<double> f_000(numComp);
2210                  for (index_t k0=0; k0 < m_NE0; ++k0) {              vector<double> f_001(numComp);
2211                      const register double* f_000 = in.getSampleDataRO(INDEX3(k0,k1,k2, m_N0,m_N1));              vector<double> f_010(numComp);
2212                      const register double* f_001 = in.getSampleDataRO(INDEX3(k0,k1,k2+1, m_N0,m_N1));              vector<double> f_011(numComp);
2213                      const register double* f_101 = in.getSampleDataRO(INDEX3(k0+1,k1,k2+1, m_N0,m_N1));              vector<double> f_100(numComp);
2214                      const register double* f_011 = in.getSampleDataRO(INDEX3(k0,k1+1,k2+1, m_N0,m_N1));              vector<double> f_101(numComp);
2215                      const register double* f_100 = in.getSampleDataRO(INDEX3(k0+1,k1,k2, m_N0,m_N1));              vector<double> f_110(numComp);
2216                      const register double* f_110 = in.getSampleDataRO(INDEX3(k0+1,k1+1,k2, m_N0,m_N1));              vector<double> f_111(numComp);
2217                      const register double* f_010 = in.getSampleDataRO(INDEX3(k0,k1+1,k2, m_N0,m_N1));  #pragma omp for
2218                      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) {
2219                      double* o = out.getSampleDataRW(INDEX3(k0,k1,k2,m_NE0,m_NE1));                  for (index_t k1=0; k1 < m_NE1; ++k1) {
2220                      for (index_t i=0; i < numComp; ++i) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
2221                          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));
2222                      } /* end of component loop i */                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2223                  } /* end of k0 loop */                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
2224              } /* end of k1 loop */                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2225          } /* end of k2 loop */                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
2226          /* 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));
2227                            memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
2228                            memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2229                            double* o = out.getSampleDataRW(INDEX3(k0,k1,k2,m_NE0,m_NE1));
2230                            for (index_t i=0; i < numComp; ++i) {
2231                                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]);
2232                            } // end of component loop i
2233                        } // end of k0 loop
2234                    } // end of k1 loop
2235                } // end of k2 loop
2236            } // end of parallel section
2237      } else {      } else {
2238          /*** GENERATOR SNIP_INTERPOLATE_ELEMENTS TOP */          out.requireWrite();
2239          const double c0 = .0094373878376559314545;          const double c0 = .0094373878376559314545;
2240          const double c1 = .035220810900864519624;          const double c1 = .035220810900864519624;
2241          const double c2 = .13144585576580214704;          const double c2 = .13144585576580214704;
2242          const double c3 = .49056261216234406855;          const double c3 = .49056261216234406855;
2243  #pragma omp parallel for  #pragma omp parallel
2244          for (index_t k2=0; k2 < m_NE2; ++k2) {          {
2245              for (index_t k1=0; k1 < m_NE1; ++k1) {              vector<double> f_000(numComp);
2246                  for (index_t k0=0; k0 < m_NE0; ++k0) {              vector<double> f_001(numComp);
2247                      const register double* f_000 = in.getSampleDataRO(INDEX3(k0,k1,k2, m_N0,m_N1));              vector<double> f_010(numComp);
2248                      const register double* f_001 = in.getSampleDataRO(INDEX3(k0,k1,k2+1, m_N0,m_N1));              vector<double> f_011(numComp);
2249                      const register double* f_101 = in.getSampleDataRO(INDEX3(k0+1,k1,k2+1, m_N0,m_N1));              vector<double> f_100(numComp);
2250                      const register double* f_011 = in.getSampleDataRO(INDEX3(k0,k1+1,k2+1, m_N0,m_N1));              vector<double> f_101(numComp);
2251                      const register double* f_110 = in.getSampleDataRO(INDEX3(k0+1,k1+1,k2, m_N0,m_N1));              vector<double> f_110(numComp);
2252                      const register double* f_010 = in.getSampleDataRO(INDEX3(k0,k1+1,k2, m_N0,m_N1));              vector<double> f_111(numComp);
2253                      const register double* f_100 = in.getSampleDataRO(INDEX3(k0+1,k1,k2, m_N0,m_N1));  #pragma omp for
2254                      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) {
2255                      double* o = out.getSampleDataRW(INDEX3(k0,k1,k2,m_NE0,m_NE1));                  for (index_t k1=0; k1 < m_NE1; ++k1) {
2256                      for (index_t i=0; i < numComp; ++i) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
2257                          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));
2258                          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));
2259                          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));
2260                          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));
2261                          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));
2262                          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));
2263                          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));
2264                          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));
2265                      } /* end of component loop i */                          double* o = out.getSampleDataRW(INDEX3(k0,k1,k2,m_NE0,m_NE1));
2266                  } /* end of k0 loop */                          for (index_t i=0; i < numComp; ++i) {
2267              } /* 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]);
2268          } /* 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]);
2269          /* 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]);
2270                                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]);
2271                                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]);
2272                                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]);
2273                                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]);
2274                                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]);
2275                            } // end of component loop i
2276                        } // end of k0 loop
2277                    } // end of k1 loop
2278                } // end of k2 loop
2279            } // end of parallel section
2280      }      }
2281  }  }
2282    
# Line 1450  void Brick::interpolateNodesOnFaces(escr Line 2286  void Brick::interpolateNodesOnFaces(escr
2286  {  {
2287      const dim_t numComp = in.getDataPointSize();      const dim_t numComp = in.getDataPointSize();
2288      if (reduced) {      if (reduced) {
2289            out.requireWrite();
2290          const double c0 = .25;          const double c0 = .25;
2291  #pragma omp parallel  #pragma omp parallel
2292          {          {
2293              /*** GENERATOR SNIP_INTERPOLATE_REDUCED_FACES TOP */              vector<double> f_000(numComp);
2294                vector<double> f_001(numComp);
2295                vector<double> f_010(numComp);
2296                vector<double> f_011(numComp);
2297                vector<double> f_100(numComp);
2298                vector<double> f_101(numComp);
2299                vector<double> f_110(numComp);
2300                vector<double> f_111(numComp);
2301              if (m_faceOffset[0] > -1) {              if (m_faceOffset[0] > -1) {
2302  #pragma omp for nowait  #pragma omp for nowait
2303                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE2; ++k2) {
2304                      for (index_t k1=0; k1 < m_NE1; ++k1) {                      for (index_t k1=0; k1 < m_NE1; ++k1) {
2305                          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));
2306                          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));
2307                          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));
2308                          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));
2309                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));
2310                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2311                              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]);
2312                          } /* end of component loop i */                          } // end of component loop i
2313                      } /* end of k1 loop */                      } // end of k1 loop
2314                  } /* end of k2 loop */                  } // end of k2 loop
2315              } /* end of face 0 */              } // end of face 0
2316              if (m_faceOffset[1] > -1) {              if (m_faceOffset[1] > -1) {
2317  #pragma omp for nowait  #pragma omp for nowait
2318                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE2; ++k2) {
2319                      for (index_t k1=0; k1 < m_NE1; ++k1) {                      for (index_t k1=0; k1 < m_NE1; ++k1) {
2320                          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));
2321                          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));
2322                          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));
2323                          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));
2324                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));
2325                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2326                              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]);
2327                          } /* end of component loop i */                          } // end of component loop i
2328                      } /* end of k1 loop */                      } // end of k1 loop
2329                  } /* end of k2 loop */                  } // end of k2 loop
2330              } /* end of face 1 */              } // end of face 1
2331              if (m_faceOffset[2] > -1) {              if (m_faceOffset[2] > -1) {
2332  #pragma omp for nowait  #pragma omp for nowait
2333                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE2; ++k2) {
2334                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
2335                          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));
2336                          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));
2337                          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));
2338                          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));
2339                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));
2340                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2341                              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]);
2342                          } /* end of component loop i */                          } // end of component loop i
2343                      } /* end of k0 loop */                      } // end of k0 loop
2344                  } /* end of k2 loop */                  } // end of k2 loop
2345              } /* end of face 2 */              } // end of face 2
2346              if (m_faceOffset[3] > -1) {              if (m_faceOffset[3] > -1) {
2347  #pragma omp for nowait  #pragma omp for nowait
2348                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE2; ++k2) {
2349                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
2350                          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));
2351                          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));
2352                          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));
2353                          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));
2354                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));
2355                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2356                              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]);
2357                          } /* end of component loop i */                          } // end of component loop i
2358                      } /* end of k0 loop */                      } // end of k0 loop
2359                  } /* end of k2 loop */                  } // end of k2 loop
2360              } /* end of face 3 */              } // end of face 3
2361              if (m_faceOffset[4] > -1) {              if (m_faceOffset[4] > -1) {
2362  #pragma omp for nowait  #pragma omp for nowait
2363                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1=0; k1 < m_NE1; ++k1) {
2364                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
2365                          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));
2366                          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));
2367                          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));
2368                          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));
2369                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));
2370                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2371                              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]);
2372                          } /* end of component loop i */                          } // end of component loop i
2373                      } /* end of k0 loop */                      } // end of k0 loop
2374                  } /* end of k1 loop */                  } // end of k1 loop
2375              } /* end of face 4 */              } // end of face 4
2376              if (m_faceOffset[5] > -1) {              if (m_faceOffset[5] > -1) {
2377  #pragma omp for nowait  #pragma omp for nowait
2378                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1=0; k1 < m_NE1; ++k1) {
2379                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
2380                          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));
2381                          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));
2382                          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));
2383                          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));
2384                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));
2385                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2386                              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]);
2387                          } /* end of component loop i */                          } // end of component loop i
2388                      } /* end of k0 loop */                      } // end of k0 loop
2389                  } /* end of k1 loop */                  } // end of k1 loop
2390              } /* end of face 5 */              } // end of face 5
             /* GENERATOR SNIP_INTERPOLATE_REDUCED_FACES BOTTOM */  
2391          } // end of parallel section          } // end of parallel section
2392      } else {      } else {
2393            out.requireWrite();
2394          const double c0 = 0.044658198738520451079;          const double c0 = 0.044658198738520451079;
2395          const double c1 = 0.16666666666666666667;          const double c1 = 0.16666666666666666667;
2396          const double c2 = 0.62200846792814621559;          const double c2 = 0.62200846792814621559;
2397  #pragma omp parallel  #pragma omp parallel
2398          {          {
2399              /*** GENERATOR SNIP_INTERPOLATE_FACES TOP */              vector<double> f_000(numComp);
2400                vector<double> f_001(numComp);
2401                vector<double> f_010(numComp);
2402                vector<double> f_011(numComp);
2403                vector<double> f_100(numComp);
2404                vector<double> f_101(numComp);
2405                vector<double> f_110(numComp);
2406                vector<double> f_111(numComp);
2407              if (m_faceOffset[0] > -1) {              if (m_faceOffset[0] > -1) {
2408  #pragma omp for nowait  #pragma omp for nowait
2409                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE2; ++k2) {
2410                      for (index_t k1=0; k1 < m_NE1; ++k1) {                      for (index_t k1=0; k1 < m_NE1; ++k1) {
2411                          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));
2412                          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));
2413                          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));
2414                          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));
2415                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));
2416                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2417                              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]);
2418                              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]);
2419                              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]);
2420                              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]);
2421                          } /* end of component loop i */                          } // end of component loop i
2422                      } /* end of k1 loop */                      } // end of k1 loop
2423                  } /* end of k2 loop */                  } // end of k2 loop
2424              } /* end of face 0 */              } // end of face 0
2425              if (m_faceOffset[1] > -1) {              if (m_faceOffset[1] > -1) {
2426  #pragma omp for nowait  #pragma omp for nowait
2427                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE2; ++k2) {
2428                      for (index_t k1=0; k1 < m_NE1; ++k1) {                      for (index_t k1=0; k1 < m_NE1; ++k1) {
2429                          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));
2430                          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));
2431                          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));
2432                          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));
2433                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));
2434                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2435                              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]);
2436                              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]);
2437                              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]);
2438                              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]);
2439                          } /* end of component loop i */                          } // end of component loop i
2440                      } /* end of k1 loop */                      } // end of k1 loop
2441                  } /* end of k2 loop */                  } // end of k2 loop
2442              } /* end of face 1 */              } // end of face 1
2443              if (m_faceOffset[2] > -1) {              if (m_faceOffset[2] > -1) {
2444  #pragma omp for nowait  #pragma omp for nowait
2445                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE2; ++k2) {
2446                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
2447                          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));
2448                          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));
2449                          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));
2450                          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));
2451                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));
2452                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2453                              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]);
2454                              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]);
2455                              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]);
2456                              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]);
2457                          } /* end of component loop i */                          } // end of component loop i
2458                      } /* end of k0 loop */                      } // end of k0 loop
2459                  } /* end of k2 loop */                  } // end of k2 loop
2460              } /* end of face 2 */              } // end of face 2
2461              if (m_faceOffset[3] > -1) {              if (m_faceOffset[3] > -1) {
2462  #pragma omp for nowait  #pragma omp for nowait
2463                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE2; ++k2) {
2464                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
2465                          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));
2466                          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));
2467                          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));
2468                          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));
2469                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));
2470                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2471                              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]);
2472                              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]);
2473                              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]);
2474                              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]);
2475                          } /* end of component loop i */                          } // end of component loop i
2476                      } /* end of k0 loop */                      } // end of k0 loop
2477                  } /* end of k2 loop */                  } // end of k2 loop
2478              } /* end of face 3 */              } // end of face 3
2479              if (m_faceOffset[4] > -1) {              if (m_faceOffset[4] > -1) {
2480  #pragma omp for nowait  #pragma omp for nowait
2481                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1=0; k1 < m_NE1; ++k1) {
2482                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
2483                          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));
2484                          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));
2485                          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));
2486                          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));
2487                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));
2488                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2489                              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]);
2490                              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]);
2491                              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]);
2492                              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]);
2493                          } /* end of component loop i */                          } // end of component loop i
2494                      } /* end of k0 loop */                      } // end of k0 loop
2495                  } /* end of k1 loop */                  } // end of k1 loop
2496              } /* end of face 4 */              } // end of face 4
2497              if (m_faceOffset[5] > -1) {              if (m_faceOffset[5] > -1) {
2498  #pragma omp for nowait  #pragma omp for nowait
2499                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1=0; k1 < m_NE1; ++k1) {
2500                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE0; ++k0) {
2501                          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));
2502                          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));
2503                          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));
2504                          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));
2505                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));
2506                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2507                              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]);
2508                              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]);
2509                              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]);
2510                              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]);
2511                          } /* end of component loop i */                          } // end of component loop i
2512                      } /* end of k0 loop */                      } // end of k0 loop
2513                  } /* end of k1 loop */                  } // end of k1 loop
2514              } /* end of face 5 */              } // end of face 5
             /* GENERATOR SNIP_INTERPOLATE_FACES BOTTOM */  
2515          } // end of parallel section          } // end of parallel section
2516      }      }
2517  }  }
2518    
2519  //protected  //protected
2520  void Brick::nodesToDOF(escript::Data& out, escript::Data& in) const  void Brick::assemblePDESingle(Paso_SystemMatrix* mat, escript::Data& rhs,
2521            const escript::Data& A, const escript::Data& B,
2522            const escript::Data& C, const escript::Data& D,
2523            const escript::Data& X, const escript::Data& Y) const
2524  {  {
2525      const dim_t numComp = in.getDataPointSize();      const double h0 = m_l0/m_gNE0;
2526      out.requireWrite();      const double h1 = m_l1/m_gNE1;
2527        const double h2 = m_l2/m_gNE2;
2528        const double w0 = 0.0009303791403858427308*h1*h2/h0;
2529        const double w1 = 0.0009303791403858427308*h2;
2530        const double w2 = -0.00024929433932114870101*h1;
2531        const double w3 = 0.0009303791403858427308*h0*h2/h1;
2532        const double w4 = -0.00024929433932114870101*h0;
2533        const double w5 = 0.0009303791403858427308*h1;
2534        const double w6 = 0.0009303791403858427308*h0;
2535        const double w7 = -0.00024929433932114870101*h0*h1/h2;
2536        const double w8 = 0.0034722222222222222222*h2;
2537        const double w9 = -0.0009303791403858427308*h1;
2538        const double w10 = 0.012958509748503046158*h0*h2/h1;
2539        const double w11 = -0.0034722222222222222222*h0;
2540        const double w12 = 0.0034722222222222222222*h1;
2541        const double w13 = 0.012958509748503046158*h0;
2542        const double w14 = -0.0034722222222222222222*h0*h1/h2;
2543        const double w15 = 0.012958509748503046158*h1*h2/h0;
2544        const double w16 = -0.0034722222222222222222*h1;
2545        const double w17 = -0.0009303791403858427308*h0;
2546        const double w18 = 0.012958509748503046158*h1;
2547        const double w19 = 0.0034722222222222222222*h0;
2548        const double w20 = 0.012958509748503046158*h2;
2549        const double w21 = -0.012958509748503046158*h1;
2550        const double w22 = -0.012958509748503046158*h0;
2551        const double w23 = 0.04836181677178996241*h1;
2552        const double w24 = 0.04836181677178996241*h0;
2553        const double w25 = -0.04836181677178996241*h0*h1/h2;
2554        const double w26 = 0.00024929433932114870101*h1;
2555        const double w27 = 0.00024929433932114870101*h0;
2556        const double w28 = -0.04836181677178996241*h1;
2557        const double w29 = -0.04836181677178996241*h0;
2558        const double w30 = -0.0009303791403858427308*h1*h2/h0;
2559        const double w31 = -0.0009303791403858427308*h2;
2560        const double w32 = -0.0009303791403858427308*h0*h2/h1;
2561        const double w33 = 0.0034722222222222222222*h0*h1/h2;
2562        const double w34 = -0.0034722222222222222222*h2;
2563        const double w35 = -0.00024929433932114870101*h2;
2564        const double w36 = -0.012958509748503046158*h1*h2/h0;
2565        const double w37 = -0.012958509748503046158*h2;
2566        const double w38 = -0.012958509748503046158*h0*h2/h1;
2567        const double w39 = -0.04836181677178996241*h2;
2568        const double w40 = -0.0034722222222222222222*h0*h2/h1;
2569        const double w41 = 0.0009303791403858427308*h0*h1/h2;
2570        const double w42 = 0.04836181677178996241*h2;
2571        const double w43 = -0.04836181677178996241*h0*h2/h1;
2572        const double w44 = 0.012958509748503046158*h0*h1/h2;
2573        const double w45 = -0.00024929433932114870101*h0*h2/h1;
2574        const double w46 = 0.00024929433932114870101*h2;
2575        const double w47 = -0.0034722222222222222222*h1*h2/h0;
2576        const double w48 = -0.00024929433932114870101*h1*h2/h0;
2577        const double w49 = -0.04836181677178996241*h1*h2/h0;
2578        const double w50 = 0.0034722222222222222222*h0*h2/h1;
2579        const double w51 = -0.0009303791403858427308*h0*h1/h2;
2580        const double w52 = -0.012958509748503046158*h0*h1/h2;
2581        const double w53 = 0.0034722222222222222222*h1*h2/h0;
2582        const double w54 = 0.00024929433932114870101*h0*h1/h2;
2583        const double w55 = 0.04836181677178996241*h0*h2/h1;
2584        const double w56 = 0.04836181677178996241*h1*h2/h0;
2585        const double w57 = 0.04836181677178996241*h0*h1/h2;
2586        const double w58 = 0.00024929433932114870101*h1*h2/h0;
2587        const double w59 = 0.00024929433932114870101*h0*h2/h1;
2588        const double w60 = 0.055555555555555555556*h1*h2/h0;
2589        const double w61 = 0.041666666666666666667*h2;
2590        const double w62 = -0.083333333333333333333*h1;
2591        const double w63 = 0.055555555555555555556*h0*h2/h1;
2592        const double w64 = -0.083333333333333333333*h0;
2593        const double w65 = 0.083333333333333333333*h1;
2594        const double w66 = 0.083333333333333333333*h0;
2595        const double w67 = -0.11111111111111111111*h0*h1/h2;
2596        const double w68 = -0.055555555555555555556*h1*h2/h0;
2597        const double w69 = -0.083333333333333333333*h2;
2598        const double w70 = -0.041666666666666666667*h1;
2599        const double w71 = -0.055555555555555555556*h0*h2/h1;
2600        const double w72 = -0.041666666666666666667*h0;
2601        const double w73 = 0.041666666666666666667*h1;
2602        const double w74 = 0.041666666666666666667*h0;
2603        const double w75 = 0.027777777777777777778*h0*h1/h2;
2604        const double w76 = 0.083333333333333333333*h2;
2605        const double w77 = -0.11111111111111111111*h0*h2/h1;
2606        const double w78 = 0.055555555555555555556*h0*h1/h2;
2607        const double w79 = -0.11111111111111111111*h1*h2/h0;
2608        const double w80 = -0.027777777777777777778*h1*h2/h0;
2609        const double w81 = -0.041666666666666666667*h2;
2610        const double w82 = -0.027777777777777777778*h0*h2/h1;
2611        const double w83 = -0.027777777777777777778*h0*h1/h2;
2612        const double w84 = 0.027777777777777777778*h0*h2/h1;
2613        const double w85 = -0.055555555555555555556*h0*h1/h2;
2614        const double w86 = 0.11111111111111111111*h1*h2/h0;
2615        const double w87 = 0.11111111111111111111*h0*h2/h1;
2616        const double w88 = 0.11111111111111111111*h0*h1/h2;
2617        const double w89 = 0.027777777777777777778*h1*h2/h0;
2618        const double w90 = 0.0001966122466178319053*h1*h2;
2619        const double w91 = 0.0001966122466178319053*h0*h2;
2620        const double w92 = 0.0001966122466178319053*h0*h1;
2621        const double w93 = 0.0007337668937680108255*h1*h2;
2622        const double w94 = 0.0027384553284542113967*h0*h2;
2623        const double w95 = 0.0027384553284542113967*h0*h1;
2624        const double w96 = 0.0027384553284542113967*h1*h2;
2625        const double w97 = 0.0007337668937680108255*h0*h2;
2626        const double w98 = 0.010220054420048834761*h1*h2;
2627        const double w99 = 0.010220054420048834761*h0*h2;
2628        const double w100 = 0.038141762351741127649*h0*h1;
2629        const double w101 = 0.000052682092703316795705*h0*h1;
2630        const double w102 = 0.0007337668937680108255*h0*h1;
2631        const double w103 = 0.010220054420048834761*h0*h1;
2632        const double w104 = -0.0001966122466178319053*h1*h2;
2633        const double w105 = -0.0001966122466178319053*h0*h2;
2634        const double w106 = -0.0007337668937680108255*h1*h2;
2635        const double w107 = -0.0007337668937680108255*h0*h2;
2636        const double w108 = -0.0027384553284542113967*h1*h2;
2637        const double w109 = -0.0027384553284542113967*h0*h2;
2638        const double w110 = -0.010220054420048834761*h1*h2;
2639        const double w111 = -0.010220054420048834761*h0*h2;
2640        const double w112 = -0.0007337668937680108255*h0*h1;
2641        const double w113 = -0.010220054420048834761*h0*h1;
2642        const double w114 = -0.038141762351741127649*h0*h2;
2643        const double w115 = -0.000052682092703316795705*h0*h2;
2644        const double w116 = -0.0001966122466178319053*h0*h1;
2645        const double w117 = -0.0027384553284542113967*h0*h1;
2646        const double w118 = 0.000052682092703316795705*h0*h2;
2647        const double w119 = 0.038141762351741127649*h0*h2;
2648        const double w120 = 0.000052682092703316795705*h1*h2;
2649        const double w121 = 0.038141762351741127649*h1*h2;
2650        const double w122 = -0.000052682092703316795705*h0*h1;
2651        const double w123 = -0.038141762351741127649*h0*h1;
2652        const double w124 = -0.000052682092703316795705*h1*h2;
2653        const double w125 = -0.038141762351741127649*h1*h2;
2654        const double w126 = 0.027777777777777777778*h1*h2;
2655        const double w127 = 0.027777777777777777778*h0*h2;
2656        const double w128 = 0.055555555555555555556*h0*h1;
2657        const double w129 = -0.027777777777777777778*h1*h2;
2658        const double w130 = -0.027777777777777777778*h0*h2;
2659        const double w131 = 0.013888888888888888889*h0*h1;
2660        const double w132 = -0.055555555555555555556*h0*h2;
2661        const double w133 = -0.027777777777777777778*h0*h1;
2662        const double w134 = 0.055555555555555555556*h0*h2;
2663        const double w135 = 0.027777777777777777778*h0*h1;
2664        const double w136 = -0.013888888888888888889*h0*h1;
2665        const double w137 = 0.055555555555555555556*h1*h2;
2666        const double w138 = -0.013888888888888888889*h1*h2;
2667        const double w139 = -0.013888888888888888889*h0*h2;
2668        const double w140 = -0.055555555555555555556*h0*h1;
2669        const double w141 = 0.013888888888888888889*h1*h2;
2670        const double w142 = 0.013888888888888888889*h0*h2;
2671        const double w143 = -0.055555555555555555556*h1*h2;
2672        const double w144 = 0.000041549056553524783501*h0*h1*h2;
2673        const double w145 = 0.0005787037037037037037*h0*h1*h2;
2674        const double w146 = 0.0080603027952983270684*h0*h1*h2;
2675        const double w147 = 0.0001550631900643071218*h0*h1*h2;
2676        const double w148 = 0.002159751624750507693*h0*h1*h2;
2677        const double w149 = 0.03008145955644280058*h0*h1*h2;
2678        const double w150 = 0.000011133036149792012204*h0*h1*h2;
2679        const double w151 = 0.018518518518518518519*h0*h1*h2;
2680        const double w152 = 0.0092592592592592592592*h0*h1*h2;
2681        const double w153 = 0.0046296296296296296296*h0*h1*h2;
2682        const double w154 = 0.037037037037037037037*h0*h1*h2;
2683        const double w155 = -0.077751058491018276949*h1*h2;
2684        const double w156 = -0.077751058491018276949*h0*h2;
2685        const double w157 = -0.077751058491018276949*h0*h1;
2686        const double w158 = -0.020833333333333333333*h0*h2;
2687        const double w159 = -0.020833333333333333333*h0*h1;
2688        const double w160 = -0.020833333333333333333*h1*h2;
2689        const double w161 = -0.0055822748423150563848*h0*h1;
2690        const double w162 = -0.0055822748423150563848*h0*h2;
2691        const double w163 = -0.0055822748423150563848*h1*h2;
2692        const double w164 = 0.077751058491018276949*h1*h2;
2693        const double w165 = 0.020833333333333333333*h1*h2;
2694        const double w166 = 0.0055822748423150563848*h1*h2;
2695        const double w167 = 0.077751058491018276949*h0*h2;
2696        const double w168 = 0.020833333333333333333*h0*h2;
2697        const double w169 = 0.0055822748423150563848*h0*h2;
2698        const double w170 = 0.077751058491018276949*h0*h1;
2699        const double w171 = 0.020833333333333333333*h0*h1;
2700        const double w172 = 0.0055822748423150563848*h0*h1;
2701        const double w173 = -0.25*h1*h2;
2702        const double w174 = -0.25*h0*h2;
2703        const double w175 = -0.25*h0*h1;
2704        const double w176 = 0.25*h1*h2;
2705        const double w177 = 0.25*h0*h2;
2706        const double w178 = 0.25*h0*h1;
2707        const double w179 = 0.061320326520293008568*h0*h1*h2;
2708        const double w180 = 0.01643073197072526838*h0*h1*h2;
2709        const double w181 = 0.004402601362608064953*h0*h1*h2;
2710        const double w182 = 0.0011796734797069914318*h0*h1*h2;
2711        const double w183 = 0.125*h0*h1*h2;
2712    
2713      const index_t left = (m_offset0==0 ? 0 : 1);      rhs.requireWrite();
2714      const index_t bottom = (m_offset1==0 ? 0 : 1);  #pragma omp parallel
2715      const index_t front = (m_offset2==0 ? 0 : 1);      {
2716      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
2717      const index_t top = (m_mpiInfo->rank%(m_NX*m_NY)/m_NX==m_NY-1 ? m_N1 : m_N1-1);  #pragma omp for
2718      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) {
2719      index_t n=0;                  for (index_t k1=0; k1<m_NE1; ++k1) {
2720      for (index_t i=front; i<back; i++) {                      for (index_t k0=0; k0<m_NE0; ++k0)  {
2721          for (index_t j=bottom; j<top; j++) {                          bool add_EM_S=false;
2722              for (index_t k=left; k<right; k++, n++) {                          bool add_EM_F=false;
2723                  const double* src=in.getSampleDataRO(k+j*m_N0+i*m_N0*m_N1);                          vector<double> EM_S(8*8, 0);
2724                  copy(src, src+numComp, out.getSampleDataRW(n));                          vector<double> EM_F(8, 0);
2725              }                          const index_t e = k0 + m_NE0*k1 + m_NE0*m_NE1*k2;
2726          }                          ///////////////
2727                            // process A //
2728                            ///////////////
2729                            if (!A.isEmpty()) {
2730                                add_EM_S=true;
2731                                const double* A_p=const_cast<escript::Data*>(&A)->getSampleDataRO(e);
2732                                if (A.actsExpanded()) {
2733                                    const double A_00_0 = A_p[INDEX3(0,0,0,3,3)];
2734                                    const double A_01_0 = A_p[INDEX3(0,1,0,3,3)];
2735                                    const double A_02_0 = A_p[INDEX3(0,2,0,3,3)];
2736                                    const double A_10_0 = A_p[INDEX3(1,0,0,3,3)];
2737                                    const double A_11_0 = A_p[INDEX3(1,1,0,3,3)];
2738                                    const double A_12_0 = A_p[INDEX3(1,2,0,3,3)];
2739                                    const double A_20_0 = A_p[INDEX3(2,0,0,3,3)];
2740                                    const double A_21_0 = A_p[INDEX3(2,1,0,3,3)];
2741                                    const double A_22_0 = A_p[INDEX3(2,2,0,3,3)];
2742                                    const double A_00_1 = A_p[INDEX3(0,0,1,3,3)];
2743                                    const double A_01_1 = A_p[INDEX3(0,1,1,3,3)];
2744                                    const double A_02_1 = A_p[INDEX3(0,2,1,3,3)];
2745                                    const double A_10_1 = A_p[INDEX3(1,0,1,3,3)];
2746                                    const double A_11_1 = A_p[INDEX3(1,1,1,3,3)];
2747                                    const double A_12_1 = A_p[INDEX3(1,2,1,3,3)];
2748                                    const double A_20_1 = A_p[INDEX3(2,0,1,3,3)];
2749                                    const double A_21_1 = A_p[INDEX3(2,1,1,3,3)];
2750                                    const double A_22_1 = A_p[INDEX3(2,2,1,3,3)];
2751                                    const double A_00_2 = A_p[INDEX3(0,0,2,3,3)];
2752                                    const double A_01_2 = A_p[INDEX3(0,1,2,3,3)];
2753                                    const double A_02_2 = A_p[INDEX3(0,2,2,3,3)];
2754                                    const double A_10_2 = A_p[INDEX3(1,0,2,3,3)];
2755                                    const double A_11_2 = A_p[INDEX3(1,1,2,3,3)];
2756                                    const double A_12_2 = A_p[INDEX3(1,2,2,3,3)];
2757                                    const double A_20_2 = A_p[INDEX3(2,0,2,3,3)];
2758                                    const double A_21_2 = A_p[INDEX3(2,1,2,3,3)];
2759                                    const double A_22_2 = A_p[INDEX3(2,2,2,3,3)];
2760                                    const double A_00_3 = A_p[INDEX3(0,0,3,3,3)];
2761                                    const double A_01_3 = A_p[INDEX3(0,1,3,3,3)];
2762                                    const double A_02_3 = A_p[INDEX3(0,2,3,3,3)];
2763                                    const double A_10_3 = A_p[INDEX3(1,0,3,3,3)];
2764                                    const double A_11_3 = A_p[INDEX3(1,1,3,3,3)];
2765                                    const double A_12_3 = A_p[INDEX3(1,2,3,3,3)];
2766                                    const double A_20_3 = A_p[INDEX3(2,0,3,3,3)];
2767                                    const double A_21_3 = A_p[INDEX3(2,1,3,3,3)];
2768                                    const double A_22_3 = A_p[INDEX3(2,2,3,3,3)];
2769                                    const double A_00_4 = A_p[INDEX3(0,0,4,3,3)];
2770                                    const double A_01_4 = A_p[INDEX3(0,1,4,3,3)];
2771                                    const double A_02_4 = A_p[INDEX3(0,2,4,3,3)];
2772                                    const double A_10_4 = A_p[INDEX3(1,0,4,3,3)];
2773                                    const double A_11_4 = A_p[INDEX3(1,1,4,3,3)];
2774                                    const double A_12_4 = A_p[INDEX3(1,2,4,3,3)];
2775                                    const double A_20_4 = A_p[INDEX3(2,0,4,3,3)];
2776                                    const double A_21_4 = A_p[INDEX3(2,1,4,3,3)];
2777                                    const double A_22_4 = A_p[INDEX3(2,2,4,3,3)];
2778                                    const double A_00_5 = A_p[INDEX3(0,0,5,3,3)];
2779                                    const double A_01_5 = A_p[INDEX3(0,1,5,3,3)];
2780                                    const double A_02_5 = A_p[INDEX3(0,2,5,3,3)];
2781                                    const double A_10_5 = A_p[INDEX3(1,0,5,3,3)];
2782                                    const double A_11_5 = A_p[INDEX3(1,1,5,3,3)];
2783                                    const double A_12_5 = A_p[INDEX3(1,2,5,3,3)];
2784                                    const double A_20_5 = A_p[INDEX3(2,0,5,3,3)];
2785                                    const double A_21_5 = A_p[INDEX3(2,1,5,3,3)];
2786                                    const double A_22_5 = A_p[INDEX3(2,2,5,3,3)];
2787                                    const double A_00_6 = A_p[INDEX3(0,0,6,3,3)];
2788                                    const double A_01_6 = A_p[INDEX3(0,1,6,3,3)];
2789                                    const double A_02_6 = A_p[INDEX3(0,2,6,3,3)];
2790                                    const double A_10_6 = A_p[INDEX3(1,0,6,3,3)];
2791                                    const double A_11_6 = A_p[INDEX3(1,1,6,3,3)];
2792                                    const double A_12_6 = A_p[INDEX3(1,2,6,3,3)];
2793                                    const double A_20_6 = A_p[INDEX3(2,0,6,3,3)];
2794                                    const double A_21_6 = A_p[INDEX3(2,1,6,3,3)];
2795                                    const double A_22_6 = A_p[INDEX3(2,2,6,3,3)];
2796                                    const double A_00_7 = A_p[INDEX3(0,0,7,3,3)];
2797                                    const double A_01_7 = A_p[INDEX3(0,1,7,3,3)];
2798                                    const double A_02_7 = A_p[INDEX3(0,2,7,3,3)];
2799                                    const double A_10_7 = A_p[INDEX3(1,0,7,3,3)];
2800                                    const double A_11_7 = A_p[INDEX3(1,1,7,3,3)];
2801                                    const double A_12_7 = A_p[INDEX3(1,2,7,3,3)];
2802                                    const double A_20_7 = A_p[INDEX3(2,0,7,3,3)];
2803                                    const double A_21_7 = A_p[INDEX3(2,1,7,3,3)];
2804                                    const double A_22_7 = A_p[INDEX3(2,2,7,3,3)];
2805                                    const double tmp160_0 = A_12_0 + A_12_6 + A_21_0 + A_21_6;
2806                                    const double tmp8_0 = A_21_0 + A_21_6;
2807                                    const double tmp135_0 = A_10_1 + A_10_2 + A_10_5 + A_10_6;
2808                                    const double tmp67_0 = A_02_2 + A_02_7;
2809                                    const double tmp211_0 = A_12_6 + A_21_6;
2810                                    const double tmp180_0 = A_10_2 + A_10_6;
2811                                    const double tmp37_0 = A_00_0 + A_00_1 + A_00_2 + A_00_3;
2812                                    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;
2813                                    const double tmp195_0 = A_02_2 + A_20_2;
2814                                    const double tmp70_0 = A_01_0 + A_01_7;
2815                                    const double tmp139_0 = A_02_3 + A_02_4 + A_20_1 + A_20_6;
2816                                    const double tmp200_0 = A_12_3 + A_12_5 + A_21_3 + A_21_5;
2817                                    const double tmp60_0 = A_22_0 + A_22_2 + A_22_4 + A_22_6;
2818                                    const double tmp192_0 = A_01_5 + A_10_5;
2819                                    const double tmp46_0 = A_21_0 + A_21_7;
2820                                    const double tmp48_0 = A_10_0 + A_10_7;
2821                                    const double tmp166_0 = A_11_5 + A_11_7;
2822                                    const double tmp221_0 = A_02_1 + A_02_6 + A_20_3 + A_20_4;
2823                                    const double tmp50_0 = A_02_4 + A_02_6 + A_20_4 + A_20_6;
2824                                    const double tmp217_0 = A_02_3 + A_02_4 + A_20_3 + A_20_4;
2825                                    const double tmp216_0 = A_01_2 + A_01_5 + A_10_2 + A_10_5;
2826                                    const double tmp104_0 = A_22_2 + A_22_6;
2827                                    const double tmp72_0 = A_20_3 + A_20_6;
2828                                    const double tmp79_0 = A_10_4 + A_10_7;
2829                                    const double tmp86_0 = A_01_2 + A_01_6 + A_10_1 + A_10_5;
2830                                    const double tmp214_0 = A_12_0 + A_12_7 + A_21_0 + A_21_7;
2831                                    const double tmp32_0 = A_02_0 + A_02_2;
2832                                    const double tmp112_0 = A_01_0 + A_01_4 + A_10_3 + A_10_7;
2833                                    const double tmp197_0 = A_12_0 + A_21_0;
2834                                    const double tmp106_0 = A_22_1 + A_22_5;
2835                                    const double tmp2_0 = A_00_0 + A_00_1 + A_00_4 + A_00_5;
2836                                    const double tmp115_0 = A_02_5 + A_02_7 + A_20_0 + A_20_2;
2837                                    const double tmp175_0 = A_01_3 + A_01_7;
2838                                    const double tmp126_0 = A_01_2 + A_01_5 + A_10_1 + A_10_6;
2839                                    const double tmp90_0 = A_00_0 + A_00_1 + A_00_2 + A_00_3 + A_00_4 + A_00_5 + A_00_6 + A_00_7;
2840                                    const double tmp47_0 = A_12_0 + A_12_6;
2841                                    const double tmp205_0 = A_02_7 + A_20_7;
2842                                    const double tmp148_0 = A_01_3 + A_01_4;
2843                                    const double tmp113_0 = A_01_3 + A_01_7 + A_10_0 + A_10_4;
2844                                    const double tmp43_0 = A_20_4 + A_20_6;
2845                                    const double tmp161_0 = A_02_1 + A_02_6 + A_20_1 + A_20_6;
2846                                    const double tmp69_0 = A_12_0 + A_12_1 + A_12_6 + A_12_7 + A_21_0 + A_21_1 + A_21_6 + A_21_7;
2847                                    const double tmp176_0 = A_01_1 + A_01_2 + A_01_5 + A_01_6;
2848                                    const double tmp105_0 = A_01_2 + A_01_6 + A_10_2 + A_10_6;
2849                                    const double tmp22_0 = A_01_5 + A_10_6;
2850                                    const double tmp91_0 = A_02_4 + A_02_6 + A_20_1 + A_20_3;
2851                                    const double tmp206_0 = A_12_7 + A_21_7;
2852                                    const double tmp188_0 = A_02_5 + A_20_5;
2853                                    const double tmp117_0 = A_21_1 + A_21_6;
2854                                    const double tmp165_0 = A_01_1 + A_01_6;
2855                                    const double tmp66_0 = A_00_4 + A_00_5;
2856                                    const double tmp57_0 = A_02_0 + A_02_2 + A_02_5 + A_02_7 + A_20_0 + A_20_2 + A_20_5 + A_20_7;
2857                                    const double tmp31_0 = A_21_4 + A_21_5;
2858                                    const double tmp3_0 = A_11_0 + A_11_2 + A_11_4 + A_11_6;
2859                                    const double tmp183_0 = A_12_0 + A_12_7;
2860                                    const double tmp61_0 = A_02_1 + A_02_3 + A_20_1 + A_20_3;
2861                                    const double tmp54_0 = A_10_5 + A_10_6;
2862                                    const double tmp18_0 = A_02_3 + A_02_6;
2863                                    const double tmp119_0 = A_12_2 + A_12_3 + A_12_4 + A_12_5 + A_21_2 + A_21_3 + A_21_4 + A_21_5;
2864                                    const double tmp29_0 = A_21_2 + A_21_3;
2865                                    const double tmp17_0 = A_01_3 + A_01_7 + A_10_3 + A_10_7;
2866                                    const double tmp212_0 = A_02_6 + A_20_6;
2867                                    const double tmp220_0 = A_02_3 + A_20_6;
2868                                    const double tmp78_0 = A_20_0 + A_20_7;
2869                                    const double tmp215_0 = A_01_6 + A_10_6;
2870                                    const double tmp203_0 = A_01_7 + A_10_7;
2871                                    const double tmp87_0 = A_12_2 + A_12_3 + A_21_4 + A_21_5;
2872                                    const double tmp114_0 = A_02_0 + A_02_2 + A_20_5 + A_20_7;
2873                                    const double tmp0_0 = A_01_0 + A_01_4 + A_10_0 + A_10_4;
2874                                    const double tmp202_0 = A_01_3 + A_01_4 + A_10_3 + A_10_4;
2875                                    const double tmp4_0 = A_20_0 + A_20_5;
2876                                    const double tmp65_0 = A_00_2 + A_00_3;
2877                                    const double tmp24_0 = A_20_1 + A_20_3;
2878                                    const double tmp64_0 = A_10_0 + A_10_3;
2879                                    const double tmp170_0 = A_02_0 + A_02_2 + A_20_0 + A_20_2;
2880                                    const double tmp11_0 = A_20_1 + A_20_6;
2881                                    const double tmp82_0 = A_12_4 + A_12_5 + A_21_4 + A_21_5;
2882                                    const double tmp99_0 = A_01_4 + A_10_7;
2883                                    const double tmp49_0 = A_12_1 + A_12_7;
2884                                    const double tmp130_0 = A_12_0 + A_12_1 + A_12_6 + A_12_7;
2885                                    const double tmp144_0 = A_01_0 + A_10_3;
2886                                    const double tmp109_0 = A_22_0 + A_22_3 + A_22_4 + A_22_7;
2887                                    const double tmp185_0 = A_02_0 + A_02_7 + A_20_2 + A_20_5;
2888                                    const double tmp157_0 = A_01_4 + A_10_4;
2889                                    const double tmp51_0 = A_22_1 + A_22_3 + A_22_5 + A_22_7;
2890                                    const double tmp146_0 = A_00_6 + A_00_7;
2891                                    const double tmp147_0 = A_12_0 + A_12_1 + A_21_0 + A_21_1;
2892                                    const double tmp150_0 = A_00_2 + A_00_3 + A_00_4 + A_00_5;
2893                                    const double tmp62_0 = A_21_3 + A_21_5;
2894                                    const double tmp223_0 = A_12_2 + A_21_4;
2895                                    const double tmp16_0 = A_02_2 + A_02_5;
2896                                    const double tmp168_0 = A_11_1 + A_11_3 + A_11_4 + A_11_6;
2897                                    const double tmp88_0 = A_12_4 + A_12_5 + A_21_2 + A_21_3;
2898                                    const double tmp142_0 = A_01_7 + A_10_4;
2899                                    const double tmp34_0 = A_20_0 + A_20_2 + A_20_5 + A_20_7;
2900                                    const double tmp71_0 = A_00_0 + A_00_1 + A_00_6 + A_00_7;
2901                                    const double tmp213_0 = A_02_1 + A_20_1;
2902                                    const double tmp227_0 = A_12_2 + A_12_5 + A_21_3 + A_21_4;
2903                                    const double tmp228_0 = A_12_1 + A_21_7;
2904                                    const double tmp140_0 = A_01_2 + A_01_6;
2905                                    const double tmp74_0 = A_22_0 + A_22_1 + A_22_4 + A_22_5;
2906                                    const double tmp167_0 = A_11_0 + A_11_2;
2907                                    const double tmp143_0 = A_01_3 + A_01_4 + A_10_0 + A_10_7;
2908                                    const double tmp83_0 = A_02_0 + A_02_5;
2909                                    const double tmp14_0 = A_22_1 + A_22_2 + A_22_5 + A_22_6;
2910                                    const double tmp5_0 = A_12_1 + A_12_6;
2911                                    const double tmp94_0 = A_02_1 + A_02_3;
2912                                    const double tmp193_0 = A_01_1 + A_01_6 + A_10_1 + A_10_6;
2913                                    const double tmp97_0 = A_02_0 + A_02_2 + A_02_5 + A_02_7;
2914                                    const double tmp131_0 = A_01_1 + A_01_5;
2915                                    const double tmp124_0 = A_01_6 + A_10_5;
2916                                    const double tmp149_0 = A_12_6 + A_12_7 + A_21_6 + A_21_7;
2917                                    const double tmp187_0 = A_01_2 + A_10_2;
2918                                    const double tmp93_0 = A_01_1 + A_01_2 + A_10_1 + A_10_2;
2919                                    const double tmp25_0 = A_01_4 + A_01_7 + A_10_4 + A_10_7;
2920                                    const double tmp156_0 = A_12_2 + A_12_5 + A_21_2 + A_21_5;
2921                                    const double tmp20_0 = A_21_2 + A_21_5;
2922                                    const double tmp55_0 = A_21_2 + A_21_4;
2923                                    const double tmp208_0 = A_12_1 + A_12_6 + A_21_0 + A_21_7;
2924                                    const double tmp125_0 = A_12_4 + A_12_5;
2925                                    const double tmp158_0 = A_01_0 + A_01_7 + A_10_0 + A_10_7;
2926                                    const double tmp108_0 = A_01_1 + A_01_5 + A_10_1 + A_10_5;
2927                                    const double tmp199_0 = A_12_2 + A_12_4 + A_21_2 + A_21_4;
2928                                    const double tmp10_0 = A_02_1 + A_02_4;
2929                                    const double tmp182_0 = A_02_3 + A_02_6 + A_20_3 + A_20_6;