/[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

revision 3971 by caltinay, Wed Sep 19 02:55:35 2012 UTC revision 4738 by sshaw, Wed Mar 12 01:32:36 2014 UTC
# Line 1  Line 1 
1    
2  /*******************************************************  /*****************************************************************************
3  *  *
4  * Copyright (c) 2003-2012 by University of Queensland  * Copyright (c) 2003-2014 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 2012-2013 by School of Earth Sciences
13    * Development from 2014 by Centre for Geoscience Computing (GeoComp)
14    *
15    *****************************************************************************/
16    
17  #include <ripley/Brick.h>  #include <ripley/Brick.h>
 extern "C" {  
18  #include <paso/SystemMatrix.h>  #include <paso/SystemMatrix.h>
19  }  #include <esysUtils/esysFileWriter.h>
20    #include <ripley/DefaultAssembler3D.h>
21    #include <ripley/WaveAssembler3D.h>
22    #include <ripley/LameAssembler3D.h>
23    #include <ripley/domainhelpers.h>
24    #include <boost/scoped_array.hpp>
25    
26    #ifdef USE_NETCDF
27    #include <netcdfcpp.h>
28    #endif
29    
30  #if USE_SILO  #if USE_SILO
31  #include <silo.h>  #include <silo.h>
# Line 25  extern "C" { Line 36  extern "C" {
36    
37  #include <iomanip>  #include <iomanip>
38    
39    #include "esysUtils/EsysRandom.h"
40    #include "blocktools.h"
41    
42    
43  using namespace std;  using namespace std;
44    using esysUtils::FileWriter;
45    
46  namespace ripley {  namespace ripley {
47    
48    int indexOfMax(int a, int b, int c) {
49        if (a > b) {
50            if (c > a) {
51                return 2;
52            }
53            return 0;
54        } else if (b > c) {
55            return 1;
56        }
57        return 2;
58    }
59    
60  Brick::Brick(int n0, int n1, int n2, double x0, double y0, double z0,  Brick::Brick(int n0, int n1, int n2, double x0, double y0, double z0,
61               double x1, double y1, double z1, int d0, int d1, int d2) :               double x1, double y1, double z1, int d0, int d1, int d2,
62      RipleyDomain(3),               const std::vector<double>& points, const std::vector<int>& tags,
63      m_x0(x0),               const simap_t& tagnamestonums) :
64      m_y0(y0),      RipleyDomain(3)
     m_z0(z0),  
     m_l0(x1-x0),  
     m_l1(y1-y0),  
     m_l2(z1-z0)  
65  {  {
66      // ignore subdivision parameters for serial run      // ignore subdivision parameters for serial run
67      if (m_mpiInfo->size == 1) {      if (m_mpiInfo->size == 1) {
# Line 45  Brick::Brick(int n0, int n1, int n2, dou Line 69  Brick::Brick(int n0, int n1, int n2, dou
69          d1=1;          d1=1;
70          d2=1;          d2=1;
71      }      }
   
72      bool warn=false;      bool warn=false;
73      // if number of subdivisions is non-positive, try to subdivide by the same  
74      // ratio as the number of elements      std::vector<int> factors;
75      if (d0<=0 && d1<=0 && d2<=0) {      int ranks = m_mpiInfo->size;
76          warn=true;      int epr[3] = {n0,n1,n2};
77          d0=(int)(pow(m_mpiInfo->size*(n0+1)*(n0+1)/((float)(n1+1)*(n2+1)), 1.f/3));      int d[3] = {d0,d1,d2};
78          d1=(int)(d0*n1/(float)n0);      if (d0<=0 || d1<=0 || d2<=0) {
79          d2=m_mpiInfo->size/(d0*d1);          for (int i = 0; i < 3; i++) {
80          if (d0*d1*d2 != m_mpiInfo->size) {              if (d[i] < 1) {
81              // ratios not the same so leave "smallest" side undivided and try                  d[i] = 1;
82              // dividing 2 sides only                  continue;
83              if (n0>=n1) {              }
84                  if (n1>=n2) {              epr[i] = -1; // can no longer be max
85                      d0=d1=0;              if (ranks % d[i] != 0) {
86                      d2=1;                  throw RipleyException("Invalid number of spatial subdivisions");
87                  } else {              }
88                      d0=d2=0;              //remove
89                      d1=1;              ranks /= d[i];
90                  }          }
91              } else {          factorise(factors, ranks);
92                  if (n0>=n2) {          if (factors.size() != 0) {
93                      d0=d1=0;              warn = true;
94                      d2=1;          }
95                  } else {      }
96                      d0=1;      while (factors.size() > 0) {
97                      d1=d2=0;          int i = indexOfMax(epr[0],epr[1],epr[2]);
98                  }          int f = factors.back();
99              }          factors.pop_back();
100          }          d[i] *= f;
101      }          epr[i] /= f;
     if (d0<=0 && d1<=0) {  
         warn=true;  
         d0=int(sqrt(m_mpiInfo->size*(n0+1)/(float)(n1+1)));  
         d1=m_mpiInfo->size/d0;  
         if (d0*d1*d2 != m_mpiInfo->size) {  
             // ratios not the same so subdivide side with more elements only  
             if (n0>n1) {  
                 d0=0;  
                 d1=1;  
             } else {  
                 d0=1;  
                 d1=0;  
             }  
         }  
     } else if (d0<=0 && d2<=0) {  
         warn=true;  
         d0=int(sqrt(m_mpiInfo->size*(n0+1)/(float)(n2+1)));  
         d2=m_mpiInfo->size/d0;  
         if (d0*d1*d2 != m_mpiInfo->size) {  
             // ratios not the same so subdivide side with more elements only  
             if (n0>n2) {  
                 d0=0;  
                 d2=1;  
             } else {  
                 d0=1;  
                 d2=0;  
             }  
         }  
     } else if (d1<=0 && d2<=0) {  
         warn=true;  
         d1=int(sqrt(m_mpiInfo->size*(n1+1)/(float)(n2+1)));  
         d2=m_mpiInfo->size/d1;  
         if (d0*d1*d2 != m_mpiInfo->size) {  
             // ratios not the same so subdivide side with more elements only  
             if (n1>n2) {  
                 d1=0;  
                 d2=1;  
             } else {  
                 d1=1;  
                 d2=0;  
             }  
         }  
102      }      }
103      if (d0<=0) {      d0 = d[0]; d1 = d[1]; d2 = d[2];
         // d1,d2 are preset, determine d0  
         d0=m_mpiInfo->size/(d1*d2);  
     } else if (d1<=0) {  
         // d0,d2 are preset, determine d1  
         d1=m_mpiInfo->size/(d0*d2);  
     } else if (d2<=0) {  
         // d0,d1 are preset, determine d2  
         d2=m_mpiInfo->size/(d0*d1);  
     }  
   
     m_NX=d0;  
     m_NY=d1;  
     m_NZ=d2;  
104    
105      // ensure number of subdivisions is valid and nodes can be distributed      // ensure number of subdivisions is valid and nodes can be distributed
106      // among number of ranks      // among number of ranks
107      if (m_NX*m_NY*m_NZ != m_mpiInfo->size)      if (d0*d1*d2 != m_mpiInfo->size){
108          throw RipleyException("Invalid number of spatial subdivisions");          throw RipleyException("Invalid number of spatial subdivisions");
109        }
110      if (warn) {      if (warn) {
111          cout << "Warning: Automatic domain subdivision (d0=" << d0 << ", d1="          cout << "Warning: Automatic domain subdivision (d0=" << d0 << ", d1="
112              << d1 << ", d2=" << d2 << "). This may not be optimal!" << endl;              << d1 << ", d2=" << d2 << "). This may not be optimal!" << endl;
113      }      }
114    
115      if ((n0+1)%m_NX > 0) {      double l0 = x1-x0;
116          double Dx=m_l0/n0;      double l1 = y1-y0;
117        double l2 = z1-z0;
118        m_dx[0] = l0/n0;
119        m_dx[1] = l1/n1;
120        m_dx[2] = l2/n2;
121    
122        if ((n0+1)%d0 > 0) {
123          n0=(int)round((float)(n0+1)/d0+0.5)*d0-1;          n0=(int)round((float)(n0+1)/d0+0.5)*d0-1;
124          m_l0=Dx*n0;          l0=m_dx[0]*n0;
125          cout << "Warning: Adjusted number of elements and length. N0="          cout << "Warning: Adjusted number of elements and length. N0="
126              << n0 << ", l0=" << m_l0 << endl;              << n0 << ", l0=" << l0 << endl;
127      }      }
128      if ((n1+1)%m_NY > 0) {      if ((n1+1)%d1 > 0) {
         double Dy=m_l1/n1;  
129          n1=(int)round((float)(n1+1)/d1+0.5)*d1-1;          n1=(int)round((float)(n1+1)/d1+0.5)*d1-1;
130          m_l1=Dy*n1;          l1=m_dx[1]*n1;
131          cout << "Warning: Adjusted number of elements and length. N1="          cout << "Warning: Adjusted number of elements and length. N1="
132              << n1 << ", l1=" << m_l1 << endl;              << n1 << ", l1=" << l1 << endl;
133      }      }
134      if ((n2+1)%m_NZ > 0) {      if ((n2+1)%d2 > 0) {
         double Dz=m_l2/n2;  
135          n2=(int)round((float)(n2+1)/d2+0.5)*d2-1;          n2=(int)round((float)(n2+1)/d2+0.5)*d2-1;
136          m_l2=Dz*n2;          l2=m_dx[2]*n2;
137          cout << "Warning: Adjusted number of elements and length. N2="          cout << "Warning: Adjusted number of elements and length. N2="
138              << n2 << ", l2=" << m_l2 << endl;              << n2 << ", l2=" << l2 << endl;
139      }      }
140    
141      m_gNE0=n0;      if ((d0 > 1 && (n0+1)/d0<2) || (d1 > 1 && (n1+1)/d1<2) || (d2 > 1 && (n2+1)/d2<2))
     m_gNE1=n1;  
     m_gNE2=n2;  
   
     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))  
142          throw RipleyException("Too few elements for the number of ranks");          throw RipleyException("Too few elements for the number of ranks");
143    
144        m_gNE[0] = n0;
145        m_gNE[1] = n1;
146        m_gNE[2] = n2;
147        m_origin[0] = x0;
148        m_origin[1] = y0;
149        m_origin[2] = z0;
150        m_length[0] = l0;
151        m_length[1] = l1;
152        m_length[2] = l2;
153        m_NX[0] = d0;
154        m_NX[1] = d1;
155        m_NX[2] = d2;
156    
157      // local number of elements (including overlap)      // local number of elements (including overlap)
158      m_NE0 = m_ownNE0 = (m_NX>1 ? (n0+1)/m_NX : n0);      m_NE[0] = m_ownNE[0] = (d0>1 ? (n0+1)/d0 : n0);
159      if (m_mpiInfo->rank%m_NX>0 && m_mpiInfo->rank%m_NX<m_NX-1)      if (m_mpiInfo->rank%d0>0 && m_mpiInfo->rank%d0<d0-1)
160          m_NE0++;          m_NE[0]++;
161      else if (m_NX>1 && m_mpiInfo->rank%m_NX==m_NX-1)      else if (d0>1 && m_mpiInfo->rank%d0==d0-1)
162          m_ownNE0--;          m_ownNE[0]--;
163    
164      m_NE1 = m_ownNE1 = (m_NY>1 ? (n1+1)/m_NY : n1);      m_NE[1] = m_ownNE[1] = (d1>1 ? (n1+1)/d1 : n1);
165      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%(d0*d1)/d0>0 && m_mpiInfo->rank%(d0*d1)/d0<d1-1)
166          m_NE1++;          m_NE[1]++;
167      else if (m_NY>1 && m_mpiInfo->rank%(m_NX*m_NY)/m_NX==m_NY-1)      else if (d1>1 && m_mpiInfo->rank%(d0*d1)/d0==d1-1)
168          m_ownNE1--;          m_ownNE[1]--;
169    
170      m_NE2 = m_ownNE2 = (m_NZ>1 ? (n2+1)/m_NZ : n2);      m_NE[2] = m_ownNE[2] = (d2>1 ? (n2+1)/d2 : n2);
171      if (m_mpiInfo->rank/(m_NX*m_NY)>0 && m_mpiInfo->rank/(m_NX*m_NY)<m_NZ-1)      if (m_mpiInfo->rank/(d0*d1)>0 && m_mpiInfo->rank/(d0*d1)<d2-1)
172          m_NE2++;          m_NE[2]++;
173      else if (m_NZ>1 && m_mpiInfo->rank/(m_NX*m_NY)==m_NZ-1)      else if (d2>1 && m_mpiInfo->rank/(d0*d1)==d2-1)
174          m_ownNE2--;          m_ownNE[2]--;
175    
176      // local number of nodes      // local number of nodes
177      m_N0 = m_NE0+1;      m_NN[0] = m_NE[0]+1;
178      m_N1 = m_NE1+1;      m_NN[1] = m_NE[1]+1;
179      m_N2 = m_NE2+1;      m_NN[2] = m_NE[2]+1;
180    
181      // bottom-left-front node is at (offset0,offset1,offset2) in global mesh      // bottom-left-front node is at (offset0,offset1,offset2) in global mesh
182      m_offset0 = (n0+1)/m_NX*(m_mpiInfo->rank%m_NX);      m_offset[0] = (n0+1)/d0*(m_mpiInfo->rank%d0);
183      if (m_offset0 > 0)      if (m_offset[0] > 0)
184          m_offset0--;          m_offset[0]--;
185      m_offset1 = (n1+1)/m_NY*(m_mpiInfo->rank%(m_NX*m_NY)/m_NX);      m_offset[1] = (n1+1)/d1*(m_mpiInfo->rank%(d0*d1)/d0);
186      if (m_offset1 > 0)      if (m_offset[1] > 0)
187          m_offset1--;          m_offset[1]--;
188      m_offset2 = (n2+1)/m_NZ*(m_mpiInfo->rank/(m_NX*m_NY));      m_offset[2] = (n2+1)/d2*(m_mpiInfo->rank/(d0*d1));
189      if (m_offset2 > 0)      if (m_offset[2] > 0)
190          m_offset2--;          m_offset[2]--;
191    
192      populateSampleIds();      populateSampleIds();
193      createPattern();      createPattern();
194        
195        assembler = new DefaultAssembler3D(this, m_dx, m_NX, m_NE, m_NN);
196        for (map<string, int>::const_iterator i = tagnamestonums.begin();
197                i != tagnamestonums.end(); i++) {
198            setTagMap(i->first, i->second);
199        }
200        addPoints(tags.size(), &points[0], &tags[0]);
201  }  }
202    
203    
# Line 217  Brick::~Brick() Line 205  Brick::~Brick()
205  {  {
206      Paso_SystemMatrixPattern_free(m_pattern);      Paso_SystemMatrixPattern_free(m_pattern);
207      Paso_Connector_free(m_connector);      Paso_Connector_free(m_connector);
208        delete assembler;
209  }  }
210    
211  string Brick::getDescription() const  string Brick::getDescription() const
# Line 229  bool Brick::operator==(const AbstractDom Line 218  bool Brick::operator==(const AbstractDom
218      const Brick* o=dynamic_cast<const Brick*>(&other);      const Brick* o=dynamic_cast<const Brick*>(&other);
219      if (o) {      if (o) {
220          return (RipleyDomain::operator==(other) &&          return (RipleyDomain::operator==(other) &&
221                  m_gNE0==o->m_gNE0 && m_gNE1==o->m_gNE1 && m_gNE2==o->m_gNE2                  m_gNE[0]==o->m_gNE[0] && m_gNE[1]==o->m_gNE[1] && m_gNE[2]==o->m_gNE[2]
222                  && m_x0==o->m_x0 && m_y0==o->m_y0 && m_z0==o->m_z0                  && m_origin[0]==o->m_origin[0] && m_origin[1]==o->m_origin[1] && m_origin[2]==o->m_origin[2]
223                  && m_l0==o->m_l0 && m_l1==o->m_l1 && m_l2==o->m_l2                  && m_length[0]==o->m_length[0] && m_length[1]==o->m_length[1] && m_length[2]==o->m_length[2]
224                  && m_NX==o->m_NX && m_NY==o->m_NY && m_NZ==o->m_NZ);                  && m_NX[0]==o->m_NX[0] && m_NX[1]==o->m_NX[1] && m_NX[2]==o->m_NX[2]);
225      }      }
226    
227      return false;      return false;
228  }  }
229    
230    void Brick::readNcGrid(escript::Data& out, string filename, string varname,
231                const ReaderParameters& params) const
232    {
233    #ifdef USE_NETCDF
234        // check destination function space
235        int myN0, myN1, myN2;
236        if (out.getFunctionSpace().getTypeCode() == Nodes) {
237            myN0 = m_NN[0];
238            myN1 = m_NN[1];
239            myN2 = m_NN[2];
240        } else if (out.getFunctionSpace().getTypeCode() == Elements ||
241                    out.getFunctionSpace().getTypeCode() == ReducedElements) {
242            myN0 = m_NE[0];
243            myN1 = m_NE[1];
244            myN2 = m_NE[2];
245        } else
246            throw RipleyException("readNcGrid(): invalid function space for output data object");
247    
248        if (params.first.size() != 3)
249            throw RipleyException("readNcGrid(): argument 'first' must have 3 entries");
250    
251        if (params.numValues.size() != 3)
252            throw RipleyException("readNcGrid(): argument 'numValues' must have 3 entries");
253    
254        if (params.multiplier.size() != 3)
255            throw RipleyException("readNcGrid(): argument 'multiplier' must have 3 entries");
256        for (size_t i=0; i<params.multiplier.size(); i++)
257            if (params.multiplier[i]<1)
258                throw RipleyException("readNcGrid(): all multipliers must be positive");
259    
260        // check file existence and size
261        NcFile f(filename.c_str(), NcFile::ReadOnly);
262        if (!f.is_valid())
263            throw RipleyException("readNcGrid(): cannot open file");
264    
265        NcVar* var = f.get_var(varname.c_str());
266        if (!var)
267            throw RipleyException("readNcGrid(): invalid variable name");
268    
269        // TODO: rank>0 data support
270        const int numComp = out.getDataPointSize();
271        if (numComp > 1)
272            throw RipleyException("readNcGrid(): only scalar data supported");
273    
274        const int dims = var->num_dims();
275        boost::scoped_array<long> edges(var->edges());
276    
277        // is this a slice of the data object (dims!=3)?
278        // note the expected ordering of edges (as in numpy: z,y,x)
279        if ( (dims==3 && (params.numValues[2] > edges[0] ||
280                          params.numValues[1] > edges[1] ||
281                          params.numValues[0] > edges[2]))
282                || (dims==2 && params.numValues[2]>1)
283                || (dims==1 && (params.numValues[2]>1 || params.numValues[1]>1)) ) {
284            throw RipleyException("readNcGrid(): not enough data in file");
285        }
286    
287        // check if this rank contributes anything
288        if (params.first[0] >= m_offset[0]+myN0 ||
289                params.first[0]+params.numValues[0]*params.multiplier[0] <= m_offset[0] ||
290                params.first[1] >= m_offset[1]+myN1 ||
291                params.first[1]+params.numValues[1]*params.multiplier[1] <= m_offset[1] ||
292                params.first[2] >= m_offset[2]+myN2 ||
293                params.first[2]+params.numValues[2]*params.multiplier[2] <= m_offset[2]) {
294            return;
295        }
296    
297        // now determine how much this rank has to write
298    
299        // first coordinates in data object to write to
300        const int first0 = max(0, params.first[0]-m_offset[0]);
301        const int first1 = max(0, params.first[1]-m_offset[1]);
302        const int first2 = max(0, params.first[2]-m_offset[2]);
303        // indices to first value in file (not accounting for reverse yet)
304        int idx0 = max(0, m_offset[0]-params.first[0]);
305        int idx1 = max(0, m_offset[1]-params.first[1]);
306        int idx2 = max(0, m_offset[2]-params.first[2]);
307        // number of values to read
308        const int num0 = min(params.numValues[0]-idx0, myN0-first0);
309        const int num1 = min(params.numValues[1]-idx1, myN1-first1);
310        const int num2 = min(params.numValues[2]-idx2, myN2-first2);
311    
312        // make sure we read the right block if going backwards through file
313        if (params.reverse[0])
314            idx0 = edges[dims-1]-num0-idx0;
315        if (dims>1 && params.reverse[1])
316            idx1 = edges[dims-2]-num1-idx1;
317        if (dims>2 && params.reverse[2])
318            idx2 = edges[dims-3]-num2-idx2;
319    
320    
321        vector<double> values(num0*num1*num2);
322        if (dims==3) {
323            var->set_cur(idx2, idx1, idx0);
324            var->get(&values[0], num2, num1, num0);
325        } else if (dims==2) {
326            var->set_cur(idx1, idx0);
327            var->get(&values[0], num1, num0);
328        } else {
329            var->set_cur(idx0);
330            var->get(&values[0], num0);
331        }
332    
333        const int dpp = out.getNumDataPointsPerSample();
334        out.requireWrite();
335    
336        // helpers for reversing
337        const int x0 = (params.reverse[0] ? num0-1 : 0);
338        const int x_mult = (params.reverse[0] ? -1 : 1);
339        const int y0 = (params.reverse[1] ? num1-1 : 0);
340        const int y_mult = (params.reverse[1] ? -1 : 1);
341        const int z0 = (params.reverse[2] ? num2-1 : 0);
342        const int z_mult = (params.reverse[2] ? -1 : 1);
343    
344        for (index_t z=0; z<num2; z++) {
345            for (index_t y=0; y<num1; y++) {
346    #pragma omp parallel for
347                for (index_t x=0; x<num0; x++) {
348                    const int baseIndex = first0+x*params.multiplier[0]
349                                         +(first1+y*params.multiplier[1])*myN0
350                                         +(first2+z*params.multiplier[2])*myN0*myN1;
351                    const int srcIndex=(z0+z_mult*z)*num1*num0
352                                      +(y0+y_mult*y)*num0
353                                      +(x0+x_mult*x);
354                    if (!isnan(values[srcIndex])) {
355                        for (index_t m2=0; m2<params.multiplier[2]; m2++) {
356                            for (index_t m1=0; m1<params.multiplier[1]; m1++) {
357                                for (index_t m0=0; m0<params.multiplier[0]; m0++) {
358                                    const int dataIndex = baseIndex+m0
359                                                   +m1*myN0
360                                                   +m2*myN0*myN1;
361                                    double* dest = out.getSampleDataRW(dataIndex);
362                                    for (index_t q=0; q<dpp; q++) {
363                                        *dest++ = values[srcIndex];
364                                    }
365                                }
366                            }
367                        }
368                    }
369                }
370            }
371        }
372    #else
373        throw RipleyException("readNcGrid(): not compiled with netCDF support");
374    #endif
375    }
376    
377    #ifdef USE_BOOSTIO
378    void Brick::readBinaryGridFromZipped(escript::Data& out, string filename,
379                               const ReaderParameters& params) const
380    {
381        // the mapping is not universally correct but should work on our
382        // supported platforms
383        switch (params.dataType) {
384            case DATATYPE_INT32:
385                readBinaryGridZippedImpl<int>(out, filename, params);
386                break;
387            case DATATYPE_FLOAT32:
388                readBinaryGridZippedImpl<float>(out, filename, params);
389                break;
390            case DATATYPE_FLOAT64:
391                readBinaryGridZippedImpl<double>(out, filename, params);
392                break;
393            default:
394                throw RipleyException("readBinaryGrid(): invalid or unsupported datatype");
395        }
396    }
397    #endif
398    
399  void Brick::readBinaryGrid(escript::Data& out, string filename,  void Brick::readBinaryGrid(escript::Data& out, string filename,
400                             const vector<int>& first,                             const ReaderParameters& params) const
401                             const vector<int>& numValues) const  {
402        // the mapping is not universally correct but should work on our
403        // supported platforms
404        switch (params.dataType) {
405            case DATATYPE_INT32:
406                readBinaryGridImpl<int>(out, filename, params);
407                break;
408            case DATATYPE_FLOAT32:
409                readBinaryGridImpl<float>(out, filename, params);
410                break;
411            case DATATYPE_FLOAT64:
412                readBinaryGridImpl<double>(out, filename, params);
413                break;
414            default:
415                throw RipleyException("readBinaryGrid(): invalid or unsupported datatype");
416        }
417    }
418    
419    template<typename ValueType>
420    void Brick::readBinaryGridImpl(escript::Data& out, const string& filename,
421                                   const ReaderParameters& params) const
422  {  {
423      // check destination function space      // check destination function space
424      int myN0, myN1, myN2;      int myN0, myN1, myN2;
425      if (out.getFunctionSpace().getTypeCode() == Nodes) {      if (out.getFunctionSpace().getTypeCode() == Nodes) {
426          myN0 = m_N0;          myN0 = m_NN[0];
427          myN1 = m_N1;          myN1 = m_NN[1];
428          myN2 = m_N2;          myN2 = m_NN[2];
429      } else if (out.getFunctionSpace().getTypeCode() == Elements ||      } else if (out.getFunctionSpace().getTypeCode() == Elements ||
430                  out.getFunctionSpace().getTypeCode() == ReducedElements) {                  out.getFunctionSpace().getTypeCode() == ReducedElements) {
431          myN0 = m_NE0;          myN0 = m_NE[0];
432          myN1 = m_NE1;          myN1 = m_NE[1];
433          myN2 = m_NE2;          myN2 = m_NE[2];
434      } else      } else
435          throw RipleyException("readBinaryGrid(): invalid function space for output data object");          throw RipleyException("readBinaryGrid(): invalid function space for output data object");
436    
437        if (params.first.size() != 3)
438            throw RipleyException("readBinaryGrid(): argument 'first' must have 3 entries");
439    
440        if (params.numValues.size() != 3)
441            throw RipleyException("readBinaryGrid(): argument 'numValues' must have 3 entries");
442    
443        if (params.multiplier.size() != 3)
444            throw RipleyException("readBinaryGrid(): argument 'multiplier' must have 3 entries");
445        for (size_t i=0; i<params.multiplier.size(); i++)
446            if (params.multiplier[i]<1)
447                throw RipleyException("readBinaryGrid(): all multipliers must be positive");
448    
449      // check file existence and size      // check file existence and size
450      ifstream f(filename.c_str(), ifstream::binary);      ifstream f(filename.c_str(), ifstream::binary);
451      if (f.fail()) {      if (f.fail()) {
# Line 264  void Brick::readBinaryGrid(escript::Data Line 454  void Brick::readBinaryGrid(escript::Data
454      f.seekg(0, ios::end);      f.seekg(0, ios::end);
455      const int numComp = out.getDataPointSize();      const int numComp = out.getDataPointSize();
456      const int filesize = f.tellg();      const int filesize = f.tellg();
457      const int reqsize = numValues[0]*numValues[1]*numValues[2]*numComp*sizeof(float);      const int reqsize = params.numValues[0]*params.numValues[1]*params.numValues[2]*numComp*sizeof(ValueType);
458      if (filesize < reqsize) {      if (filesize < reqsize) {
459          f.close();          f.close();
460          throw RipleyException("readBinaryGrid(): not enough data in file");          throw RipleyException("readBinaryGrid(): not enough data in file");
461      }      }
462    
463      // check if this rank contributes anything      // check if this rank contributes anything
464      if (first[0] >= m_offset0+myN0 || first[0]+numValues[0] <= m_offset0 ||      if (params.first[0] >= m_offset[0]+myN0 ||
465              first[1] >= m_offset1+myN1 || first[1]+numValues[1] <= m_offset1 ||              params.first[0]+params.numValues[0]*params.multiplier[0] <= m_offset[0] ||
466              first[2] >= m_offset2+myN2 || first[2]+numValues[2] <= m_offset2) {              params.first[1] >= m_offset[1]+myN1 ||
467                params.first[1]+params.numValues[1]*params.multiplier[1] <= m_offset[1] ||
468                params.first[2] >= m_offset[2]+myN2 ||
469                params.first[2]+params.numValues[2]*params.multiplier[2] <= m_offset[2]) {
470          f.close();          f.close();
471          return;          return;
472      }      }
# Line 281  void Brick::readBinaryGrid(escript::Data Line 474  void Brick::readBinaryGrid(escript::Data
474      // now determine how much this rank has to write      // now determine how much this rank has to write
475    
476      // first coordinates in data object to write to      // first coordinates in data object to write to
477      const int first0 = max(0, first[0]-m_offset0);      const int first0 = max(0, params.first[0]-m_offset[0]);
478      const int first1 = max(0, first[1]-m_offset1);      const int first1 = max(0, params.first[1]-m_offset[1]);
479      const int first2 = max(0, first[2]-m_offset2);      const int first2 = max(0, params.first[2]-m_offset[2]);
480      // indices to first value in file      // indices to first value in file
481      const int idx0 = max(0, m_offset0-first[0]);      const int idx0 = max(0, m_offset[0]-params.first[0]);
482      const int idx1 = max(0, m_offset1-first[1]);      const int idx1 = max(0, m_offset[1]-params.first[1]);
483      const int idx2 = max(0, m_offset2-first[2]);      const int idx2 = max(0, m_offset[2]-params.first[2]);
484      // number of values to write      // number of values to read
485      const int num0 = min(numValues[0]-idx0, myN0-first0);      const int num0 = min(params.numValues[0]-idx0, myN0-first0);
486      const int num1 = min(numValues[1]-idx1, myN1-first1);      const int num1 = min(params.numValues[1]-idx1, myN1-first1);
487      const int num2 = min(numValues[2]-idx2, myN2-first2);      const int num2 = min(params.numValues[2]-idx2, myN2-first2);
488    
489      out.requireWrite();      out.requireWrite();
490      vector<float> values(num0*numComp);      vector<ValueType> values(num0*numComp);
491      const int dpp = out.getNumDataPointsPerSample();      const int dpp = out.getNumDataPointsPerSample();
492    
493      for (index_t z=0; z<num2; z++) {      for (int z=0; z<num2; z++) {
494          for (index_t y=0; y<num1; y++) {          for (int y=0; y<num1; y++) {
495              const int fileofs = numComp*(idx0+(idx1+y)*numValues[0]+(idx2+z)*numValues[0]*numValues[1]);              const int fileofs = numComp*(idx0+(idx1+y)*params.numValues[0]
496              f.seekg(fileofs*sizeof(float));                               +(idx2+z)*params.numValues[0]*params.numValues[1]);
497              f.read((char*)&values[0], num0*numComp*sizeof(float));              f.seekg(fileofs*sizeof(ValueType));
498              for (index_t x=0; x<num0; x++) {              f.read((char*)&values[0], num0*numComp*sizeof(ValueType));
499                  double* dest = out.getSampleDataRW(first0+x+(first1+y)*myN0+(first2+z)*myN0*myN1);  
500                  for (index_t c=0; c<numComp; c++) {              for (int x=0; x<num0; x++) {
501                      for (index_t q=0; q<dpp; q++) {                  const int baseIndex = first0+x*params.multiplier[0]
502                          *dest++ = static_cast<double>(values[x*numComp+c]);                                       +(first1+y*params.multiplier[1])*myN0
503                                         +(first2+z*params.multiplier[2])*myN0*myN1;
504                    for (int m2=0; m2<params.multiplier[2]; m2++) {
505                        for (int m1=0; m1<params.multiplier[1]; m1++) {
506                            for (int m0=0; m0<params.multiplier[0]; m0++) {
507                                const int dataIndex = baseIndex+m0
508                                               +m1*myN0
509                                               +m2*myN0*myN1;
510                                double* dest = out.getSampleDataRW(dataIndex);
511                                for (int c=0; c<numComp; c++) {
512                                    ValueType val = values[x*numComp+c];
513    
514                                    if (params.byteOrder != BYTEORDER_NATIVE) {
515                                        char* cval = reinterpret_cast<char*>(&val);
516                                        // this will alter val!!
517                                        byte_swap32(cval);
518                                    }
519                                    if (!std::isnan(val)) {
520                                        for (int q=0; q<dpp; q++) {
521                                            *dest++ = static_cast<double>(val);
522                                        }
523                                    }
524                                }
525                            }
526                      }                      }
527                  }                  }
528              }              }
# Line 316  void Brick::readBinaryGrid(escript::Data Line 532  void Brick::readBinaryGrid(escript::Data
532      f.close();      f.close();
533  }  }
534    
535    #ifdef USE_BOOSTIO
536    template<typename ValueType>
537    void Brick::readBinaryGridZippedImpl(escript::Data& out, const string& filename,
538                                   const ReaderParameters& params) const
539    {
540        // check destination function space
541        int myN0, myN1, myN2;
542        if (out.getFunctionSpace().getTypeCode() == Nodes) {
543            myN0 = m_NN[0];
544            myN1 = m_NN[1];
545            myN2 = m_NN[2];
546        } else if (out.getFunctionSpace().getTypeCode() == Elements ||
547                    out.getFunctionSpace().getTypeCode() == ReducedElements) {
548            myN0 = m_NE[0];
549            myN1 = m_NE[1];
550            myN2 = m_NE[2];
551        } else
552            throw RipleyException("readBinaryGridFromZipped(): invalid function space for output data object");
553    
554        if (params.first.size() != 3)
555            throw RipleyException("readBinaryGridFromZipped(): argument 'first' must have 3 entries");
556    
557        if (params.numValues.size() != 3)
558            throw RipleyException("readBinaryGridFromZipped(): argument 'numValues' must have 3 entries");
559    
560        if (params.multiplier.size() != 3)
561            throw RipleyException("readBinaryGridFromZipped(): argument 'multiplier' must have 3 entries");
562        for (size_t i=0; i<params.multiplier.size(); i++)
563            if (params.multiplier[i]<1)
564                throw RipleyException("readBinaryGridFromZipped(): all multipliers must be positive");
565    
566        // check file existence and size
567        ifstream f(filename.c_str(), ifstream::binary);
568        if (f.fail()) {
569            throw RipleyException("readBinaryGridFromZipped(): cannot open file");
570        }
571        f.seekg(0, ios::end);
572        const int numComp = out.getDataPointSize();
573        int filesize = f.tellg();
574        f.seekg(0, ios::beg);
575        std::vector<char> compressed(filesize);
576        f.read((char*)&compressed[0], filesize);
577        f.close();
578        std::vector<char> decompressed = unzip(compressed);
579        filesize = decompressed.size();
580        const int reqsize = params.numValues[0]*params.numValues[1]*params.numValues[2]*numComp*sizeof(ValueType);
581        if (filesize < reqsize) {
582            throw RipleyException("readBinaryGridFromZipped(): not enough data in file");
583        }
584    
585        // check if this rank contributes anything
586        if (params.first[0] >= m_offset[0]+myN0 ||
587                params.first[0]+params.numValues[0]*params.multiplier[0] <= m_offset[0] ||
588                params.first[1] >= m_offset[1]+myN1 ||
589                params.first[1]+params.numValues[1]*params.multiplier[1] <= m_offset[1] ||
590                params.first[2] >= m_offset[2]+myN2 ||
591                params.first[2]+params.numValues[2]*params.multiplier[2] <= m_offset[2]) {
592            return;
593        }
594    
595        // now determine how much this rank has to write
596    
597        // first coordinates in data object to write to
598        const int first0 = max(0, params.first[0]-m_offset[0]);
599        const int first1 = max(0, params.first[1]-m_offset[1]);
600        const int first2 = max(0, params.first[2]-m_offset[2]);
601        // indices to first value in file
602        const int idx0 = max(0, m_offset[0]-params.first[0]);
603        const int idx1 = max(0, m_offset[1]-params.first[1]);
604        const int idx2 = max(0, m_offset[2]-params.first[2]);
605        // number of values to read
606        const int num0 = min(params.numValues[0]-idx0, myN0-first0);
607        const int num1 = min(params.numValues[1]-idx1, myN1-first1);
608        const int num2 = min(params.numValues[2]-idx2, myN2-first2);
609    
610        out.requireWrite();
611        vector<ValueType> values(num0*numComp);
612        const int dpp = out.getNumDataPointsPerSample();
613    
614        for (int z=0; z<num2; z++) {
615            for (int y=0; y<num1; y++) {
616                const int fileofs = numComp*(idx0+(idx1+y)*params.numValues[0]
617                                 +(idx2+z)*params.numValues[0]*params.numValues[1]);
618                memcpy((char*)&values[0], (char*)&decompressed[fileofs*sizeof(ValueType)], num0*numComp*sizeof(ValueType));
619                
620                for (int x=0; x<num0; x++) {
621                    const int baseIndex = first0+x*params.multiplier[0]
622                                         +(first1+y*params.multiplier[1])*myN0
623                                         +(first2+z*params.multiplier[2])*myN0*myN1;
624                    for (int m2=0; m2<params.multiplier[2]; m2++) {
625                        for (int m1=0; m1<params.multiplier[1]; m1++) {
626                            for (int m0=0; m0<params.multiplier[0]; m0++) {
627                                const int dataIndex = baseIndex+m0
628                                               +m1*myN0
629                                               +m2*myN0*myN1;
630                                double* dest = out.getSampleDataRW(dataIndex);
631                                for (int c=0; c<numComp; c++) {
632                                    ValueType val = values[x*numComp+c];
633    
634                                    if (params.byteOrder != BYTEORDER_NATIVE) {
635                                        char* cval = reinterpret_cast<char*>(&val);
636                                        // this will alter val!!
637                                        byte_swap32(cval);
638                                    }
639                                    if (!std::isnan(val)) {
640                                        for (int q=0; q<dpp; q++) {
641                                            *dest++ = static_cast<double>(val);
642                                        }
643                                    }
644                                }
645                            }
646                        }
647                    }
648                }
649            }
650        }
651    }
652    #endif
653    
654    void Brick::writeBinaryGrid(const escript::Data& in, string filename,
655                                int byteOrder, int dataType) const
656    {
657        // the mapping is not universally correct but should work on our
658        // supported platforms
659        switch (dataType) {
660            case DATATYPE_INT32:
661                writeBinaryGridImpl<int>(in, filename, byteOrder);
662                break;
663            case DATATYPE_FLOAT32:
664                writeBinaryGridImpl<float>(in, filename, byteOrder);
665                break;
666            case DATATYPE_FLOAT64:
667                writeBinaryGridImpl<double>(in, filename, byteOrder);
668                break;
669            default:
670                throw RipleyException("writeBinaryGrid(): invalid or unsupported datatype");
671        }
672    }
673    
674    template<typename ValueType>
675    void Brick::writeBinaryGridImpl(const escript::Data& in,
676                                    const string& filename, int byteOrder) const
677    {
678        // check function space and determine number of points
679        int myN0, myN1, myN2;
680        int totalN0, totalN1, totalN2;
681        if (in.getFunctionSpace().getTypeCode() == Nodes) {
682            myN0 = m_NN[0];
683            myN1 = m_NN[1];
684            myN2 = m_NN[2];
685            totalN0 = m_gNE[0]+1;
686            totalN1 = m_gNE[1]+1;
687            totalN2 = m_gNE[2]+1;
688        } else if (in.getFunctionSpace().getTypeCode() == Elements ||
689                    in.getFunctionSpace().getTypeCode() == ReducedElements) {
690            myN0 = m_NE[0];
691            myN1 = m_NE[1];
692            myN2 = m_NE[2];
693            totalN0 = m_gNE[0];
694            totalN1 = m_gNE[1];
695            totalN2 = m_gNE[2];
696        } else
697            throw RipleyException("writeBinaryGrid(): invalid function space of data object");
698    
699        const int numComp = in.getDataPointSize();
700        const int dpp = in.getNumDataPointsPerSample();
701        const int fileSize = sizeof(ValueType)*numComp*dpp*totalN0*totalN1*totalN2;
702    
703        if (numComp > 1 || dpp > 1)
704            throw RipleyException("writeBinaryGrid(): only scalar, single-value data supported");
705    
706        // from here on we know that each sample consists of one value
707        FileWriter fw;
708        fw.openFile(filename, fileSize);
709        MPIBarrier();
710    
711        for (index_t z=0; z<myN2; z++) {
712            for (index_t y=0; y<myN1; y++) {
713                const int fileofs = (m_offset[0]+(m_offset[1]+y)*totalN0
714                                    +(m_offset[2]+z)*totalN0*totalN1)*sizeof(ValueType);
715                ostringstream oss;
716    
717                for (index_t x=0; x<myN0; x++) {
718                    const double* sample = in.getSampleDataRO(z*myN0*myN1+y*myN0+x);
719                    ValueType fvalue = static_cast<ValueType>(*sample);
720                    if (byteOrder == BYTEORDER_NATIVE) {
721                        oss.write((char*)&fvalue, sizeof(fvalue));
722                    } else {
723                        char* value = reinterpret_cast<char*>(&fvalue);
724                        oss.write(byte_swap32(value), sizeof(fvalue));
725                    }
726                }
727                fw.writeAt(oss, fileofs);
728            }
729        }
730        fw.close();
731    }
732    
733  void Brick::dump(const string& fileName) const  void Brick::dump(const string& fileName) const
734  {  {
735  #if USE_SILO  #if USE_SILO
# Line 376  void Brick::dump(const string& fileName) Line 790  void Brick::dump(const string& fileName)
790      }      }
791      */      */
792    
793      boost::scoped_ptr<double> x(new double[m_N0]);      boost::scoped_ptr<double> x(new double[m_NN[0]]);
794      boost::scoped_ptr<double> y(new double[m_N1]);      boost::scoped_ptr<double> y(new double[m_NN[1]]);
795      boost::scoped_ptr<double> z(new double[m_N2]);      boost::scoped_ptr<double> z(new double[m_NN[2]]);
796      double* coords[3] = { x.get(), y.get(), z.get() };      double* coords[3] = { x.get(), y.get(), z.get() };
     pair<double,double> xdx = getFirstCoordAndSpacing(0);  
     pair<double,double> ydy = getFirstCoordAndSpacing(1);  
     pair<double,double> zdz = getFirstCoordAndSpacing(2);  
797  #pragma omp parallel  #pragma omp parallel
798      {      {
799  #pragma omp for  #pragma omp for
800          for (dim_t i0 = 0; i0 < m_N0; i0++) {          for (dim_t i0 = 0; i0 < m_NN[0]; i0++) {
801              coords[0][i0]=xdx.first+i0*xdx.second;              coords[0][i0]=getLocalCoordinate(i0, 0);
802          }          }
803  #pragma omp for  #pragma omp for
804          for (dim_t i1 = 0; i1 < m_N1; i1++) {          for (dim_t i1 = 0; i1 < m_NN[1]; i1++) {
805              coords[1][i1]=ydy.first+i1*ydy.second;              coords[1][i1]=getLocalCoordinate(i1, 1);
806          }          }
807  #pragma omp for  #pragma omp for
808          for (dim_t i2 = 0; i2 < m_N2; i2++) {          for (dim_t i2 = 0; i2 < m_NN[2]; i2++) {
809              coords[2][i2]=zdz.first+i2*zdz.second;              coords[2][i2]=getLocalCoordinate(i2, 2);
810          }          }
811      }      }
812      IndexVector dims = getNumNodesPerDim();      int* dims = const_cast<int*>(getNumNodesPerDim());
813      DBPutQuadmesh(dbfile, "mesh", NULL, coords, &dims[0], 3, DB_DOUBLE,  
814        // write mesh
815        DBPutQuadmesh(dbfile, "mesh", NULL, coords, dims, 3, DB_DOUBLE,
816              DB_COLLINEAR, NULL);              DB_COLLINEAR, NULL);
817    
818      DBPutQuadvar1(dbfile, "nodeId", "mesh", (void*)&m_nodeId[0], &dims[0], 3,      // write node ids
819        DBPutQuadvar1(dbfile, "nodeId", "mesh", (void*)&m_nodeId[0], dims, 3,
820              NULL, 0, DB_INT, DB_NODECENT, NULL);              NULL, 0, DB_INT, DB_NODECENT, NULL);
821    
822      // write element ids      // write element ids
823      dims = getNumElementsPerDim();      dims = const_cast<int*>(getNumElementsPerDim());
824      DBPutQuadvar1(dbfile, "elementId", "mesh", (void*)&m_elementId[0],      DBPutQuadvar1(dbfile, "elementId", "mesh", (void*)&m_elementId[0],
825              &dims[0], 3, NULL, 0, DB_INT, DB_ZONECENT, NULL);              dims, 3, NULL, 0, DB_INT, DB_ZONECENT, NULL);
826    
827      // rank 0 writes multimesh and multivar      // rank 0 writes multimesh and multivar
828      if (m_mpiInfo->rank == 0) {      if (m_mpiInfo->rank == 0) {
# Line 476  const int* Brick::borrowSampleReferenceI Line 890  const int* Brick::borrowSampleReferenceI
890          case FaceElements:          case FaceElements:
891          case ReducedFaceElements:          case ReducedFaceElements:
892              return &m_faceId[0];              return &m_faceId[0];
893            case Points:
894                return &m_diracPointNodeIDs[0];
895          default:          default:
896              break;              break;
897      }      }
# Line 501  bool Brick::ownSample(int fsType, index_ Line 917  bool Brick::ownSample(int fsType, index_
917          case ReducedElements:          case ReducedElements:
918              {              {
919                  // check ownership of element's _last_ node                  // check ownership of element's _last_ node
920                  const index_t x=id%m_NE0 + 1;                  const index_t x=id%m_NE[0] + 1;
921                  const index_t y=id%(m_NE0*m_NE1)/m_NE0 + 1;                  const index_t y=id%(m_NE[0]*m_NE[1])/m_NE[0] + 1;
922                  const index_t z=id/(m_NE0*m_NE1) + 1;                  const index_t z=id/(m_NE[0]*m_NE[1]) + 1;
923                  return (m_dofMap[x + m_N0*y +m_N0*m_N1*z] < getNumDOF());                  return (m_dofMap[x + m_NN[0]*y + m_NN[0]*m_NN[1]*z] < getNumDOF());
924              }              }
925          case FaceElements:          case FaceElements:
926          case ReducedFaceElements:          case ReducedFaceElements:
927              {              {
928                  // check ownership of face element's last node                  // check ownership of face element's last node
                 const IndexVector faces = getNumFacesPerBoundary();  
929                  dim_t n=0;                  dim_t n=0;
930                  for (size_t i=0; i<faces.size(); i++) {                  for (size_t i=0; i<6; i++) {
931                      n+=faces[i];                      n+=m_faceCount[i];
932                      if (id<n) {                      if (id<n) {
933                          const index_t j=id-n+faces[i];                          const index_t j=id-n+m_faceCount[i];
934                          if (i>=4) { // front or back                          if (i>=4) { // front or back
935                              const index_t first=(i==4 ? 0 : m_N0*m_N1*(m_N2-1));                              const index_t first=(i==4 ? 0 : m_NN[0]*m_NN[1]*(m_NN[2]-1));
936                              return (m_dofMap[first+j%m_NE0+1+(j/m_NE0+1)*m_N0] < getNumDOF());                              return (m_dofMap[first+j%m_NE[0]+1+(j/m_NE[0]+1)*m_NN[0]] < getNumDOF());
937                          } else if (i>=2) { // bottom or top                          } else if (i>=2) { // bottom or top
938                              const index_t first=(i==2 ? 0 : m_N0*(m_N1-1));                              const index_t first=(i==2 ? 0 : m_NN[0]*(m_NN[1]-1));
939                              return (m_dofMap[first+j%m_NE0+1+(j/m_NE0+1)*m_N0*m_N1] < getNumDOF());                              return (m_dofMap[first+j%m_NE[0]+1+(j/m_NE[0]+1)*m_NN[0]*m_NN[1]] < getNumDOF());
940                          } else { // left or right                          } else { // left or right
941                              const index_t first=(i==0 ? 0 : m_N0-1);                              const index_t first=(i==0 ? 0 : m_NN[0]-1);
942                              return (m_dofMap[first+(j%m_NE1+1)*m_N0+(j/m_NE1+1)*m_N0*m_N1] < getNumDOF());                              return (m_dofMap[first+(j%m_NE[1]+1)*m_NN[0]+(j/m_NE[1]+1)*m_NN[0]*m_NN[1]] < getNumDOF());
943                          }                          }
944                      }                      }
945                  }                  }
# Line 547  void Brick::setToNormal(escript::Data& o Line 962  void Brick::setToNormal(escript::Data& o
962          {          {
963              if (m_faceOffset[0] > -1) {              if (m_faceOffset[0] > -1) {
964  #pragma omp for nowait  #pragma omp for nowait
965                  for (index_t k2 = 0; k2 < m_NE2; ++k2) {                  for (index_t k2 = 0; k2 < m_NE[2]; ++k2) {
966                      for (index_t k1 = 0; k1 < m_NE1; ++k1) {                      for (index_t k1 = 0; k1 < m_NE[1]; ++k1) {
967                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE[1]));
968                          // set vector at four quadrature points                          // set vector at four quadrature points
969                          *o++ = -1.; *o++ = 0.; *o++ = 0.;                          *o++ = -1.; *o++ = 0.; *o++ = 0.;
970                          *o++ = -1.; *o++ = 0.; *o++ = 0.;                          *o++ = -1.; *o++ = 0.; *o++ = 0.;
# Line 561  void Brick::setToNormal(escript::Data& o Line 976  void Brick::setToNormal(escript::Data& o
976    
977              if (m_faceOffset[1] > -1) {              if (m_faceOffset[1] > -1) {
978  #pragma omp for nowait  #pragma omp for nowait
979                  for (index_t k2 = 0; k2 < m_NE2; ++k2) {                  for (index_t k2 = 0; k2 < m_NE[2]; ++k2) {
980                      for (index_t k1 = 0; k1 < m_NE1; ++k1) {                      for (index_t k1 = 0; k1 < m_NE[1]; ++k1) {
981                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE[1]));
982                          // set vector at four quadrature points                          // set vector at four quadrature points
983                          *o++ = 1.; *o++ = 0.; *o++ = 0.;                          *o++ = 1.; *o++ = 0.; *o++ = 0.;
984                          *o++ = 1.; *o++ = 0.; *o++ = 0.;                          *o++ = 1.; *o++ = 0.; *o++ = 0.;
# Line 575  void Brick::setToNormal(escript::Data& o Line 990  void Brick::setToNormal(escript::Data& o
990    
991              if (m_faceOffset[2] > -1) {              if (m_faceOffset[2] > -1) {
992  #pragma omp for nowait  #pragma omp for nowait
993                  for (index_t k2 = 0; k2 < m_NE2; ++k2) {                  for (index_t k2 = 0; k2 < m_NE[2]; ++k2) {
994                      for (index_t k0 = 0; k0 < m_NE0; ++k0) {                      for (index_t k0 = 0; k0 < m_NE[0]; ++k0) {
995                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE[0]));
996                          // set vector at four quadrature points                          // set vector at four quadrature points
997                          *o++ = 0.; *o++ = -1.; *o++ = 0.;                          *o++ = 0.; *o++ = -1.; *o++ = 0.;
998                          *o++ = 0.; *o++ = -1.; *o++ = 0.;                          *o++ = 0.; *o++ = -1.; *o++ = 0.;
# Line 589  void Brick::setToNormal(escript::Data& o Line 1004  void Brick::setToNormal(escript::Data& o
1004    
1005              if (m_faceOffset[3] > -1) {              if (m_faceOffset[3] > -1) {
1006  #pragma omp for nowait  #pragma omp for nowait
1007                  for (index_t k2 = 0; k2 < m_NE2; ++k2) {                  for (index_t k2 = 0; k2 < m_NE[2]; ++k2) {
1008                      for (index_t k0 = 0; k0 < m_NE0; ++k0) {                      for (index_t k0 = 0; k0 < m_NE[0]; ++k0) {
1009                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE[0]));
1010                          // set vector at four quadrature points                          // set vector at four quadrature points
1011                          *o++ = 0.; *o++ = 1.; *o++ = 0.;                          *o++ = 0.; *o++ = 1.; *o++ = 0.;
1012                          *o++ = 0.; *o++ = 1.; *o++ = 0.;                          *o++ = 0.; *o++ = 1.; *o++ = 0.;
# Line 603  void Brick::setToNormal(escript::Data& o Line 1018  void Brick::setToNormal(escript::Data& o
1018    
1019              if (m_faceOffset[4] > -1) {              if (m_faceOffset[4] > -1) {
1020  #pragma omp for nowait  #pragma omp for nowait
1021                  for (index_t k1 = 0; k1 < m_NE1; ++k1) {                  for (index_t k1 = 0; k1 < m_NE[1]; ++k1) {
1022                      for (index_t k0 = 0; k0 < m_NE0; ++k0) {                      for (index_t k0 = 0; k0 < m_NE[0]; ++k0) {
1023                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE[0]));
1024                          // set vector at four quadrature points                          // set vector at four quadrature points
1025                          *o++ = 0.; *o++ = 0.; *o++ = -1.;                          *o++ = 0.; *o++ = 0.; *o++ = -1.;
1026                          *o++ = 0.; *o++ = 0.; *o++ = -1.;                          *o++ = 0.; *o++ = 0.; *o++ = -1.;
# Line 617  void Brick::setToNormal(escript::Data& o Line 1032  void Brick::setToNormal(escript::Data& o
1032    
1033              if (m_faceOffset[5] > -1) {              if (m_faceOffset[5] > -1) {
1034  #pragma omp for nowait  #pragma omp for nowait
1035                  for (index_t k1 = 0; k1 < m_NE1; ++k1) {                  for (index_t k1 = 0; k1 < m_NE[1]; ++k1) {
1036                      for (index_t k0 = 0; k0 < m_NE0; ++k0) {                      for (index_t k0 = 0; k0 < m_NE[0]; ++k0) {
1037                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE[0]));
1038                          // set vector at four quadrature points                          // set vector at four quadrature points
1039                          *o++ = 0.; *o++ = 0.; *o++ = 1.;                          *o++ = 0.; *o++ = 0.; *o++ = 1.;
1040                          *o++ = 0.; *o++ = 0.; *o++ = 1.;                          *o++ = 0.; *o++ = 0.; *o++ = 1.;
# Line 635  void Brick::setToNormal(escript::Data& o Line 1050  void Brick::setToNormal(escript::Data& o
1050          {          {
1051              if (m_faceOffset[0] > -1) {              if (m_faceOffset[0] > -1) {
1052  #pragma omp for nowait  #pragma omp for nowait
1053                  for (index_t k2 = 0; k2 < m_NE2; ++k2) {                  for (index_t k2 = 0; k2 < m_NE[2]; ++k2) {
1054                      for (index_t k1 = 0; k1 < m_NE1; ++k1) {                      for (index_t k1 = 0; k1 < m_NE[1]; ++k1) {
1055                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE[1]));
1056                          *o++ = -1.;                          *o++ = -1.;
1057                          *o++ = 0.;                          *o++ = 0.;
1058                          *o = 0.;                          *o = 0.;
# Line 647  void Brick::setToNormal(escript::Data& o Line 1062  void Brick::setToNormal(escript::Data& o
1062    
1063              if (m_faceOffset[1] > -1) {              if (m_faceOffset[1] > -1) {
1064  #pragma omp for nowait  #pragma omp for nowait
1065                  for (index_t k2 = 0; k2 < m_NE2; ++k2) {                  for (index_t k2 = 0; k2 < m_NE[2]; ++k2) {
1066                      for (index_t k1 = 0; k1 < m_NE1; ++k1) {                      for (index_t k1 = 0; k1 < m_NE[1]; ++k1) {
1067                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE[1]));
1068                          *o++ = 1.;                          *o++ = 1.;
1069                          *o++ = 0.;                          *o++ = 0.;
1070                          *o = 0.;                          *o = 0.;
# Line 659  void Brick::setToNormal(escript::Data& o Line 1074  void Brick::setToNormal(escript::Data& o
1074    
1075              if (m_faceOffset[2] > -1) {              if (m_faceOffset[2] > -1) {
1076  #pragma omp for nowait  #pragma omp for nowait
1077                  for (index_t k2 = 0; k2 < m_NE2; ++k2) {                  for (index_t k2 = 0; k2 < m_NE[2]; ++k2) {
1078                      for (index_t k0 = 0; k0 < m_NE0; ++k0) {                      for (index_t k0 = 0; k0 < m_NE[0]; ++k0) {
1079                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE[0]));
1080                          *o++ = 0.;                          *o++ = 0.;
1081                          *o++ = -1.;                          *o++ = -1.;
1082                          *o = 0.;                          *o = 0.;
# Line 671  void Brick::setToNormal(escript::Data& o Line 1086  void Brick::setToNormal(escript::Data& o
1086    
1087              if (m_faceOffset[3] > -1) {              if (m_faceOffset[3] > -1) {
1088  #pragma omp for nowait  #pragma omp for nowait
1089                  for (index_t k2 = 0; k2 < m_NE2; ++k2) {                  for (index_t k2 = 0; k2 < m_NE[2]; ++k2) {
1090                      for (index_t k0 = 0; k0 < m_NE0; ++k0) {                      for (index_t k0 = 0; k0 < m_NE[0]; ++k0) {
1091                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE[0]));
1092                          *o++ = 0.;                          *o++ = 0.;
1093                          *o++ = 1.;                          *o++ = 1.;
1094                          *o = 0.;                          *o = 0.;
# Line 683  void Brick::setToNormal(escript::Data& o Line 1098  void Brick::setToNormal(escript::Data& o
1098    
1099              if (m_faceOffset[4] > -1) {              if (m_faceOffset[4] > -1) {
1100  #pragma omp for nowait  #pragma omp for nowait
1101                  for (index_t k1 = 0; k1 < m_NE1; ++k1) {                  for (index_t k1 = 0; k1 < m_NE[1]; ++k1) {
1102                      for (index_t k0 = 0; k0 < m_NE0; ++k0) {                      for (index_t k0 = 0; k0 < m_NE[0]; ++k0) {
1103                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE[0]));
1104                          *o++ = 0.;                          *o++ = 0.;
1105                          *o++ = 0.;                          *o++ = 0.;
1106                          *o = -1.;                          *o = -1.;
# Line 695  void Brick::setToNormal(escript::Data& o Line 1110  void Brick::setToNormal(escript::Data& o
1110    
1111              if (m_faceOffset[5] > -1) {              if (m_faceOffset[5] > -1) {
1112  #pragma omp for nowait  #pragma omp for nowait
1113                  for (index_t k1 = 0; k1 < m_NE1; ++k1) {                  for (index_t k1 = 0; k1 < m_NE[1]; ++k1) {
1114                      for (index_t k0 = 0; k0 < m_NE0; ++k0) {                      for (index_t k0 = 0; k0 < m_NE[0]; ++k0) {
1115                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE[0]));
1116                          *o++ = 0.;                          *o++ = 0.;
1117                          *o++ = 0.;                          *o++ = 0.;
1118                          *o = 1.;                          *o = 1.;
# Line 720  void Brick::setToSize(escript::Data& out Line 1135  void Brick::setToSize(escript::Data& out
1135              || out.getFunctionSpace().getTypeCode() == ReducedElements) {              || out.getFunctionSpace().getTypeCode() == ReducedElements) {
1136          out.requireWrite();          out.requireWrite();
1137          const dim_t numQuad=out.getNumDataPointsPerSample();          const dim_t numQuad=out.getNumDataPointsPerSample();
1138          const double xSize=getFirstCoordAndSpacing(0).second;          const double size=sqrt(m_dx[0]*m_dx[0]+m_dx[1]*m_dx[1]+m_dx[2]*m_dx[2]);
         const double ySize=getFirstCoordAndSpacing(1).second;  
         const double zSize=getFirstCoordAndSpacing(2).second;  
         const double size=sqrt(xSize*xSize+ySize*ySize+zSize*zSize);  
1139  #pragma omp parallel for  #pragma omp parallel for
1140          for (index_t k = 0; k < getNumElements(); ++k) {          for (index_t k = 0; k < getNumElements(); ++k) {
1141              double* o = out.getSampleDataRW(k);              double* o = out.getSampleDataRW(k);
# Line 733  void Brick::setToSize(escript::Data& out Line 1145  void Brick::setToSize(escript::Data& out
1145              || out.getFunctionSpace().getTypeCode() == ReducedFaceElements) {              || out.getFunctionSpace().getTypeCode() == ReducedFaceElements) {
1146          out.requireWrite();          out.requireWrite();
1147          const dim_t numQuad=out.getNumDataPointsPerSample();          const dim_t numQuad=out.getNumDataPointsPerSample();
         const double xSize=getFirstCoordAndSpacing(0).second;  
         const double ySize=getFirstCoordAndSpacing(1).second;  
         const double zSize=getFirstCoordAndSpacing(2).second;  
1148  #pragma omp parallel  #pragma omp parallel
1149          {          {
1150              if (m_faceOffset[0] > -1) {              if (m_faceOffset[0] > -1) {
1151                  const double size=min(ySize,zSize);                  const double size=min(m_dx[1],m_dx[2]);
1152  #pragma omp for nowait  #pragma omp for nowait
1153                  for (index_t k2 = 0; k2 < m_NE2; ++k2) {                  for (index_t k2 = 0; k2 < m_NE[2]; ++k2) {
1154                      for (index_t k1 = 0; k1 < m_NE1; ++k1) {                      for (index_t k1 = 0; k1 < m_NE[1]; ++k1) {
1155                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE[1]));
1156                          fill(o, o+numQuad, size);                          fill(o, o+numQuad, size);
1157                      }                      }
1158                  }                  }
1159              }              }
1160    
1161              if (m_faceOffset[1] > -1) {              if (m_faceOffset[1] > -1) {
1162                  const double size=min(ySize,zSize);                  const double size=min(m_dx[1],m_dx[2]);
1163  #pragma omp for nowait  #pragma omp for nowait
1164                  for (index_t k2 = 0; k2 < m_NE2; ++k2) {                  for (index_t k2 = 0; k2 < m_NE[2]; ++k2) {
1165                      for (index_t k1 = 0; k1 < m_NE1; ++k1) {                      for (index_t k1 = 0; k1 < m_NE[1]; ++k1) {
1166                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE[1]));
1167                          fill(o, o+numQuad, size);                          fill(o, o+numQuad, size);
1168                      }                      }
1169                  }                  }
1170              }              }
1171    
1172              if (m_faceOffset[2] > -1) {              if (m_faceOffset[2] > -1) {
1173                  const double size=min(xSize,zSize);                  const double size=min(m_dx[0],m_dx[2]);
1174  #pragma omp for nowait  #pragma omp for nowait
1175                  for (index_t k2 = 0; k2 < m_NE2; ++k2) {                  for (index_t k2 = 0; k2 < m_NE[2]; ++k2) {
1176                      for (index_t k0 = 0; k0 < m_NE0; ++k0) {                      for (index_t k0 = 0; k0 < m_NE[0]; ++k0) {
1177                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE[0]));
1178                          fill(o, o+numQuad, size);                          fill(o, o+numQuad, size);
1179                      }                      }
1180                  }                  }
1181              }              }
1182    
1183              if (m_faceOffset[3] > -1) {              if (m_faceOffset[3] > -1) {
1184                  const double size=min(xSize,zSize);                  const double size=min(m_dx[0],m_dx[2]);
1185  #pragma omp for nowait  #pragma omp for nowait
1186                  for (index_t k2 = 0; k2 < m_NE2; ++k2) {                  for (index_t k2 = 0; k2 < m_NE[2]; ++k2) {
1187                      for (index_t k0 = 0; k0 < m_NE0; ++k0) {                      for (index_t k0 = 0; k0 < m_NE[0]; ++k0) {
1188                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE[0]));
1189                          fill(o, o+numQuad, size);                          fill(o, o+numQuad, size);
1190                      }                      }
1191                  }                  }
1192              }              }
1193    
1194              if (m_faceOffset[4] > -1) {              if (m_faceOffset[4] > -1) {
1195                  const double size=min(xSize,ySize);                  const double size=min(m_dx[0],m_dx[1]);
1196  #pragma omp for nowait  #pragma omp for nowait
1197                  for (index_t k1 = 0; k1 < m_NE1; ++k1) {                  for (index_t k1 = 0; k1 < m_NE[1]; ++k1) {
1198                      for (index_t k0 = 0; k0 < m_NE0; ++k0) {                      for (index_t k0 = 0; k0 < m_NE[0]; ++k0) {
1199                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE[0]));
1200                          fill(o, o+numQuad, size);                          fill(o, o+numQuad, size);
1201                      }                      }
1202                  }                  }
1203              }              }
1204    
1205              if (m_faceOffset[5] > -1) {              if (m_faceOffset[5] > -1) {
1206                  const double size=min(xSize,ySize);                  const double size=min(m_dx[0],m_dx[1]);
1207  #pragma omp for nowait  #pragma omp for nowait
1208                  for (index_t k1 = 0; k1 < m_NE1; ++k1) {                  for (index_t k1 = 0; k1 < m_NE[1]; ++k1) {
1209                      for (index_t k0 = 0; k0 < m_NE0; ++k0) {                      for (index_t k0 = 0; k0 < m_NE[0]; ++k0) {
1210                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE[0]));
1211                          fill(o, o+numQuad, size);                          fill(o, o+numQuad, size);
1212                      }                      }
1213                  }                  }
# Line 813  void Brick::setToSize(escript::Data& out Line 1222  void Brick::setToSize(escript::Data& out
1222      }      }
1223  }  }
1224    
 Paso_SystemMatrixPattern* Brick::getPattern(bool reducedRowOrder,  
                                             bool reducedColOrder) const  
 {  
     /* FIXME: reduced  
     if (reducedRowOrder || reducedColOrder)  
         throw RipleyException("getPattern() not implemented for reduced order");  
     */  
     return m_pattern;  
 }  
   
1225  void Brick::Print_Mesh_Info(const bool full) const  void Brick::Print_Mesh_Info(const bool full) const
1226  {  {
1227      RipleyDomain::Print_Mesh_Info(full);      RipleyDomain::Print_Mesh_Info(full);
# Line 830  void Brick::Print_Mesh_Info(const bool f Line 1229  void Brick::Print_Mesh_Info(const bool f
1229          cout << "     Id  Coordinates" << endl;          cout << "     Id  Coordinates" << endl;
1230          cout.precision(15);          cout.precision(15);
1231          cout.setf(ios::scientific, ios::floatfield);          cout.setf(ios::scientific, ios::floatfield);
         pair<double,double> xdx = getFirstCoordAndSpacing(0);  
         pair<double,double> ydy = getFirstCoordAndSpacing(1);  
         pair<double,double> zdz = getFirstCoordAndSpacing(2);  
1232          for (index_t i=0; i < getNumNodes(); i++) {          for (index_t i=0; i < getNumNodes(); i++) {
1233              cout << "  " << setw(5) << m_nodeId[i]              cout << "  " << setw(5) << m_nodeId[i]
1234                  << "  " << xdx.first+(i%m_N0)*xdx.second                  << "  " << getLocalCoordinate(i%m_NN[0], 0)
1235                  << "  " << ydy.first+(i%(m_N0*m_N1)/m_N0)*ydy.second                  << "  " << getLocalCoordinate(i%(m_NN[0]*m_NN[1])/m_NN[0], 1)
1236                  << "  " << zdz.first+(i/(m_N0*m_N1))*zdz.second << endl;                  << "  " << getLocalCoordinate(i/(m_NN[0]*m_NN[1]), 2) << endl;
1237          }          }
1238      }      }
1239  }  }
1240    
 IndexVector Brick::getNumNodesPerDim() const  
 {  
     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;  
 }  
   
 IndexVector Brick::getNumSubdivisionsPerDim() const  
 {  
     IndexVector ret;  
     ret.push_back(m_NX);  
     ret.push_back(m_NY);  
     ret.push_back(m_NZ);  
     return ret;  
 }  
   
 pair<double,double> Brick::getFirstCoordAndSpacing(dim_t dim) const  
 {  
     if (dim==0)  
         return pair<double,double>(m_x0+(m_l0*m_offset0)/m_gNE0, m_l0/m_gNE0);  
     else if (dim==1)  
         return pair<double,double>(m_y0+(m_l1*m_offset1)/m_gNE1, m_l1/m_gNE1);  
     else if (dim==2)  
         return pair<double,double>(m_z0+(m_l2*m_offset2)/m_gNE2, m_l2/m_gNE2);  
   
     throw RipleyException("getFirstCoordAndSpacing: invalid argument");  
 }  
   
 //protected  
 dim_t Brick::getNumDOF() const  
 {  
     return (m_gNE0+1)/m_NX*(m_gNE1+1)/m_NY*(m_gNE2+1)/m_NZ;  
 }  
   
 //protected  
 dim_t Brick::getNumFaceElements() const  
 {  
     const IndexVector faces = getNumFacesPerBoundary();  
     dim_t n=0;  
     for (size_t i=0; i<faces.size(); i++)  
         n+=faces[i];  
     return n;  
 }  
1241    
1242  //protected  //protected
1243  void Brick::assembleCoordinates(escript::Data& arg) const  void Brick::assembleCoordinates(escript::Data& arg) const
# Line 931  void Brick::assembleCoordinates(escript: Line 1249  void Brick::assembleCoordinates(escript:
1249      if (!numSamplesEqual(&x, 1, getNumNodes()))      if (!numSamplesEqual(&x, 1, getNumNodes()))
1250          throw RipleyException("setToX: Illegal number of samples in Data object");          throw RipleyException("setToX: Illegal number of samples in Data object");
1251    
     pair<double,double> xdx = getFirstCoordAndSpacing(0);  
     pair<double,double> ydy = getFirstCoordAndSpacing(1);  
     pair<double,double> zdz = getFirstCoordAndSpacing(2);  
1252      arg.requireWrite();      arg.requireWrite();
1253  #pragma omp parallel for  #pragma omp parallel for
1254      for (dim_t i2 = 0; i2 < m_N2; i2++) {      for (dim_t i2 = 0; i2 < m_NN[2]; i2++) {
1255          for (dim_t i1 = 0; i1 < m_N1; i1++) {          for (dim_t i1 = 0; i1 < m_NN[1]; i1++) {
1256              for (dim_t i0 = 0; i0 < m_N0; i0++) {              for (dim_t i0 = 0; i0 < m_NN[0]; i0++) {
1257                  double* point = arg.getSampleDataRW(i0+m_N0*i1+m_N0*m_N1*i2);                  double* point = arg.getSampleDataRW(i0+m_NN[0]*i1+m_NN[0]*m_NN[1]*i2);
1258                  point[0] = xdx.first+i0*xdx.second;                  point[0] = getLocalCoordinate(i0, 0);
1259                  point[1] = ydy.first+i1*ydy.second;                  point[1] = getLocalCoordinate(i1, 1);
1260                  point[2] = zdz.first+i2*zdz.second;                  point[2] = getLocalCoordinate(i2, 2);
1261              }              }
1262          }          }
1263      }      }
1264  }  }
1265    
1266  //protected  //protected
1267  void Brick::assembleGradient(escript::Data& out, escript::Data& in) const  void Brick::assembleGradient(escript::Data& out, const escript::Data& in) const
1268  {  {
1269      const dim_t numComp = in.getDataPointSize();      const dim_t numComp = in.getDataPointSize();
     const double h0 = m_l0/m_gNE0;  
     const double h1 = m_l1/m_gNE1;  
     const double h2 = m_l2/m_gNE2;  
1270      const double C0 = .044658198738520451079;      const double C0 = .044658198738520451079;
1271      const double C1 = .16666666666666666667;      const double C1 = .16666666666666666667;
1272      const double C2 = .21132486540518711775;      const double C2 = .21132486540518711775;
# Line 976  void Brick::assembleGradient(escript::Da Line 1288  void Brick::assembleGradient(escript::Da
1288              vector<double> f_110(numComp);              vector<double> f_110(numComp);
1289              vector<double> f_111(numComp);              vector<double> f_111(numComp);
1290  #pragma omp for  #pragma omp for
1291              for (index_t k2=0; k2 < m_NE2; ++k2) {              for (index_t k2=0; k2 < m_NE[2]; ++k2) {
1292                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1=0; k1 < m_NE[1]; ++k1) {
1293                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE[0]; ++k0) {
1294                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1295                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1296                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1297                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1298                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1299                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1300                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1301                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1302                          double* o = out.getSampleDataRW(INDEX3(k0,k1,k2,m_NE0,m_NE1));                          double* o = out.getSampleDataRW(INDEX3(k0,k1,k2,m_NE[0],m_NE[1]));
1303                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1304                              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;                              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) / m_dx[0];
1305                              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;                              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) / m_dx[0];
1306                              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;                              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) / m_dx[0];
1307                              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;                              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) / m_dx[0];
1308                              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;                              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) / m_dx[1];
1309                              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;                              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) / m_dx[1];
1310                              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;                              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) / m_dx[1];
1311                              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;                              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) / m_dx[1];
1312                              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;                              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) / m_dx[2];
1313                              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;                              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) / m_dx[2];
1314                              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 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) / m_dx[2];
1315                              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 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) / m_dx[2];
1316                              o[INDEX3(i,0,0,numComp,3)] = V0;                              o[INDEX3(i,0,0,numComp,3)] = V0;
1317                              o[INDEX3(i,1,0,numComp,3)] = V4;                              o[INDEX3(i,1,0,numComp,3)] = V4;
1318                              o[INDEX3(i,2,0,numComp,3)] = V8;                              o[INDEX3(i,2,0,numComp,3)] = V8;
# Line 1043  void Brick::assembleGradient(escript::Da Line 1355  void Brick::assembleGradient(escript::Da
1355              vector<double> f_110(numComp);              vector<double> f_110(numComp);
1356              vector<double> f_111(numComp);              vector<double> f_111(numComp);
1357  #pragma omp for  #pragma omp for
1358              for (index_t k2=0; k2 < m_NE2; ++k2) {              for (index_t k2=0; k2 < m_NE[2]; ++k2) {
1359                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1=0; k1 < m_NE[1]; ++k1) {
1360                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE[0]; ++k0) {
1361                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1362                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1363                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1364                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1365                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1366                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1367                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1368                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1369                          double* o = out.getSampleDataRW(INDEX3(k0,k1,k2,m_NE0,m_NE1));                          double* o = out.getSampleDataRW(INDEX3(k0,k1,k2,m_NE[0],m_NE[1]));
1370                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1371                              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 / m_dx[0];
1372                              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 / m_dx[1];
1373                              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 / m_dx[2];
1374                          } // end of component loop i                          } // end of component loop i
1375                      } // end of k0 loop                      } // end of k0 loop
1376                  } // end of k1 loop                  } // end of k1 loop
# Line 1078  void Brick::assembleGradient(escript::Da Line 1390  void Brick::assembleGradient(escript::Da
1390              vector<double> f_111(numComp);              vector<double> f_111(numComp);
1391              if (m_faceOffset[0] > -1) {              if (m_faceOffset[0] > -1) {
1392  #pragma omp for nowait  #pragma omp for nowait
1393                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE[2]; ++k2) {
1394                      for (index_t k1=0; k1 < m_NE1; ++k1) {                      for (index_t k1=0; k1 < m_NE[1]; ++k1) {
1395                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(0,k1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(0,k1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1396                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(0,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(0,k1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1397                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(0,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(0,k1+1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1398                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(0,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(0,k1+1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1399                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(1,k1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(1,k1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1400                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(1,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(1,k1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1401                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(1,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(1,k1+1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1402                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(1,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(1,k1+1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1403                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE[1]));
1404                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1405                              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) / m_dx[1];
1406                              const double V1=((f_010[i]-f_000[i])*C2 + (f_011[i]-f_001[i])*C6) / h1;                              const double V1=((f_010[i]-f_000[i])*C2 + (f_011[i]-f_001[i])*C6) / m_dx[1];
1407                              const double V2=((f_001[i]-f_000[i])*C6 + (f_010[i]-f_011[i])*C2) / h2;                              const double V2=((f_001[i]-f_000[i])*C6 + (f_010[i]-f_011[i])*C2) / m_dx[2];
1408                              const double V3=((f_001[i]-f_000[i])*C2 + (f_011[i]-f_010[i])*C6) / h2;                              const double V3=((f_001[i]-f_000[i])*C2 + (f_011[i]-f_010[i])*C6) / m_dx[2];
1409                              o[INDEX3(i,0,0,numComp,3)] = ((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;                              o[INDEX3(i,0,0,numComp,3)] = ((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) / m_dx[0];
1410                              o[INDEX3(i,1,0,numComp,3)] = V0;                              o[INDEX3(i,1,0,numComp,3)] = V0;
1411                              o[INDEX3(i,2,0,numComp,3)] = V2;                              o[INDEX3(i,2,0,numComp,3)] = V2;
1412                              o[INDEX3(i,0,1,numComp,3)] = ((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;                              o[INDEX3(i,0,1,numComp,3)] = ((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) / m_dx[0];
1413                              o[INDEX3(i,1,1,numComp,3)] = V0;                              o[INDEX3(i,1,1,numComp,3)] = V0;
1414                              o[INDEX3(i,2,1,numComp,3)] = V3;                              o[INDEX3(i,2,1,numComp,3)] = V3;
1415                              o[INDEX3(i,0,2,numComp,3)] = ((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;                              o[INDEX3(i,0,2,numComp,3)] = ((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) / m_dx[0];
1416                              o[INDEX3(i,1,2,numComp,3)] = V1;                              o[INDEX3(i,1,2,numComp,3)] = V1;
1417                              o[INDEX3(i,2,2,numComp,3)] = V2;                              o[INDEX3(i,2,2,numComp,3)] = V2;
1418                              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) / m_dx[0];
1419                              o[INDEX3(i,1,3,numComp,3)] = V1;                              o[INDEX3(i,1,3,numComp,3)] = V1;
1420                              o[INDEX3(i,2,3,numComp,3)] = V3;                              o[INDEX3(i,2,3,numComp,3)] = V3;
1421                          } // end of component loop i                          } // end of component loop i
# Line 1112  void Brick::assembleGradient(escript::Da Line 1424  void Brick::assembleGradient(escript::Da
1424              } // end of face 0              } // end of face 0
1425              if (m_faceOffset[1] > -1) {              if (m_faceOffset[1] > -1) {
1426  #pragma omp for nowait  #pragma omp for nowait
1427                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE[2]; ++k2) {
1428                      for (index_t k1=0; k1 < m_NE1; ++k1) {                      for (index_t k1=0; k1 < m_NE[1]; ++k1) {
1429                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(m_N0-2,k1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(m_NN[0]-2,k1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1430                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(m_N0-2,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(m_NN[0]-2,k1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1431                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(m_N0-2,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(m_NN[0]-2,k1+1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1432                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(m_N0-2,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(m_NN[0]-2,k1+1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1433                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(m_N0-1,k1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(m_NN[0]-1,k1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1434                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(m_N0-1,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(m_NN[0]-1,k1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1435                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(m_N0-1,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(m_NN[0]-1,k1+1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1436                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(m_N0-1,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(m_NN[0]-1,k1+1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1437                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE[1]));
1438                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1439                              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) / m_dx[1];
1440                              const double V1=((f_110[i]-f_100[i])*C2 + (f_111[i]-f_101[i])*C6) / h1;                              const double V1=((f_110[i]-f_100[i])*C2 + (f_111[i]-f_101[i])*C6) / m_dx[1];
1441                              const double V2=((f_101[i]-f_100[i])*C6 + (f_111[i]-f_110[i])*C2) / h2;                              const double V2=((f_101[i]-f_100[i])*C6 + (f_111[i]-f_110[i])*C2) / m_dx[2];
1442                              const double V3=((f_101[i]-f_100[i])*C2 + (f_111[i]-f_110[i])*C6) / h2;                              const double V3=((f_101[i]-f_100[i])*C2 + (f_111[i]-f_110[i])*C6) / m_dx[2];
1443                              o[INDEX3(i,0,0,numComp,3)] = ((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;                              o[INDEX3(i,0,0,numComp,3)] = ((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) / m_dx[0];
1444                              o[INDEX3(i,1,0,numComp,3)] = V0;                              o[INDEX3(i,1,0,numComp,3)] = V0;
1445                              o[INDEX3(i,2,0,numComp,3)] = V2;                              o[INDEX3(i,2,0,numComp,3)] = V2;
1446                              o[INDEX3(i,0,1,numComp,3)] = ((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;                              o[INDEX3(i,0,1,numComp,3)] = ((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) / m_dx[0];
1447                              o[INDEX3(i,1,1,numComp,3)] = V0;                              o[INDEX3(i,1,1,numComp,3)] = V0;
1448                              o[INDEX3(i,2,1,numComp,3)] = V3;                              o[INDEX3(i,2,1,numComp,3)] = V3;
1449                              o[INDEX3(i,0,2,numComp,3)] = ((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;                              o[INDEX3(i,0,2,numComp,3)] = ((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) / m_dx[0];
1450                              o[INDEX3(i,1,2,numComp,3)] = V1;                              o[INDEX3(i,1,2,numComp,3)] = V1;
1451                              o[INDEX3(i,2,2,numComp,3)] = V2;                              o[INDEX3(i,2,2,numComp,3)] = V2;
1452                              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) / m_dx[0];
1453                              o[INDEX3(i,1,3,numComp,3)] = V1;                              o[INDEX3(i,1,3,numComp,3)] = V1;
1454                              o[INDEX3(i,2,3,numComp,3)] = V3;                              o[INDEX3(i,2,3,numComp,3)] = V3;
1455                          } // end of component loop i                          } // end of component loop i
# Line 1146  void Brick::assembleGradient(escript::Da Line 1458  void Brick::assembleGradient(escript::Da
1458              } // end of face 1              } // end of face 1
1459              if (m_faceOffset[2] > -1) {              if (m_faceOffset[2] > -1) {
1460  #pragma omp for nowait  #pragma omp for nowait
1461                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE[2]; ++k2) {
1462                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE[0]; ++k0) {
1463                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,0,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,0,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1464                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,0,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,0,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1465                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1466                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1467                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,0,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,0,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1468                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,0,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,0,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1469                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1470                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1471                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE[0]));
1472                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1473                              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) / m_dx[0];
1474                              const double V1=((f_001[i]-f_000[i])*C6 + (f_101[i]-f_100[i])*C2) / h2;                              const double V1=((f_001[i]-f_000[i])*C6 + (f_101[i]-f_100[i])*C2) / m_dx[2];
1475                              const double V2=((f_001[i]-f_000[i])*C2 + (f_101[i]-f_100[i])*C6) / h2;                              const double V2=((f_001[i]-f_000[i])*C2 + (f_101[i]-f_100[i])*C6) / m_dx[2];
1476                              o[INDEX3(i,0,0,numComp,3)] = V0;                              o[INDEX3(i,0,0,numComp,3)] = V0;
1477                              o[INDEX3(i,1,0,numComp,3)] = ((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;                              o[INDEX3(i,1,0,numComp,3)] = ((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) / m_dx[1];
1478                              o[INDEX3(i,2,0,numComp,3)] = V1;                              o[INDEX3(i,2,0,numComp,3)] = V1;
1479                              o[INDEX3(i,0,1,numComp,3)] = V0;                              o[INDEX3(i,0,1,numComp,3)] = V0;
1480                              o[INDEX3(i,1,1,numComp,3)] = ((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;                              o[INDEX3(i,1,1,numComp,3)] = ((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) / m_dx[1];
1481                              o[INDEX3(i,2,1,numComp,3)] = V2;                              o[INDEX3(i,2,1,numComp,3)] = V2;
1482                              o[INDEX3(i,0,2,numComp,3)] = V0;                              o[INDEX3(i,0,2,numComp,3)] = V0;
1483                              o[INDEX3(i,1,2,numComp,3)] = ((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;                              o[INDEX3(i,1,2,numComp,3)] = ((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) / m_dx[1];
1484                              o[INDEX3(i,2,2,numComp,3)] = V1;                              o[INDEX3(i,2,2,numComp,3)] = V1;
1485                              o[INDEX3(i,0,3,numComp,3)] = V0;                              o[INDEX3(i,0,3,numComp,3)] = V0;
1486                              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) / m_dx[1];
1487                              o[INDEX3(i,2,3,numComp,3)] = V2;                              o[INDEX3(i,2,3,numComp,3)] = V2;
1488                          } // end of component loop i                          } // end of component loop i
1489                      } // end of k0 loop                      } // end of k0 loop
# Line 1179  void Brick::assembleGradient(escript::Da Line 1491  void Brick::assembleGradient(escript::Da
1491              } // end of face 2              } // end of face 2
1492              if (m_faceOffset[3] > -1) {              if (m_faceOffset[3] > -1) {
1493  #pragma omp for nowait  #pragma omp for nowait
1494                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE[2]; ++k2) {
1495                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE[0]; ++k0) {
1496                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,m_N1-2,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,m_NN[1]-2,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1497                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,m_N1-2,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,m_NN[1]-2,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1498                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,m_N1-1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,m_NN[1]-1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1499                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,m_N1-1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,m_NN[1]-1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1500                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-2,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,m_NN[1]-2,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1501                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-2,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,m_NN[1]-2,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1502                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,m_NN[1]-1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1503                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,m_NN[1]-1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1504                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE[0]));
1505                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1506                              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) / m_dx[0];
1507                              const double V1=((f_110[i]-f_010[i])*C2 + (f_111[i]-f_011[i])*C6) / h0;                              const double V1=((f_110[i]-f_010[i])*C2 + (f_111[i]-f_011[i])*C6) / m_dx[0];
1508                              const double V2=((f_011[i]-f_010[i])*C6 + (f_111[i]-f_110[i])*C2) / h2;                              const double V2=((f_011[i]-f_010[i])*C6 + (f_111[i]-f_110[i])*C2) / m_dx[2];
1509                              const double V3=((f_011[i]-f_010[i])*C2 + (f_111[i]-f_110[i])*C6) / h2;                              const double V3=((f_011[i]-f_010[i])*C2 + (f_111[i]-f_110[i])*C6) / m_dx[2];
1510                              o[INDEX3(i,0,0,numComp,3)] = V0;                              o[INDEX3(i,0,0,numComp,3)] = V0;
1511                              o[INDEX3(i,1,0,numComp,3)] = ((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;                              o[INDEX3(i,1,0,numComp,3)] = ((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) / m_dx[1];
1512                              o[INDEX3(i,2,0,numComp,3)] = V2;                              o[INDEX3(i,2,0,numComp,3)] = V2;
1513                              o[INDEX3(i,0,1,numComp,3)] = V0;                              o[INDEX3(i,0,1,numComp,3)] = V0;
1514                              o[INDEX3(i,1,1,numComp,3)] = ((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;                              o[INDEX3(i,1,1,numComp,3)] = ((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) / m_dx[1];
1515                              o[INDEX3(i,2,1,numComp,3)] = V3;                              o[INDEX3(i,2,1,numComp,3)] = V3;
1516                              o[INDEX3(i,0,2,numComp,3)] = V1;                              o[INDEX3(i,0,2,numComp,3)] = V1;
1517                              o[INDEX3(i,1,2,numComp,3)] = ((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;                              o[INDEX3(i,1,2,numComp,3)] = ((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) / m_dx[1];
1518                              o[INDEX3(i,2,2,numComp,3)] = V2;                              o[INDEX3(i,2,2,numComp,3)] = V2;
1519                              o[INDEX3(i,0,3,numComp,3)] = V1;                              o[INDEX3(i,0,3,numComp,3)] = V1;
1520                              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) / m_dx[1];
1521                              o[INDEX3(i,2,3,numComp,3)] = V3;                              o[INDEX3(i,2,3,numComp,3)] = V3;
1522                          } // end of component loop i                          } // end of component loop i
1523                      } // end of k0 loop                      } // end of k0 loop
# Line 1213  void Brick::assembleGradient(escript::Da Line 1525  void Brick::assembleGradient(escript::Da
1525              } // end of face 3              } // end of face 3
1526              if (m_faceOffset[4] > -1) {              if (m_faceOffset[4] > -1) {
1527  #pragma omp for nowait  #pragma omp for nowait
1528                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1=0; k1 < m_NE[1]; ++k1) {
1529                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE[0]; ++k0) {
1530                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,0, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,0, m_NN[0],m_NN[1])), numComp*sizeof(double));
1531                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1532                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,0, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,0, m_NN[0],m_NN[1])), numComp*sizeof(double));
1533                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1534                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,0, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,0, m_NN[0],m_NN[1])), numComp*sizeof(double));
1535                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1536                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,0, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,0, m_NN[0],m_NN[1])), numComp*sizeof(double));
1537                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1538                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE[0]));
1539                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1540                              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) / m_dx[0];
1541                              const double V1=((f_100[i]-f_000[i])*C2 + (f_110[i]-f_010[i])*C6) / h0;                              const double V1=((f_100[i]-f_000[i])*C2 + (f_110[i]-f_010[i])*C6) / m_dx[0];
1542                              const double V2=((f_010[i]-f_000[i])*C6 + (f_110[i]-f_100[i])*C2) / h1;                              const double V2=((f_010[i]-f_000[i])*C6 + (f_110[i]-f_100[i])*C2) / m_dx[1];
1543                              const double V3=((f_010[i]-f_000[i])*C2 + (f_110[i]-f_100[i])*C6) / h1;                              const double V3=((f_010[i]-f_000[i])*C2 + (f_110[i]-f_100[i])*C6) / m_dx[1];
1544                              o[INDEX3(i,0,0,numComp,3)] = V0;                              o[INDEX3(i,0,0,numComp,3)] = V0;
1545                              o[INDEX3(i,1,0,numComp,3)] = V2;                              o[INDEX3(i,1,0,numComp,3)] = V2;
1546                              o[INDEX3(i,2,0,numComp,3)] = ((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;                              o[INDEX3(i,2,0,numComp,3)] = ((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) / m_dx[2];
1547                              o[INDEX3(i,0,1,numComp,3)] = V0;                              o[INDEX3(i,0,1,numComp,3)] = V0;
1548                              o[INDEX3(i,1,1,numComp,3)] = V3;                              o[INDEX3(i,1,1,numComp,3)] = V3;
1549                              o[INDEX3(i,2,1,numComp,3)] = ((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;                              o[INDEX3(i,2,1,numComp,3)] = ((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) / m_dx[2];
1550                              o[INDEX3(i,0,2,numComp,3)] = V1;                              o[INDEX3(i,0,2,numComp,3)] = V1;
1551                              o[INDEX3(i,1,2,numComp,3)] = V2;                              o[INDEX3(i,1,2,numComp,3)] = V2;
1552                              o[INDEX3(i,2,2,numComp,3)] = ((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;                              o[INDEX3(i,2,2,numComp,3)] = ((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) / m_dx[2];
1553                              o[INDEX3(i,0,3,numComp,3)] = V1;                              o[INDEX3(i,0,3,numComp,3)] = V1;
1554                              o[INDEX3(i,1,3,numComp,3)] = V3;                              o[INDEX3(i,1,3,numComp,3)] = V3;
1555                              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) / m_dx[2];
1556                          } // end of component loop i                          } // end of component loop i
1557                      } // end of k0 loop                      } // end of k0 loop
1558                  } // end of k1 loop                  } // end of k1 loop
1559              } // end of face 4              } // end of face 4
1560              if (m_faceOffset[5] > -1) {              if (m_faceOffset[5] > -1) {
1561  #pragma omp for nowait  #pragma omp for nowait
1562                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1=0; k1 < m_NE[1]; ++k1) {
1563                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE[0]; ++k0) {
1564                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,m_N2-2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,m_NN[2]-2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1565                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,m_NN[2]-1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1566                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,m_N2-2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,m_NN[2]-2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1567                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,m_NN[2]-1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1568                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,m_N2-2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,m_NN[2]-2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1569                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,m_NN[2]-1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1570                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,m_N2-2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,m_NN[2]-2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1571                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,m_NN[2]-1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1572                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE[0]));
1573                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1574                              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) / m_dx[0];
1575                              const double V1=((f_101[i]-f_001[i])*C2 + (f_111[i]-f_011[i])*C6) / h0;                              const double V1=((f_101[i]-f_001[i])*C2 + (f_111[i]-f_011[i])*C6) / m_dx[0];
1576                              const double V2=((f_011[i]-f_001[i])*C6 + (f_111[i]-f_101[i])*C2) / h1;                              const double V2=((f_011[i]-f_001[i])*C6 + (f_111[i]-f_101[i])*C2) / m_dx[1];
1577                              const double V3=((f_011[i]-f_001[i])*C2 + (f_111[i]-f_101[i])*C6) / h1;                              const double V3=((f_011[i]-f_001[i])*C2 + (f_111[i]-f_101[i])*C6) / m_dx[1];
1578                              o[INDEX3(i,0,0,numComp,3)] = V0;                              o[INDEX3(i,0,0,numComp,3)] = V0;
1579                              o[INDEX3(i,1,0,numComp,3)] = V2;                              o[INDEX3(i,1,0,numComp,3)] = V2;
1580                              o[INDEX3(i,2,0,numComp,3)] = ((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;                              o[INDEX3(i,2,0,numComp,3)] = ((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) / m_dx[2];
1581                              o[INDEX3(i,0,1,numComp,3)] = V0;                              o[INDEX3(i,0,1,numComp,3)] = V0;
1582                              o[INDEX3(i,1,1,numComp,3)] = V3;                              o[INDEX3(i,1,1,numComp,3)] = V3;
1583                              o[INDEX3(i,2,1,numComp,3)] = ((f_011[i]-f_010[i])*C0 + (f_101[i]-f_100[i])*C5 + (f_001[i]+f_111[i]-f_000[i]-f_110[i])*C1) / h2;                              o[INDEX3(i,2,1,numComp,3)] = ((f_011[i]-f_010[i])*C0 + (f_101[i]-f_100[i])*C5 + (f_001[i]+f_111[i]-f_000[i]-f_110[i])*C1) / m_dx[2];
1584                              o[INDEX3(i,0,2,numComp,3)] = V1;                              o[INDEX3(i,0,2,numComp,3)] = V1;
1585                              o[INDEX3(i,1,2,numComp,3)] = V2;                              o[INDEX3(i,1,2,numComp,3)] = V2;
1586                              o[INDEX3(i,2,2,numComp,3)] = ((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;                              o[INDEX3(i,2,2,numComp,3)] = ((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) / m_dx[2];
1587                              o[INDEX3(i,0,3,numComp,3)] = V1;                              o[INDEX3(i,0,3,numComp,3)] = V1;
1588                              o[INDEX3(i,1,3,numComp,3)] = V3;                              o[INDEX3(i,1,3,numComp,3)] = V3;
1589                              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) / m_dx[2];
1590                          } // end of component loop i                          } // end of component loop i
1591                      } // end of k0 loop                      } // end of k0 loop
1592                  } // end of k1 loop                  } // end of k1 loop
# Line 1294  void Brick::assembleGradient(escript::Da Line 1606  void Brick::assembleGradient(escript::Da
1606              vector<double> f_111(numComp);              vector<double> f_111(numComp);
1607              if (m_faceOffset[0] > -1) {              if (m_faceOffset[0] > -1) {
1608  #pragma omp for nowait  #pragma omp for nowait
1609                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE[2]; ++k2) {
1610                      for (index_t k1=0; k1 < m_NE1; ++k1) {                      for (index_t k1=0; k1 < m_NE[1]; ++k1) {
1611                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(0,k1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(0,k1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1612                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(0,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(0,k1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1613                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(0,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(0,k1+1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1614                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(0,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(0,k1+1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1615                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(1,k1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(1,k1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1616                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(1,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(1,k1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1617                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(1,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(1,k1+1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1618                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(1,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(1,k1+1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1619                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE[1]));
1620                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1621                              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 / m_dx[0];
1622                              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 / m_dx[1];
1623                              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 / m_dx[2];
1624                          } // end of component loop i                          } // end of component loop i
1625                      } // end of k1 loop                      } // end of k1 loop
1626                  } // end of k2 loop                  } // end of k2 loop
1627              } // end of face 0              } // end of face 0
1628              if (m_faceOffset[1] > -1) {              if (m_faceOffset[1] > -1) {
1629  #pragma omp for nowait  #pragma omp for nowait
1630                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE[2]; ++k2) {
1631                      for (index_t k1=0; k1 < m_NE1; ++k1) {                      for (index_t k1=0; k1 < m_NE[1]; ++k1) {
1632                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(m_N0-2,k1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(m_NN[0]-2,k1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1633                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(m_N0-2,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(m_NN[0]-2,k1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1634                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(m_N0-2,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(m_NN[0]-2,k1+1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1635                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(m_N0-2,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(m_NN[0]-2,k1+1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1636                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(m_N0-1,k1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(m_NN[0]-1,k1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1637                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(m_N0-1,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(m_NN[0]-1,k1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1638                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(m_N0-1,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(m_NN[0]-1,k1+1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1639                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(m_N0-1,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(m_NN[0]-1,k1+1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1640                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE[1]));
1641                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1642                              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 / m_dx[0];
1643                              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 / m_dx[1];
1644                              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 / m_dx[2];
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              } // end of face 1              } // end of face 1
1649              if (m_faceOffset[2] > -1) {              if (m_faceOffset[2] > -1) {
1650  #pragma omp for nowait  #pragma omp for nowait
1651                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE[2]; ++k2) {
1652                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE[0]; ++k0) {
1653                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,0,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,0,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1654                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,0,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,0,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1655                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1656                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1657                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,0,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,0,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1658                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,0,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,0,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1659                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1660                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1661                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE[0]));
1662                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1663                              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 / m_dx[0];
1664                              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 / m_dx[1];
1665                              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 / m_dx[2];
1666                          } // end of component loop i                          } // end of component loop i
1667                      } // end of k0 loop                      } // end of k0 loop
1668                  } // end of k2 loop                  } // end of k2 loop
1669              } // end of face 2              } // end of face 2
1670              if (m_faceOffset[3] > -1) {              if (m_faceOffset[3] > -1) {
1671  #pragma omp for nowait  #pragma omp for nowait
1672                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE[2]; ++k2) {
1673                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE[0]; ++k0) {
1674                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,m_N1-2,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,m_NN[1]-2,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1675                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,m_N1-2,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,m_NN[1]-2,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1676                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,m_N1-1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,m_NN[1]-1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1677                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,m_N1-1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,m_NN[1]-1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1678                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-2,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,m_NN[1]-2,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1679                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-2,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,m_NN[1]-2,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1680                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,m_NN[1]-1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1681                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,m_NN[1]-1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1682                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE[0]));
1683                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1684                              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 / m_dx[0];
1685                              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 / m_dx[1];
1686                              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 / m_dx[2];
1687                          } // end of component loop i                          } // end of component loop i
1688                      } // end of k0 loop                      } // end of k0 loop
1689                  } // end of k2 loop                  } // end of k2 loop
1690              } // end of face 3              } // end of face 3
1691              if (m_faceOffset[4] > -1) {              if (m_faceOffset[4] > -1) {
1692  #pragma omp for nowait  #pragma omp for nowait
1693                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1=0; k1 < m_NE[1]; ++k1) {
1694                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE[0]; ++k0) {
1695                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,0, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,0, m_NN[0],m_NN[1])), numComp*sizeof(double));
1696                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1697                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,0, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,0, m_NN[0],m_NN[1])), numComp*sizeof(double));
1698                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1699                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,0, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,0, m_NN[0],m_NN[1])), numComp*sizeof(double));
1700                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1701                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,0, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,0, m_NN[0],m_NN[1])), numComp*sizeof(double));
1702                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1703                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE[0]));
1704                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1705                              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 / m_dx[0];
1706                              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 / m_dx[1];
1707                              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 / m_dx[2];
1708                          } // end of component loop i                          } // end of component loop i
1709                      } // end of k0 loop                      } // end of k0 loop
1710                  } // end of k1 loop                  } // end of k1 loop
1711              } // end of face 4              } // end of face 4
1712              if (m_faceOffset[5] > -1) {              if (m_faceOffset[5] > -1) {
1713  #pragma omp for nowait  #pragma omp for nowait
1714                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1=0; k1 < m_NE[1]; ++k1) {
1715                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE[0]; ++k0) {
1716                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,m_N2-2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,m_NN[2]-2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1717                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,m_NN[2]-1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1718                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,m_N2-2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,m_NN[2]-2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1719                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,m_NN[2]-1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1720                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,m_N2-2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,m_NN[2]-2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1721                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,m_NN[2]-1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1722                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,m_N2-2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,m_NN[2]-2, m_NN[0],m_NN[1])), numComp*sizeof(double));
1723                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,m_NN[2]-1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1724                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE[0]));
1725                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1726                              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 / m_dx[0];
1727                              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 / m_dx[1];
1728                              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 / m_dx[2];
1729                          } // end of component loop i                          } // end of component loop i
1730                      } // end of k0 loop                      } // end of k0 loop
1731                  } // end of k1 loop                  } // end of k1 loop
# Line 1423  void Brick::assembleGradient(escript::Da Line 1735  void Brick::assembleGradient(escript::Da
1735  }  }
1736    
1737  //protected  //protected
1738  void Brick::assembleIntegrate(vector<double>& integrals, escript::Data& arg) const  void Brick::assembleIntegrate(vector<double>& integrals, const escript::Data& arg) const
1739  {  {
1740      const dim_t numComp = arg.getDataPointSize();      const dim_t numComp = arg.getDataPointSize();
1741      const double h0 = m_l0/m_gNE0;      const index_t left = (m_offset[0]==0 ? 0 : 1);
1742      const double h1 = m_l1/m_gNE1;      const index_t bottom = (m_offset[1]==0 ? 0 : 1);
1743      const double h2 = m_l2/m_gNE2;      const index_t front = (m_offset[2]==0 ? 0 : 1);
     const index_t left = (m_offset0==0 ? 0 : 1);  
     const index_t bottom = (m_offset1==0 ? 0 : 1);  
     const index_t front = (m_offset2==0 ? 0 : 1);  
1744      const int fs = arg.getFunctionSpace().getTypeCode();      const int fs = arg.getFunctionSpace().getTypeCode();
1745      if (fs == Elements && arg.actsExpanded()) {      if (fs == Elements && arg.actsExpanded()) {
1746          const double w_0 = h0*h1*h2/8.;          const double w_0 = m_dx[0]*m_dx[1]*m_dx[2]/8.;
1747  #pragma omp parallel  #pragma omp parallel
1748          {          {
1749              vector<double> int_local(numComp, 0);              vector<double> int_local(numComp, 0);
1750  #pragma omp for nowait  #pragma omp for nowait
1751              for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {              for (index_t k2 = front; k2 < front+m_ownNE[2]; ++k2) {
1752                  for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {                  for (index_t k1 = bottom; k1 < bottom+m_ownNE[1]; ++k1) {
1753                      for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {                      for (index_t k0 = left; k0 < left+m_ownNE[0]; ++k0) {
1754                          const double* f = arg.getSampleDataRO(INDEX3(k0, k1, k2, m_NE0, m_NE1));                          const double* f = arg.getSampleDataRO(INDEX3(k0, k1, k2, m_NE[0], m_NE[1]));
1755                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1756                              const double f_0 = f[INDEX2(i,0,numComp)];                              const double f_0 = f[INDEX2(i,0,numComp)];
1757                              const double f_1 = f[INDEX2(i,1,numComp)];                              const double f_1 = f[INDEX2(i,1,numComp)];
# Line 1464  void Brick::assembleIntegrate(vector<dou Line 1773  void Brick::assembleIntegrate(vector<dou
1773          } // end of parallel section          } // end of parallel section
1774    
1775      } else if (fs==ReducedElements || (fs==Elements && !arg.actsExpanded())) {      } else if (fs==ReducedElements || (fs==Elements && !arg.actsExpanded())) {
1776          const double w_0 = h0*h1*h2;          const double w_0 = m_dx[0]*m_dx[1]*m_dx[2];
1777  #pragma omp parallel  #pragma omp parallel
1778          {          {
1779              vector<double> int_local(numComp, 0);              vector<double> int_local(numComp, 0);
1780  #pragma omp for nowait  #pragma omp for nowait
1781              for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {              for (index_t k2 = front; k2 < front+m_ownNE[2]; ++k2) {
1782                  for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {                  for (index_t k1 = bottom; k1 < bottom+m_ownNE[1]; ++k1) {
1783                      for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {                      for (index_t k0 = left; k0 < left+m_ownNE[0]; ++k0) {
1784                          const double* f = arg.getSampleDataRO(INDEX3(k0, k1, k2, m_NE0, m_NE1));                          const double* f = arg.getSampleDataRO(INDEX3(k0, k1, k2, m_NE[0], m_NE[1]));
1785                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1786                              int_local[i]+=f[i]*w_0;                              int_local[i]+=f[i]*w_0;
1787                          }  // end of component loop i                          }  // end of component loop i
# Line 1486  void Brick::assembleIntegrate(vector<dou Line 1795  void Brick::assembleIntegrate(vector<dou
1795          } // end of parallel section          } // end of parallel section
1796    
1797      } else if (fs == FaceElements && arg.actsExpanded()) {      } else if (fs == FaceElements && arg.actsExpanded()) {
1798          const double w_0 = h1*h2/4.;          const double w_0 = m_dx[1]*m_dx[2]/4.;
1799          const double w_1 = h0*h2/4.;          const double w_1 = m_dx[0]*m_dx[2]/4.;
1800          const double w_2 = h0*h1/4.;          const double w_2 = m_dx[0]*m_dx[1]/4.;
1801  #pragma omp parallel  #pragma omp parallel
1802          {          {
1803              vector<double> int_local(numComp, 0);              vector<double> int_local(numComp, 0);
1804              if (m_faceOffset[0] > -1) {              if (m_faceOffset[0] > -1) {
1805  #pragma omp for nowait  #pragma omp for nowait
1806                  for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {                  for (index_t k2 = front; k2 < front+m_ownNE[2]; ++k2) {
1807                      for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {                      for (index_t k1 = bottom; k1 < bottom+m_ownNE[1]; ++k1) {
1808                          const double* f = arg.getSampleDataRO(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));                          const double* f = arg.getSampleDataRO(m_faceOffset[0]+INDEX2(k1,k2,m_NE[1]));
1809                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1810                              const double f_0 = f[INDEX2(i,0,numComp)];                              const double f_0 = f[INDEX2(i,0,numComp)];
1811                              const double f_1 = f[INDEX2(i,1,numComp)];                              const double f_1 = f[INDEX2(i,1,numComp)];
# Line 1510  void Brick::assembleIntegrate(vector<dou Line 1819  void Brick::assembleIntegrate(vector<dou
1819    
1820              if (m_faceOffset[1] > -1) {              if (m_faceOffset[1] > -1) {
1821  #pragma omp for nowait  #pragma omp for nowait
1822                  for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {                  for (index_t k2 = front; k2 < front+m_ownNE[2]; ++k2) {
1823                      for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {                      for (index_t k1 = bottom; k1 < bottom+m_ownNE[1]; ++k1) {
1824                          const double* f = arg.getSampleDataRO(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));                          const double* f = arg.getSampleDataRO(m_faceOffset[1]+INDEX2(k1,k2,m_NE[1]));
1825                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1826                              const double f_0 = f[INDEX2(i,0,numComp)];                              const double f_0 = f[INDEX2(i,0,numComp)];
1827                              const double f_1 = f[INDEX2(i,1,numComp)];                              const double f_1 = f[INDEX2(i,1,numComp)];
# Line 1526  void Brick::assembleIntegrate(vector<dou Line 1835  void Brick::assembleIntegrate(vector<dou
1835    
1836              if (m_faceOffset[2] > -1) {              if (m_faceOffset[2] > -1) {
1837  #pragma omp for nowait  #pragma omp for nowait
1838                  for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {                  for (index_t k2 = front; k2 < front+m_ownNE[2]; ++k2) {
1839                      for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {                      for (index_t k0 = left; k0 < left+m_ownNE[0]; ++k0) {
1840                          const double* f = arg.getSampleDataRO(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));                          const double* f = arg.getSampleDataRO(m_faceOffset[2]+INDEX2(k0,k2,m_NE[0]));
1841                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1842                              const double f_0 = f[INDEX2(i,0,numComp)];                              const double f_0 = f[INDEX2(i,0,numComp)];
1843                              const double f_1 = f[INDEX2(i,1,numComp)];                              const double f_1 = f[INDEX2(i,1,numComp)];
# Line 1542  void Brick::assembleIntegrate(vector<dou Line 1851  void Brick::assembleIntegrate(vector<dou
1851    
1852              if (m_faceOffset[3] > -1) {              if (m_faceOffset[3] > -1) {
1853  #pragma omp for nowait  #pragma omp for nowait
1854                  for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {                  for (index_t k2 = front; k2 < front+m_ownNE[2]; ++k2) {
1855                      for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {                      for (index_t k0 = left; k0 < left+m_ownNE[0]; ++k0) {
1856                          const double* f = arg.getSampleDataRO(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));                          const double* f = arg.getSampleDataRO(m_faceOffset[3]+INDEX2(k0,k2,m_NE[0]));
1857                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1858                              const double f_0 = f[INDEX2(i,0,numComp)];                              const double f_0 = f[INDEX2(i,0,numComp)];
1859                              const double f_1 = f[INDEX2(i,1,numComp)];                              const double f_1 = f[INDEX2(i,1,numComp)];
# Line 1558  void Brick::assembleIntegrate(vector<dou Line 1867  void Brick::assembleIntegrate(vector<dou
1867    
1868              if (m_faceOffset[4] > -1) {              if (m_faceOffset[4] > -1) {
1869  #pragma omp for nowait  #pragma omp for nowait
1870                  for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {                  for (index_t k1 = bottom; k1 < bottom+m_ownNE[1]; ++k1) {
1871                      for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {                      for (index_t k0 = left; k0 < left+m_ownNE[0]; ++k0) {
1872                          const double* f = arg.getSampleDataRO(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));                          const double* f = arg.getSampleDataRO(m_faceOffset[4]+INDEX2(k0,k1,m_NE[0]));
1873                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1874                              const double f_0 = f[INDEX2(i,0,numComp)];                              const double f_0 = f[INDEX2(i,0,numComp)];
1875                              const double f_1 = f[INDEX2(i,1,numComp)];                              const double f_1 = f[INDEX2(i,1,numComp)];
# Line 1574  void Brick::assembleIntegrate(vector<dou Line 1883  void Brick::assembleIntegrate(vector<dou
1883    
1884              if (m_faceOffset[5] > -1) {              if (m_faceOffset[5] > -1) {
1885  #pragma omp for nowait  #pragma omp for nowait
1886                  for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {                  for (index_t k1 = bottom; k1 < bottom+m_ownNE[1]; ++k1) {
1887                      for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {                      for (index_t k0 = left; k0 < left+m_ownNE[0]; ++k0) {
1888                          const double* f = arg.getSampleDataRO(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));                          const double* f = arg.getSampleDataRO(m_faceOffset[5]+INDEX2(k0,k1,m_NE[0]));
1889                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1890                              const double f_0 = f[INDEX2(i,0,numComp)];                              const double f_0 = f[INDEX2(i,0,numComp)];
1891                              const double f_1 = f[INDEX2(i,1,numComp)];                              const double f_1 = f[INDEX2(i,1,numComp)];
# Line 1594  void Brick::assembleIntegrate(vector<dou Line 1903  void Brick::assembleIntegrate(vector<dou
1903          } // end of parallel section          } // end of parallel section
1904    
1905      } else if (fs==ReducedFaceElements || (fs==FaceElements && !arg.actsExpanded())) {      } else if (fs==ReducedFaceElements || (fs==FaceElements && !arg.actsExpanded())) {
1906          const double w_0 = h1*h2;          const double w_0 = m_dx[1]*m_dx[2];
1907          const double w_1 = h0*h2;          const double w_1 = m_dx[0]*m_dx[2];
1908          const double w_2 = h0*h1;          const double w_2 = m_dx[0]*m_dx[1];
1909  #pragma omp parallel  #pragma omp parallel
1910          {          {
1911              vector<double> int_local(numComp, 0);              vector<double> int_local(numComp, 0);
1912              if (m_faceOffset[0] > -1) {              if (m_faceOffset[0] > -1) {
1913  #pragma omp for nowait  #pragma omp for nowait
1914                  for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {                  for (index_t k2 = front; k2 < front+m_ownNE[2]; ++k2) {
1915                      for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {                      for (index_t k1 = bottom; k1 < bottom+m_ownNE[1]; ++k1) {
1916                          const double* f = arg.getSampleDataRO(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));                          const double* f = arg.getSampleDataRO(m_faceOffset[0]+INDEX2(k1,k2,m_NE[1]));
1917                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1918                              int_local[i]+=f[i]*w_0;                              int_local[i]+=f[i]*w_0;
1919                          }  // end of component loop i                          }  // end of component loop i
# Line 1614  void Brick::assembleIntegrate(vector<dou Line 1923  void Brick::assembleIntegrate(vector<dou
1923    
1924              if (m_faceOffset[1] > -1) {              if (m_faceOffset[1] > -1) {
1925  #pragma omp for nowait  #pragma omp for nowait
1926                  for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {                  for (index_t k2 = front; k2 < front+m_ownNE[2]; ++k2) {
1927                      for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {                      for (index_t k1 = bottom; k1 < bottom+m_ownNE[1]; ++k1) {
1928                          const double* f = arg.getSampleDataRO(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));                          const double* f = arg.getSampleDataRO(m_faceOffset[1]+INDEX2(k1,k2,m_NE[1]));
1929                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1930                              int_local[i]+=f[i]*w_0;                              int_local[i]+=f[i]*w_0;
1931                          }  // end of component loop i                          }  // end of component loop i
# Line 1626  void Brick::assembleIntegrate(vector<dou Line 1935  void Brick::assembleIntegrate(vector<dou
1935    
1936              if (m_faceOffset[2] > -1) {              if (m_faceOffset[2] > -1) {
1937  #pragma omp for nowait  #pragma omp for nowait
1938                  for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {                  for (index_t k2 = front; k2 < front+m_ownNE[2]; ++k2) {
1939                      for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {                      for (index_t k0 = left; k0 < left+m_ownNE[0]; ++k0) {
1940                          const double* f = arg.getSampleDataRO(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));                          const double* f = arg.getSampleDataRO(m_faceOffset[2]+INDEX2(k0,k2,m_NE[0]));
1941                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1942                              int_local[i]+=f[i]*w_1;                              int_local[i]+=f[i]*w_1;
1943                          }  // end of component loop i                          }  // end of component loop i
# Line 1638  void Brick::assembleIntegrate(vector<dou Line 1947  void Brick::assembleIntegrate(vector<dou
1947    
1948              if (m_faceOffset[3] > -1) {              if (m_faceOffset[3] > -1) {
1949  #pragma omp for nowait  #pragma omp for nowait
1950                  for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {                  for (index_t k2 = front; k2 < front+m_ownNE[2]; ++k2) {
1951                      for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {                      for (index_t k0 = left; k0 < left+m_ownNE[0]; ++k0) {
1952                          const double* f = arg.getSampleDataRO(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));                          const double* f = arg.getSampleDataRO(m_faceOffset[3]+INDEX2(k0,k2,m_NE[0]));
1953                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1954                              int_local[i]+=f[i]*w_1;                              int_local[i]+=f[i]*w_1;
1955                          }  // end of component loop i                          }  // end of component loop i
# Line 1650  void Brick::assembleIntegrate(vector<dou Line 1959  void Brick::assembleIntegrate(vector<dou
1959    
1960              if (m_faceOffset[4] > -1) {              if (m_faceOffset[4] > -1) {
1961  #pragma omp for nowait  #pragma omp for nowait
1962                  for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {                  for (index_t k1 = bottom; k1 < bottom+m_ownNE[1]; ++k1) {
1963                      for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {                      for (index_t k0 = left; k0 < left+m_ownNE[0]; ++k0) {
1964                          const double* f = arg.getSampleDataRO(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));                          const double* f = arg.getSampleDataRO(m_faceOffset[4]+INDEX2(k0,k1,m_NE[0]));
1965                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1966                              int_local[i]+=f[i]*w_2;                              int_local[i]+=f[i]*w_2;
1967                          }  // end of component loop i                          }  // end of component loop i
# Line 1662  void Brick::assembleIntegrate(vector<dou Line 1971  void Brick::assembleIntegrate(vector<dou
1971    
1972              if (m_faceOffset[5] > -1) {              if (m_faceOffset[5] > -1) {
1973  #pragma omp for nowait  #pragma omp for nowait
1974                  for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {                  for (index_t k1 = bottom; k1 < bottom+m_ownNE[1]; ++k1) {
1975                      for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {                      for (index_t k0 = left; k0 < left+m_ownNE[0]; ++k0) {
1976                          const double* f = arg.getSampleDataRO(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));                          const double* f = arg.getSampleDataRO(m_faceOffset[5]+INDEX2(k0,k1,m_NE[0]));
1977                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1978                              int_local[i]+=f[i]*w_2;                              int_local[i]+=f[i]*w_2;
1979                          }  // end of component loop i                          }  // end of component loop i
# Line 1682  void Brick::assembleIntegrate(vector<dou Line 1991  void Brick::assembleIntegrate(vector<dou
1991  //protected  //protected
1992  dim_t Brick::insertNeighbourNodes(IndexVector& index, index_t node) const  dim_t Brick::insertNeighbourNodes(IndexVector& index, index_t node) const
1993  {  {
1994      const dim_t nDOF0 = (m_gNE0+1)/m_NX;      const dim_t nDOF0 = (m_gNE[0]+1)/m_NX[0];
1995      const dim_t nDOF1 = (m_gNE1+1)/m_NY;      const dim_t nDOF1 = (m_gNE[1]+1)/m_NX[1];
1996      const dim_t nDOF2 = (m_gNE2+1)/m_NZ;      const dim_t nDOF2 = (m_gNE[2]+1)/m_NX[2];
1997      const int x=node%nDOF0;      const int x=node%nDOF0;
1998      const int y=node%(nDOF0*nDOF1)/nDOF0;      const int y=node%(nDOF0*nDOF1)/nDOF0;
1999      const int z=node/(nDOF0*nDOF1);      const int z=node/(nDOF0*nDOF1);
# Line 1714  dim_t Brick::insertNeighbourNodes(IndexV Line 2023  dim_t Brick::insertNeighbourNodes(IndexV
2023  }  }
2024    
2025  //protected  //protected
2026  void Brick::nodesToDOF(escript::Data& out, escript::Data& in) const  void Brick::nodesToDOF(escript::Data& out, const escript::Data& in) const
2027  {  {
2028      const dim_t numComp = in.getDataPointSize();      const dim_t numComp = in.getDataPointSize();
2029      out.requireWrite();      out.requireWrite();
2030    
2031      const index_t left = (m_offset0==0 ? 0 : 1);      const index_t left = (m_offset[0]==0 ? 0 : 1);
2032      const index_t bottom = (m_offset1==0 ? 0 : 1);      const index_t bottom = (m_offset[1]==0 ? 0 : 1);
2033      const index_t front = (m_offset2==0 ? 0 : 1);      const index_t front = (m_offset[2]==0 ? 0 : 1);
2034      const dim_t nDOF0 = (m_gNE0+1)/m_NX;      const dim_t nDOF0 = (m_gNE[0]+1)/m_NX[0];
2035      const dim_t nDOF1 = (m_gNE1+1)/m_NY;      const dim_t nDOF1 = (m_gNE[1]+1)/m_NX[1];
2036      const dim_t nDOF2 = (m_gNE2+1)/m_NZ;      const dim_t nDOF2 = (m_gNE[2]+1)/m_NX[2];
2037  #pragma omp parallel for  #pragma omp parallel for
2038      for (index_t i=0; i<nDOF2; i++) {      for (index_t i=0; i<nDOF2; i++) {
2039          for (index_t j=0; j<nDOF1; j++) {          for (index_t j=0; j<nDOF1; j++) {
2040              for (index_t k=0; k<nDOF0; k++) {              for (index_t k=0; k<nDOF0; k++) {
2041                  const index_t n=k+left+(j+bottom)*m_N0+(i+front)*m_N0*m_N1;                  const index_t n=k+left+(j+bottom)*m_NN[0]+(i+front)*m_NN[0]*m_NN[1];
2042                  const double* src=in.getSampleDataRO(n);                  const double* src=in.getSampleDataRO(n);
2043                  copy(src, src+numComp, out.getSampleDataRW(k+j*nDOF0+i*nDOF0*nDOF1));                  copy(src, src+numComp, out.getSampleDataRW(k+j*nDOF0+i*nDOF0*nDOF1));
2044              }              }
# Line 1738  void Brick::nodesToDOF(escript::Data& ou Line 2047  void Brick::nodesToDOF(escript::Data& ou
2047  }  }
2048    
2049  //protected  //protected
2050  void Brick::dofToNodes(escript::Data& out, escript::Data& in) const  void Brick::dofToNodes(escript::Data& out, const escript::Data& in) const
2051  {  {
2052      const dim_t numComp = in.getDataPointSize();      const dim_t numComp = in.getDataPointSize();
2053      Paso_Coupler* coupler = Paso_Coupler_alloc(m_connector, numComp);      Paso_Coupler* coupler = Paso_Coupler_alloc(m_connector, numComp);
2054      in.requireWrite();      // expand data object if necessary to be able to grab the whole data
2055      Paso_Coupler_startCollect(coupler, in.getSampleDataRW(0));      const_cast<escript::Data*>(&in)->expand();
2056        Paso_Coupler_startCollect(coupler, in.getSampleDataRO(0));
2057    
2058      const dim_t numDOF = getNumDOF();      const dim_t numDOF = getNumDOF();
2059      out.requireWrite();      out.requireWrite();
# Line 1756  void Brick::dofToNodes(escript::Data& ou Line 2066  void Brick::dofToNodes(escript::Data& ou
2066                  : &buffer[(m_dofMap[i]-numDOF)*numComp]);                  : &buffer[(m_dofMap[i]-numDOF)*numComp]);
2067          copy(src, src+numComp, out.getSampleDataRW(i));          copy(src, src+numComp, out.getSampleDataRW(i));
2068      }      }
2069        Paso_Coupler_free(coupler);
2070  }  }
2071    
2072  //private  //private
2073  void Brick::populateSampleIds()  void Brick::populateSampleIds()
2074  {  {
2075      // identifiers are ordered from left to right, bottom to top, front to back      // degrees of freedom are numbered from left to right, bottom to top, front
2076      // globally      // to back in each rank, continuing on the next rank (ranks also go
2077        // left-right, bottom-top, front-back).
2078        // This means rank 0 has id 0...n0-1, rank 1 has id n0...n1-1 etc. which
2079        // helps when writing out data rank after rank.
2080    
2081      // build node distribution vector first.      // build node distribution vector first.
2082      // rank i owns m_nodeDistribution[i+1]-nodeDistribution[i] nodes which is      // rank i owns m_nodeDistribution[i+1]-nodeDistribution[i] nodes which is
# Line 1776  void Brick::populateSampleIds() Line 2090  void Brick::populateSampleIds()
2090      m_nodeId.resize(getNumNodes());      m_nodeId.resize(getNumNodes());
2091      m_dofId.resize(numDOF);      m_dofId.resize(numDOF);
2092      m_elementId.resize(getNumElements());      m_elementId.resize(getNumElements());
2093    
2094        // populate face element counts
2095        //left
2096        if (m_offset[0]==0)
2097            m_faceCount[0]=m_NE[1]*m_NE[2];
2098        else
2099            m_faceCount[0]=0;
2100        //right
2101        if (m_mpiInfo->rank%m_NX[0]==m_NX[0]-1)
2102            m_faceCount[1]=m_NE[1]*m_NE[2];
2103        else
2104            m_faceCount[1]=0;
2105        //bottom
2106        if (m_offset[1]==0)
2107            m_faceCount[2]=m_NE[0]*m_NE[2];
2108        else
2109            m_faceCount[2]=0;
2110        //top
2111        if (m_mpiInfo->rank%(m_NX[0]*m_NX[1])/m_NX[0]==m_NX[1]-1)
2112            m_faceCount[3]=m_NE[0]*m_NE[2];
2113        else
2114            m_faceCount[3]=0;
2115        //front
2116        if (m_offset[2]==0)
2117            m_faceCount[4]=m_NE[0]*m_NE[1];
2118        else
2119            m_faceCount[4]=0;
2120        //back
2121        if (m_mpiInfo->rank/(m_NX[0]*m_NX[1])==m_NX[2]-1)
2122            m_faceCount[5]=m_NE[0]*m_NE[1];
2123        else
2124            m_faceCount[5]=0;
2125    
2126      m_faceId.resize(getNumFaceElements());      m_faceId.resize(getNumFaceElements());
2127    
2128        const index_t left = (m_offset[0]==0 ? 0 : 1);
2129        const index_t bottom = (m_offset[1]==0 ? 0 : 1);
2130        const index_t front = (m_offset[2]==0 ? 0 : 1);
2131        const dim_t nDOF0 = (m_gNE[0]+1)/m_NX[0];
2132        const dim_t nDOF1 = (m_gNE[1]+1)/m_NX[1];
2133        const dim_t nDOF2 = (m_gNE[2]+1)/m_NX[2];
2134    
2135        // the following is a compromise between efficiency and code length to
2136        // set the node id's according to the order mentioned above.
2137        // First we set all the edge and corner id's in a rather slow way since
2138        // they might or might not be owned by this rank. Next come the own
2139        // node id's which are identical to the DOF id's (simple loop), and finally
2140        // the 6 faces are set but only if required...
2141    
2142    #define globalNodeId(x,y,z) \
2143        ((m_offset[0]+x)/nDOF0)*nDOF0*nDOF1*nDOF2+(m_offset[0]+x)%nDOF0\
2144        + ((m_offset[1]+y)/nDOF1)*nDOF0*nDOF1*nDOF2*m_NX[0]+((m_offset[1]+y)%nDOF1)*nDOF0\
2145        + ((m_offset[2]+z)/nDOF2)*nDOF0*nDOF1*nDOF2*m_NX[0]*m_NX[1]+((m_offset[2]+z)%nDOF2)*nDOF0*nDOF1
2146    
2147  #pragma omp parallel  #pragma omp parallel
2148      {      {
2149            // set edge id's
2150            // edges in x-direction, including corners
2151  #pragma omp for nowait  #pragma omp for nowait
2152          // nodes          for (dim_t i=0; i<m_NN[0]; i++) {
2153          for (dim_t i2=0; i2<m_N2; i2++) {              m_nodeId[i] = globalNodeId(i, 0, 0); // LF
2154              for (dim_t i1=0; i1<m_N1; i1++) {              m_nodeId[m_NN[0]*(m_NN[1]-1)+i] = globalNodeId(i, m_NN[1]-1, 0); // UF
2155                  for (dim_t i0=0; i0<m_N0; i0++) {              m_nodeId[m_NN[0]*m_NN[1]*(m_NN[2]-1)+i] = globalNodeId(i, 0, m_NN[2]-1); // LB
2156                      m_nodeId[i0+i1*m_N0+i2*m_N0*m_N1] =              m_nodeId[m_NN[0]*m_NN[1]*m_NN[2]-m_NN[0]+i] = globalNodeId(i, m_NN[1]-1, m_NN[2]-1); // UB
2157                          (m_offset2+i2)*(m_gNE0+1)*(m_gNE1+1)          }
2158                          +(m_offset1+i1)*(m_gNE0+1)          // edges in y-direction, without corners
2159                          +m_offset0+i0;  #pragma omp for nowait
2160            for (dim_t i=1; i<m_NN[1]-1; i++) {
2161                m_nodeId[m_NN[0]*i] = globalNodeId(0, i, 0); // FL
2162                m_nodeId[m_NN[0]*(i+1)-1] = globalNodeId(m_NN[0]-1, i, 0); // FR
2163                m_nodeId[m_NN[0]*m_NN[1]*(m_NN[2]-1)+m_NN[0]*i] = globalNodeId(0, i, m_NN[2]-1); // BL
2164                m_nodeId[m_NN[0]*m_NN[1]*(m_NN[2]-1)+m_NN[0]*(i+1)-1] = globalNodeId(m_NN[0]-1, i, m_NN[2]-1); // BR
2165            }
2166            // edges in z-direction, without corners
2167    #pragma omp for
2168            for (dim_t i=1; i<m_NN[2]-1; i++) {
2169                m_nodeId[m_NN[0]*m_NN[1]*i] = globalNodeId(0, 0, i); // LL
2170                m_nodeId[m_NN[0]*m_NN[1]*i+m_NN[0]-1] = globalNodeId(m_NN[0]-1, 0, i); // LR
2171                m_nodeId[m_NN[0]*m_NN[1]*(i+1)-m_NN[0]] = globalNodeId(0, m_NN[1]-1, i); // UL
2172                m_nodeId[m_NN[0]*m_NN[1]*(i+1)-1] = globalNodeId(m_NN[0]-1, m_NN[1]-1, i); // UR
2173            }
2174            // implicit barrier here because some node IDs will be overwritten
2175            // below
2176    
2177            // populate degrees of freedom and own nodes (identical id)
2178    #pragma omp for nowait
2179            for (dim_t i=0; i<nDOF2; i++) {
2180                for (dim_t j=0; j<nDOF1; j++) {
2181                    for (dim_t k=0; k<nDOF0; k++) {
2182                        const index_t nodeIdx=k+left+(j+bottom)*m_NN[0]+(i+front)*m_NN[0]*m_NN[1];
2183                        const index_t dofIdx=k+j*nDOF0+i*nDOF0*nDOF1;
2184                        m_dofId[dofIdx] = m_nodeId[nodeIdx]
2185                            = m_nodeDistribution[m_mpiInfo->rank]+dofIdx;
2186                  }                  }
2187              }              }
2188          }          }
2189    
2190          // degrees of freedom          // populate the rest of the nodes (shared with other ranks)
2191            if (m_faceCount[0]==0) { // left plane
2192    #pragma omp for nowait
2193                for (dim_t i=0; i<nDOF2; i++) {
2194                    for (dim_t j=0; j<nDOF1; j++) {
2195                        const index_t nodeIdx=(j+bottom)*m_NN[0]+(i+front)*m_NN[0]*m_NN[1];
2196                        const index_t dofId=(j+1)*nDOF0-1+i*nDOF0*nDOF1;
2197                        m_nodeId[nodeIdx]
2198                            = m_nodeDistribution[m_mpiInfo->rank-1]+dofId;
2199                    }
2200                }
2201            }
2202            if (m_faceCount[1]==0) { // right plane
2203    #pragma omp for nowait
2204                for (dim_t i=0; i<nDOF2; i++) {
2205                    for (dim_t j=0; j<nDOF1; j++) {
2206                        const index_t nodeIdx=(j+bottom+1)*m_NN[0]-1+(i+front)*m_NN[0]*m_NN[1];
2207                        const index_t dofId=j*nDOF0+i*nDOF0*nDOF1;
2208                        m_nodeId[nodeIdx]
2209                            = m_nodeDistribution[m_mpiInfo->rank+1]+dofId;
2210                    }
2211                }
2212            }
2213            if (m_faceCount[2]==0) { // bottom plane
2214    #pragma omp for nowait
2215                for (dim_t i=0; i<nDOF2; i++) {
2216                    for (dim_t k=0; k<nDOF0; k++) {
2217                        const index_t nodeIdx=k+left+(i+front)*m_NN[0]*m_NN[1];
2218                        const index_t dofId=nDOF0*(nDOF1-1)+k+i*nDOF0*nDOF1;
2219                        m_nodeId[nodeIdx]
2220                            = m_nodeDistribution[m_mpiInfo->rank-m_NX[0]]+dofId;
2221                    }
2222                }
2223            }
2224            if (m_faceCount[3]==0) { // top plane
2225    #pragma omp for nowait
2226                for (dim_t i=0; i<nDOF2; i++) {
2227                    for (dim_t k=0; k<nDOF0; k++) {
2228                        const index_t nodeIdx=k+left+(i+front)*m_NN[0]*m_NN[1]+m_NN[0]*(m_NN[1]-1);
2229                        const index_t dofId=k+i*nDOF0*nDOF1;
2230                        m_nodeId[nodeIdx]
2231                            = m_nodeDistribution[m_mpiInfo->rank+m_NX[0]]+dofId;
2232                    }
2233                }
2234            }
2235            if (m_faceCount[4]==0) { // front plane
2236    #pragma omp for nowait
2237                for (dim_t j=0; j<nDOF1; j++) {
2238                    for (dim_t k=0; k<nDOF0; k++) {
2239                        const index_t nodeIdx=k+left+(j+bottom)*m_NN[0];
2240                        const index_t dofId=k+j*nDOF0+nDOF0*nDOF1*(nDOF2-1);
2241                        m_nodeId[nodeIdx]
2242                            = m_nodeDistribution[m_mpiInfo->rank-m_NX[0]*m_NX[1]]+dofId;
2243                    }
2244                }
2245            }
2246            if (m_faceCount[5]==0) { // back plane
2247  #pragma omp for nowait  #pragma omp for nowait
2248          for (dim_t k=0; k<numDOF; k++)              for (dim_t j=0; j<nDOF1; j++) {
2249              m_dofId[k] = m_nodeDistribution[m_mpiInfo->rank]+k;                  for (dim_t k=0; k<nDOF0; k++) {
2250                        const index_t nodeIdx=k+left+(j+bottom)*m_NN[0]+m_NN[0]*m_NN[1]*(m_NN[2]-1);
2251                        const index_t dofId=k+j*nDOF0;
2252                        m_nodeId[nodeIdx]
2253                            = m_nodeDistribution[m_mpiInfo->rank+m_NX[0]*m_NX[1]]+dofId;
2254                    }
2255                }
2256            }
2257    
2258          // elements          // populate element id's
2259  #pragma omp for nowait  #pragma omp for nowait
2260          for (dim_t i2=0; i2<m_NE2; i2++) {          for (dim_t i2=0; i2<m_NE[2]; i2++) {
2261              for (dim_t i1=0; i1<m_NE1; i1++) {              for (dim_t i1=0; i1<m_NE[1]; i1++) {
2262                  for (dim_t i0=0; i0<m_NE0; i0++) {                  for (dim_t i0=0; i0<m_NE[0]; i0++) {
2263                      m_elementId[i0+i1*m_NE0+i2*m_NE0*m_NE1] =                      m_elementId[i0+i1*m_NE[0]+i2*m_NE[0]*m_NE[1]] =
2264                          (m_offset2+i2)*m_gNE0*m_gNE1                          (m_offset[2]+i2)*m_gNE[0]*m_gNE[1]
2265                          +(m_offset1+i1)*m_gNE0                          +(m_offset[1]+i1)*m_gNE[0]
2266                          +m_offset0+i0;                          +m_offset[0]+i0;
2267                  }                  }
2268              }              }
2269          }          }
# Line 1817  void Brick::populateSampleIds() Line 2274  void Brick::populateSampleIds()
2274              m_faceId[k]=k;              m_faceId[k]=k;
2275      } // end parallel section      } // end parallel section
2276    
2277    #undef globalNodeId
2278    
2279      m_nodeTags.assign(getNumNodes(), 0);      m_nodeTags.assign(getNumNodes(), 0);
2280      updateTagsInUse(Nodes);      updateTagsInUse(Nodes);
2281    
# Line 1824  void Brick::populateSampleIds() Line 2283  void Brick::populateSampleIds()
2283      updateTagsInUse(Elements);      updateTagsInUse(Elements);
2284    
2285      // generate face offset vector and set face tags      // generate face offset vector and set face tags
     const IndexVector facesPerEdge = getNumFacesPerBoundary();  
2286      const index_t LEFT=1, RIGHT=2, BOTTOM=10, TOP=20, FRONT=100, BACK=200;      const index_t LEFT=1, RIGHT=2, BOTTOM=10, TOP=20, FRONT=100, BACK=200;
2287      const index_t faceTag[] = { LEFT, RIGHT, BOTTOM, TOP, FRONT, BACK };      const index_t faceTag[] = { LEFT, RIGHT, BOTTOM, TOP, FRONT, BACK };
2288      m_faceOffset.assign(facesPerEdge.size(), -1);      m_faceOffset.assign(6, -1);
2289      m_faceTags.clear();      m_faceTags.clear();
2290      index_t offset=0;      index_t offset=0;
2291      for (size_t i=0; i<facesPerEdge.size(); i++) {      for (size_t i=0; i<6; i++) {
2292          if (facesPerEdge[i]>0) {          if (m_faceCount[i]>0) {
2293              m_faceOffset[i]=offset;              m_faceOffset[i]=offset;
2294              offset+=facesPerEdge[i];              offset+=m_faceCount[i];
2295              m_faceTags.insert(m_faceTags.end(), facesPerEdge[i], faceTag[i]);              m_faceTags.insert(m_faceTags.end(), m_faceCount[i], faceTag[i]);
2296          }          }
2297      }      }
2298      setTagMap("left", LEFT);      setTagMap("left", LEFT);
# Line 1849  void Brick::populateSampleIds() Line 2307  void Brick::populateSampleIds()
2307  //private  //private
2308  void Brick::createPattern()  void Brick::createPattern()
2309  {  {
2310      const dim_t nDOF0 = (m_gNE0+1)/m_NX;      const dim_t nDOF0 = (m_gNE[0]+1)/m_NX[0];
2311      const dim_t nDOF1 = (m_gNE1+1)/m_NY;      const dim_t nDOF1 = (m_gNE[1]+1)/m_NX[1];
2312      const dim_t nDOF2 = (m_gNE2+1)/m_NZ;      const dim_t nDOF2 = (m_gNE[2]+1)/m_NX[2];
2313      const index_t left = (m_offset0==0 ? 0 : 1);      const index_t left = (m_offset[0]==0 ? 0 : 1);
2314      const index_t bottom = (m_offset1==0 ? 0 : 1);      const index_t bottom = (m_offset[1]==0 ? 0 : 1);
2315      const index_t front = (m_offset2==0 ? 0 : 1);      const index_t front = (m_offset[2]==0 ? 0 : 1);
2316    
2317      // populate node->DOF mapping with own degrees of freedom.      // populate node->DOF mapping with own degrees of freedom.
2318      // The rest is assigned in the loop further down      // The rest is assigned in the loop further down
# Line 1863  void Brick::createPattern() Line 2321  void Brick::createPattern()
2321      for (index_t i=front; i<front+nDOF2; i++) {      for (index_t i=front; i<front+nDOF2; i++) {
2322          for (index_t j=bottom; j<bottom+nDOF1; j++) {          for (index_t j=bottom; j<bottom+nDOF1; j++) {
2323              for (index_t k=left; k<left+nDOF0; k++) {              for (index_t k=left; k<left+nDOF0; k++) {
2324                  m_dofMap[i*m_N0*m_N1+j*m_N0+k]=(i-front)*nDOF0*nDOF1+(j-bottom)*nDOF0+k-left;                  m_dofMap[i*m_NN[0]*m_NN[1]+j*m_NN[0]+k]=(i-front)*nDOF0*nDOF1+(j-bottom)*nDOF0+k-left;
2325              }              }
2326          }          }
2327      }      }
# Line 1876  void Brick::createPattern() Line 2334  void Brick::createPattern()
2334      RankVector neighbour;      RankVector neighbour;
2335      IndexVector offsetInShared(1,0);      IndexVector offsetInShared(1,0);
2336      IndexVector sendShared, recvShared;      IndexVector sendShared, recvShared;
2337      int numShared=0;      int numShared=0, expectedShared=0;;
2338      const int x=m_mpiInfo->rank%m_NX;      const int x=m_mpiInfo->rank%m_NX[0];
2339      const int y=m_mpiInfo->rank%(m_NX*m_NY)/m_NX;      const int y=m_mpiInfo->rank%(m_NX[0]*m_NX[1])/m_NX[0];
2340      const int z=m_mpiInfo->rank/(m_NX*m_NY);      const int z=m_mpiInfo->rank/(m_NX[0]*m_NX[1]);
2341      for (int i2=-1; i2<2; i2++) {      for (int i2=-1; i2<2; i2++) {
2342          for (int i1=-1; i1<2; i1++) {          for (int i1=-1; i1<2; i1++) {
2343              for (int i0=-1; i0<2; i0++) {              for (int i0=-1; i0<2; i0++) {
# Line 1890  void Brick::createPattern() Line 2348  void Brick::createPattern()
2348                  const int nx=x+i0;                  const int nx=x+i0;
2349                  const int ny=y+i1;                  const int ny=y+i1;
2350                  const int nz=z+i2;                  const int nz=z+i2;
2351                  if (nx>=0 && ny>=0 && nz>=0 && nx<m_NX && ny<m_NY && nz<m_NZ) {                  if (!(nx>=0 && ny>=0 && nz>=0 && nx<m_NX[0] && ny<m_NX[1] && nz<m_NX[2])) {
2352                      neighbour.push_back(nz*m_NX*m_NY+ny*m_NX+nx);                      continue;
2353                    }
2354                    if (i0==0 && i1==0)
2355                        expectedShared += nDOF0*nDOF1;
2356                    else if (i0==0 && i2==0)
2357                        expectedShared += nDOF0*nDOF2;
2358                    else if (i1==0 && i2==0)
2359                        expectedShared += nDOF1*nDOF2;
2360                    else if (i0==0)
2361                        expectedShared += nDOF0;
2362                    else if (i1==0)
2363                        expectedShared += nDOF1;
2364                    else if (i2==0)
2365                        expectedShared += nDOF2;
2366                    else
2367                        expectedShared++;
2368                }
2369            }
2370        }
2371        
2372        vector<IndexVector> rowIndices(expectedShared);
2373        
2374        for (int i2=-1; i2<2; i2++) {
2375            for (int i1=-1; i1<2; i1++) {
2376                for (int i0=-1; i0<2; i0++) {
2377                    // skip this rank
2378                    if (i0==0 && i1==0 && i2==0)
2379                        continue;
2380                    // location of neighbour rank
2381                    const int nx=x+i0;
2382                    const int ny=y+i1;
2383                    const int nz=z+i2;
2384                    if (nx>=0 && ny>=0 && nz>=0 && nx<m_NX[0] && ny<m_NX[1] && nz<m_NX[2]) {
2385                        neighbour.push_back(nz*m_NX[0]*m_NX[1]+ny*m_NX[0]+nx);
2386                      if (i0==0 && i1==0) {                      if (i0==0 && i1==0) {
2387                          // sharing front or back plane                          // sharing front or back plane
2388                          offsetInShared.push_back(offsetInShared.back()+nDOF0*nDOF1);                          offsetInShared.push_back(offsetInShared.back()+nDOF0*nDOF1);
2389                          for (dim_t i=0; i<nDOF1; i++) {                          for (dim_t i=0; i<nDOF1; i++) {
2390                              const int firstDOF=(i2==-1 ? i*nDOF0                              const int firstDOF=(i2==-1 ? i*nDOF0
2391                                      : i*nDOF0 + nDOF0*nDOF1*(nDOF2-1));                                      : i*nDOF0 + nDOF0*nDOF1*(nDOF2-1));
2392                              const int firstNode=(i2==-1 ? left+(i+bottom)*m_N0                              const int firstNode=(i2==-1 ? left+(i+bottom)*m_NN[0]
2393                                      : left+(i+bottom)*m_N0+m_N0*m_N1*(m_N2-1));                                      : left+(i+bottom)*m_NN[0]+m_NN[0]*m_NN[1]*(m_NN[2]-1));
2394                              for (dim_t j=0; j<nDOF0; j++, numShared++) {                              for (dim_t j=0; j<nDOF0; j++, numShared++) {
2395                                  sendShared.push_back(firstDOF+j);                                  sendShared.push_back(firstDOF+j);
2396                                  recvShared.push_back(numDOF+numShared);                                  recvShared.push_back(numDOF+numShared);
2397                                  if (j>0) {                                  if (j>0) {
2398                                      if (i>0)                                      if (i>0)
2399                                          colIndices[firstDOF+j-1-nDOF0].push_back(numShared);                                          doublyLink(colIndices, rowIndices, firstDOF+j-1-nDOF0, numShared);
2400                                      colIndices[firstDOF+j-1].push_back(numShared);                                      doublyLink(colIndices, rowIndices, firstDOF+j-1, numShared);
2401                                      if (i<nDOF1-1)                                      if (i<nDOF1-1)
2402                                          colIndices[firstDOF+j-1+nDOF0].push_back(numShared);                                          doublyLink(colIndices, rowIndices, firstDOF+j-1+nDOF0, numShared);
2403                                  }                                  }
2404                                  if (i>0)                                  if (i>0)
2405                                      colIndices[firstDOF+j-nDOF0].push_back(numShared);                                      doublyLink(colIndices, rowIndices, firstDOF+j-nDOF0, numShared);
2406                                  colIndices[firstDOF+j].push_back(numShared);                                  doublyLink(colIndices, rowIndices, firstDOF+j, numShared);
2407                                  if (i<nDOF1-1)                                  if (i<nDOF1-1)
2408                                      colIndices[firstDOF+j+nDOF0].push_back(numShared);                                      doublyLink(colIndices, rowIndices, firstDOF+j+nDOF0, numShared);
2409                                  if (j<nDOF0-1) {                                  if (j<nDOF0-1) {
2410                                      if (i>0)                                      if (i>0)
2411                                          colIndices[firstDOF+j+1-nDOF0].push_back(numShared);                                          doublyLink(colIndices, rowIndices, firstDOF+j+1-nDOF0, numShared);
2412                                      colIndices[firstDOF+j+1].push_back(numShared);                                      doublyLink(colIndices, rowIndices, firstDOF+j+1, numShared);
2413                                      if (i<nDOF1-1)                                      if (i<nDOF1-1)
2414                                          colIndices[firstDOF+j+1+nDOF0].push_back(numShared);                                          doublyLink(colIndices, rowIndices, firstDOF+j+1+nDOF0, numShared);
2415                                  }                                  }
2416                                  m_dofMap[firstNode+j]=numDOF+numShared;                                  m_dofMap[firstNode+j]=numDOF+numShared;
2417                              }                              }
# Line 1932  void Brick::createPattern() Line 2423  void Brick::createPattern()
2423                              const int firstDOF=(i1==-1 ? i*nDOF0*nDOF1                              const int firstDOF=(i1==-1 ? i*nDOF0*nDOF1
2424                                      : nDOF0*((i+1)*nDOF1-1));                                      : nDOF0*((i+1)*nDOF1-1));
2425                              const int firstNode=(i1==-1 ?                              const int firstNode=(i1==-1 ?
2426                                      left+(i+front)*m_N0*m_N1                                      left+(i+front)*m_NN[0]*m_NN[1]
2427                                      : left+m_N0*((i+1+front)*m_N1-1));                                      : left+m_NN[0]*((i+1+front)*m_NN[1]-1));
2428                              for (dim_t j=0; j<nDOF0; j++, numShared++) {                              for (dim_t j=0; j<nDOF0; j++, numShared++) {
2429                                  sendShared.push_back(firstDOF+j);                                  sendShared.push_back(firstDOF+j);
2430                                  recvShared.push_back(numDOF+numShared);                                  recvShared.push_back(numDOF+numShared);
2431                                  if (j>0) {                                  if (j>0) {
2432                                      if (i>0)                                      if (i>0)
2433                                          colIndices[firstDOF+j-1-nDOF0*nDOF1].push_back(numShared);                                          doublyLink(colIndices, rowIndices, firstDOF+j-1-nDOF0*nDOF1, numShared);
2434                                      colIndices[firstDOF+j-1].push_back(numShared);                                      doublyLink(colIndices, rowIndices, firstDOF+j-1, numShared);
2435                                      if (i<nDOF2-1)                                      if (i<nDOF2-1)
2436                                          colIndices[firstDOF+j-1+nDOF0*nDOF1].push_back(numShared);                                          doublyLink(colIndices, rowIndices, firstDOF+j-1+nDOF0*nDOF1, numShared);
2437                                  }                                  }
2438                                  if (i>0)                                  if (i>0)
2439                                      colIndices[firstDOF+j-nDOF0*nDOF1].push_back(numShared);                                      doublyLink(colIndices, rowIndices, firstDOF+j-nDOF0*nDOF1, numShared);
2440                                  colIndices[firstDOF+j].push_back(numShared);                                  doublyLink(colIndices, rowIndices, firstDOF+j, numShared);
2441                                  if (i<nDOF2-1)                                  if (i<nDOF2-1)
2442                                      colIndices[firstDOF+j+nDOF0*nDOF1].push_back(numShared);                                      doublyLink(colIndices, rowIndices, firstDOF+j+nDOF0*nDOF1, numShared);
2443                                  if (j<nDOF0-1) {                                  if (j<nDOF0-1) {
2444                                      if (i>0)                                      if (i>0)
2445                                          colIndices[firstDOF+j+1-nDOF0*nDOF1].push_back(numShared);                                          doublyLink(colIndices, rowIndices, firstDOF+j+1-nDOF0*nDOF1, numShared);
2446                                      colIndices[firstDOF+j+1].push_back(numShared);                                      doublyLink(colIndices, rowIndices, firstDOF+j+1, numShared);
2447                                      if (i<nDOF2-1)                                      if (i<nDOF2-1)
2448                                          colIndices[firstDOF+j+1+nDOF0*nDOF1].push_back(numShared);                                          doublyLink(colIndices, rowIndices, firstDOF+j+1+nDOF0*nDOF1, numShared);
2449                                  }                                  }
2450                                  m_dofMap[firstNode+j]=numDOF+numShared;                                  m_dofMap[firstNode+j]=numDOF+numShared;
2451                              }                              }
# Line 1966  void Brick::createPattern() Line 2457  void Brick::createPattern()
2457                              const int firstDOF=(i0==-1 ? i*nDOF0*nDOF1                              const int firstDOF=(i0==-1 ? i*nDOF0*nDOF1
2458                                      : nDOF0*(1+i*nDOF1)-1);                                      : nDOF0*(1+i*nDOF1)-1);
2459                              const int firstNode=(i0==-1 ?                              const int firstNode=(i0==-1 ?
2460                                      (bottom+(i+front)*m_N1)*m_N0                                      (bottom+(i+front)*m_NN[1])*m_NN[0]
2461                                      : (bottom+1+(i+front)*m_N1)*m_N0-1);                                      : (bottom+1+(i+front)*m_NN[1])*m_NN[0]-1);
2462                              for (dim_t j=0; j<nDOF1; j++, numShared++) {                              for (dim_t j=0; j<nDOF1; j++, numShared++) {
2463                                  sendShared.push_back(firstDOF+j*nDOF0);                                  sendShared.push_back(firstDOF+j*nDOF0);
2464                                  recvShared.push_back(numDOF+numShared);                                  recvShared.push_back(numDOF+numShared);
2465                                  if (j>0) {                                  if (j>0) {
2466                                      if (i>0)                                      if (i>0)
2467                                          colIndices[firstDOF+(j-1)*nDOF0-nDOF0*nDOF1].push_back(numShared);                                          doublyLink(colIndices, rowIndices, firstDOF+(j-1)*nDOF0-nDOF0*nDOF1, numShared);
2468                                      colIndices[firstDOF+(j-1)*nDOF0].push_back(numShared);                                      doublyLink(colIndices, rowIndices, firstDOF+(j-1)*nDOF0, numShared);
2469                                      if (i<nDOF2-1)                                      if (i<nDOF2-1)
2470                                          colIndices[firstDOF+(j-1)*nDOF0+nDOF0*nDOF1].push_back(numShared);                                          doublyLink(colIndices, rowIndices, firstDOF+(j-1)*nDOF0+nDOF0*nDOF1, numShared);
2471                                  }                                  }
2472                                  if (i>0)                                  if (i>0)
2473                                      colIndices[firstDOF+j*nDOF0-nDOF0*nDOF1].push_back(numShared);                                      doublyLink(colIndices, rowIndices, firstDOF+j*nDOF0-nDOF0*nDOF1, numShared);
2474                                  colIndices[firstDOF+j*nDOF0].push_back(numShared);                                  doublyLink(colIndices, rowIndices, firstDOF+j*nDOF0, numShared);
2475                                  if (i<nDOF2-1)                                  if (i<nDOF2-1)
2476                                      colIndices[firstDOF+j*nDOF0+nDOF0*nDOF1].push_back(numShared);                                      doublyLink(colIndices, rowIndices, firstDOF+j*nDOF0+nDOF0*nDOF1, numShared);
2477                                  if (j<nDOF1-1) {                                  if (j<nDOF1-1) {
2478                                      if (i>0)                                      if (i>0)
2479                                          colIndices[firstDOF+(j+1)*nDOF0-nDOF0*nDOF1].push_back(numShared);                                          doublyLink(colIndices, rowIndices, firstDOF+(j+1)*nDOF0-nDOF0*nDOF1, numShared);
2480                                      colIndices[firstDOF+(j+1)*nDOF0].push_back(numShared);                                      doublyLink(colIndices, rowIndices, firstDOF+(j+1)*nDOF0, numShared);
2481                                      if (i<nDOF2-1)                                      if (i<nDOF2-1)
2482                                          colIndices[firstDOF+(j+1)*nDOF0+nDOF0*nDOF1].push_back(numShared);                                          doublyLink(colIndices, rowIndices, firstDOF+(j+1)*nDOF0+nDOF0*nDOF1, numShared);
2483                                  }                                  }
2484                                  m_dofMap[firstNode+j*m_N0]=numDOF+numShared;                                  m_dofMap[firstNode+j*m_NN[0]]=numDOF+numShared;
2485                              }                              }
2486                          }                          }
2487                      } else if (i0==0) {                      } else if (i0==0) {
# Line 1998  void Brick::createPattern() Line 2489  void Brick::createPattern()
2489                          offsetInShared.push_back(offsetInShared.back()+nDOF0);                          offsetInShared.push_back(offsetInShared.back()+nDOF0);
2490                          const int firstDOF=(i1+1)/2*nDOF0*(nDOF1-1)                          const int firstDOF=(i1+1)/2*nDOF0*(nDOF1-1)
2491                                             +(i2+1)/2*nDOF0*nDOF1*(nDOF2-1);                                             +(i2+1)/2*nDOF0*nDOF1*(nDOF2-1);
2492                          const int firstNode=left+(i1+1)/2*m_N0*(m_N1-1)                          const int firstNode=left+(i1+1)/2*m_NN[0]*(m_NN[1]-1)
2493                                              +(i2+1)/2*m_N0*m_N1*(m_N2-1);                                              +(i2+1)/2*m_NN[0]*m_NN[1]*(m_NN[2]-1);
2494                          for (dim_t i=0; i<nDOF0; i++, numShared++) {                          for (dim_t i=0; i<nDOF0; i++, numShared++) {
2495                              sendShared.push_back(firstDOF+i);                              sendShared.push_back(firstDOF+i);
2496                              recvShared.push_back(numDOF+numShared);                              recvShared.push_back(numDOF+numShared);
2497                              if (i>0)                              if (i>0)
2498                                  colIndices[firstDOF+i-1].push_back(numShared);                                  doublyLink(colIndices, rowIndices, firstDOF+i-1, numShared);
2499                              colIndices[firstDOF+i].push_back(numShared);                              doublyLink(colIndices, rowIndices, firstDOF+i, numShared);
2500                              if (i<nDOF0-1)                              if (i<nDOF0-1)
2501                                  colIndices[firstDOF+i+1].push_back(numShared);                                  doublyLink(colIndices, rowIndices, firstDOF+i+1, numShared);
2502                              m_dofMap[firstNode+i]=numDOF+numShared;                              m_dofMap[firstNode+i]=numDOF+numShared;
2503                          }                          }
2504                      } else if (i1==0) {                      } else if (i1==0) {
# Line 2015  void Brick::createPattern() Line 2506  void Brick::createPattern()
2506                          offsetInShared.push_back(offsetInShared.back()+nDOF1);                          offsetInShared.push_back(offsetInShared.back()+nDOF1);
2507                          const int firstDOF=(i0+1)/2*(nDOF0-1)                          const int firstDOF=(i0+1)/2*(nDOF0-1)
2508                                             +(i2+1)/2*nDOF0*nDOF1*(nDOF2-1);                                             +(i2+1)/2*nDOF0*nDOF1*(nDOF2-1);
2509                          const int firstNode=bottom*m_N0                          const int firstNode=bottom*m_NN[0]
2510                                              +(i0+1)/2*(m_N0-1)                                              +(i0+1)/2*(m_NN[0]-1)
2511                                              +(i2+1)/2*m_N0*m_N1*(m_N2-1);                                              +(i2+1)/2*m_NN[0]*m_NN[1]*(m_NN[2]-1);
2512                          for (dim_t i=0; i<nDOF1; i++, numShared++) {                          for (dim_t i=0; i<nDOF1; i++, numShared++) {
2513                              sendShared.push_back(firstDOF+i*nDOF0);                              sendShared.push_back(firstDOF+i*nDOF0);
2514                              recvShared.push_back(numDOF+numShared);                              recvShared.push_back(numDOF+numShared);
2515                              if (i>0)                              if (i>0)
2516                                  colIndices[firstDOF+(i-1)*nDOF0].push_back(numShared);                                  doublyLink(colIndices, rowIndices, firstDOF+(i-1)*nDOF0, numShared);
2517                              colIndices[firstDOF+i*nDOF0].push_back(numShared);                              doublyLink(colIndices, rowIndices, firstDOF+i*nDOF0, numShared);
2518                              if (i<nDOF1-1)                              if (i<nDOF1-1)
2519                                  colIndices[firstDOF+(i+1)*nDOF0].push_back(numShared);                                  doublyLink(colIndices, rowIndices, firstDOF+(i+1)*nDOF0, numShared);
2520                              m_dofMap[firstNode+i*m_N0]=numDOF+numShared;                              m_dofMap[firstNode+i*m_NN[0]]=numDOF+numShared;
2521                          }                          }
2522                      } else if (i2==0) {                      } else if (i2==0) {
2523                          // sharing an edge in z direction                          // sharing an edge in z direction
2524                          offsetInShared.push_back(offsetInShared.back()+nDOF2);                          offsetInShared.push_back(offsetInShared.back()+nDOF2);
2525                          const int firstDOF=(i0+1)/2*(nDOF0-1)                          const int firstDOF=(i0+1)/2*(nDOF0-1)
2526                                             +(i1+1)/2*nDOF0*(nDOF1-1);                                             +(i1+1)/2*nDOF0*(nDOF1-1);
2527                          const int firstNode=front*m_N0*m_N1                          const int firstNode=front*m_NN[0]*m_NN[1]
2528                                              +(i0+1)/2*(m_N0-1)                                              +(i0+1)/2*(m_NN[0]-1)
2529                                              +(i1+1)/2*m_N0*(m_N1-1);                                              +(i1+1)/2*m_NN[0]*(m_NN[1]-1);
2530                          for (dim_t i=0; i<nDOF2; i++, numShared++) {                          for (dim_t i=0; i<nDOF2; i++, numShared++) {
2531                              sendShared.push_back(firstDOF+i*nDOF0*nDOF1);                              sendShared.push_back(firstDOF+i*nDOF0*nDOF1);
2532                              recvShared.push_back(numDOF+numShared);                              recvShared.push_back(numDOF+numShared);
2533                              if (i>0)                              if (i>0)
2534                                  colIndices[firstDOF+(i-1)*nDOF0*nDOF1].push_back(numShared);                                  doublyLink(colIndices, rowIndices, firstDOF+(i-1)*nDOF0*nDOF1, numShared);
2535                              colIndices[firstDOF+i*nDOF0*nDOF1].push_back(numShared);                              doublyLink(colIndices, rowIndices, firstDOF+i*nDOF0*nDOF1, numShared);
2536                              if (i<nDOF2-1)                              if (i<nDOF2-1)
2537                                  colIndices[firstDOF+(i+1)*nDOF0*nDOF1].push_back(numShared);                                  doublyLink(colIndices, rowIndices, firstDOF+(i+1)*nDOF0*nDOF1, numShared);
2538                              m_dofMap[firstNode+i*m_N0*m_N1]=numDOF+numShared;                              m_dofMap[firstNode+i*m_NN[0]*m_NN[1]]=numDOF+numShared;
2539                          }                          }
2540                      } else {                      } else {
2541                          // sharing a node                          // sharing a node
2542                          const int dof=(i0+1)/2*(nDOF0-1)                          const int dof=(i0+1)/2*(nDOF0-1)
2543                                        +(i1+1)/2*nDOF0*(nDOF1-1)                                        +(i1+1)/2*nDOF0*(nDOF1-1)
2544                                        +(i2+1)/2*nDOF0*nDOF1*(nDOF2-1);                                        +(i2+1)/2*nDOF0*nDOF1*(nDOF2-1);
2545                          const int node=(i0+1)/2*(m_N0-1)                          const int node=(i0+1)/2*(m_NN[0]-1)
2546                                         +(i1+1)/2*m_N0*(m_N1-1)                                         +(i1+1)/2*m_NN[0]*(m_NN[1]-1)
2547                                         +(i2+1)/2*m_N0*m_N1*(m_N2-1);                                         +(i2+1)/2*m_NN[0]*m_NN[1]*(m_NN[2]-1);
2548                          offsetInShared.push_back(offsetInShared.back()+1);                          offsetInShared.push_back(offsetInShared.back()+1);
2549                          sendShared.push_back(dof);                          sendShared.push_back(dof);
2550                          recvShared.push_back(numDOF+numShared);                          recvShared.push_back(numDOF+numShared);
2551                          colIndices[dof].push_back(numShared);                          doublyLink(colIndices, rowIndices, dof, numShared);
2552                          m_dofMap[node]=numDOF+numShared;                          m_dofMap[node]=numDOF+numShared;
2553                          ++numShared;                          ++numShared;
2554                      }                      }
# Line 2066  void Brick::createPattern() Line 2557  void Brick::createPattern()
2557          }          }
2558      }      }
2559    
2560    #pragma omp parallel for
2561        for (int i = 0; i < numShared; i++) {
2562            std::sort(rowIndices[i].begin(), rowIndices[i].end());
2563        }
2564    
2565      // create connector      // create connector
2566      Paso_SharedComponents *snd_shcomp = Paso_SharedComponents_alloc(      Paso_SharedComponents *snd_shcomp = Paso_SharedComponents_alloc(
2567              numDOF, neighbour.size(), &neighbour[0], &sendShared[0],              numDOF, neighbour.size(), &neighbour[0], &sendShared[0],
# Line 2080  void Brick::createPattern() Line 2576  void Brick::createPattern()
2576      // create main and couple blocks      // create main and couple blocks
2577      Paso_Pattern *mainPattern = createMainPattern();      Paso_Pattern *mainPattern = createMainPattern();
2578      Paso_Pattern *colPattern, *rowPattern;      Paso_Pattern *colPattern, *rowPattern;
2579      createCouplePatterns(colIndices, numShared, &colPattern, &rowPattern);      createCouplePatterns(colIndices, rowIndices, numShared, &colPattern, &rowPattern);
2580    
2581      // allocate paso distribution      // allocate paso distribution
2582      Paso_Distribution* distribution = Paso_Distribution_alloc(m_mpiInfo,      Paso_Distribution* distribution = Paso_Distribution_alloc(m_mpiInfo,
# Line 2164  void Brick::addToMatrixAndRHS(Paso_Syste Line 2660  void Brick::addToMatrixAndRHS(Paso_Syste
2660      IndexVector rowIndex;      IndexVector rowIndex;
2661      rowIndex.push_back(m_dofMap[firstNode]);      rowIndex.push_back(m_dofMap[firstNode]);
2662      rowIndex.push_back(m_dofMap[firstNode+1]);      rowIndex.push_back(m_dofMap[firstNode+1]);
2663      rowIndex.push_back(m_dofMap[firstNode+m_N0]);      rowIndex.push_back(m_dofMap[firstNode+m_NN[0]]);
2664      rowIndex.push_back(m_dofMap[firstNode+m_N0+1]);      rowIndex.push_back(m_dofMap[firstNode+m_NN[0]+1]);
2665      rowIndex.push_back(m_dofMap[firstNode+m_N0*m_N1]);      rowIndex.push_back(m_dofMap[firstNode+m_NN[0]*m_NN[1]]);
2666      rowIndex.push_back(m_dofMap[firstNode+m_N0*m_N1+1]);      rowIndex.push_back(m_dofMap[firstNode+m_NN[0]*m_NN[1]+1]);
2667      rowIndex.push_back(m_dofMap[firstNode+m_N0*(m_N1+1)]);      rowIndex.push_back(m_dofMap[firstNode+m_NN[0]*(m_NN[1]+1)]);
2668      rowIndex.push_back(m_dofMap[firstNode+m_N0*(m_N1+1)+1]);      rowIndex.push_back(m_dofMap[firstNode+m_NN[0]*(m_NN[1]+1)+1]);
2669      if (addF) {      if (addF) {
2670          double *F_p=F.getSampleDataRW(0);          double *F_p=F.getSampleDataRW(0);
2671          for (index_t i=0; i<rowIndex.size(); i++) {          for (index_t i=0; i<rowIndex.size(); i++) {
# Line 2186  void Brick::addToMatrixAndRHS(Paso_Syste Line 2682  void Brick::addToMatrixAndRHS(Paso_Syste
2682  }  }
2683    
2684  //protected  //protected
2685  void Brick::interpolateNodesOnElements(escript::Data& out, escript::Data& in,  void Brick::interpolateNodesOnElements(escript::Data& out,
2686                                           const escript::Data& in,
2687                                         bool reduced) const                                         bool reduced) const
2688  {  {
2689      const dim_t numComp = in.getDataPointSize();      const dim_t numComp = in.getDataPointSize();
2690      if (reduced) {      if (reduced) {
2691          out.requireWrite();          out.requireWrite();
         const double c0 = .125;  
2692  #pragma omp parallel  #pragma omp parallel
2693          {          {
2694              vector<double> f_000(numComp);              vector<double> f_000(numComp);
# Line 2204  void Brick::interpolateNodesOnElements(e Line 2700  void Brick::interpolateNodesOnElements(e
2700              vector<double> f_110(numComp);              vector<double> f_110(numComp);
2701              vector<double> f_111(numComp);              vector<double> f_111(numComp);
2702  #pragma omp for  #pragma omp for
2703              for (index_t k2=0; k2 < m_NE2; ++k2) {              for (index_t k2=0; k2 < m_NE[2]; ++k2) {
2704                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1=0; k1 < m_NE[1]; ++k1) {
2705                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE[0]; ++k0) {
2706                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
2707                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
2708                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
2709                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
2710                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
2711                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
2712                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
2713                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
2714                          double* o = out.getSampleDataRW(INDEX3(k0,k1,k2,m_NE0,m_NE1));                          double* o = out.getSampleDataRW(INDEX3(k0,k1,k2,m_NE[0],m_NE[1]));
2715                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2716                              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]);                              o[INDEX2(i,numComp,0)] = (f_000[i] + f_001[i] + f_010[i] + f_011[i] + f_100[i] + f_101[i] + f_110[i] + f_111[i])/8;
2717                          } // end of component loop i                          } // end of component loop i
2718                      } // end of k0 loop                      } // end of k0 loop
2719                  } // end of k1 loop                  } // end of k1 loop
# Line 2240  void Brick::interpolateNodesOnElements(e Line 2736  void Brick::interpolateNodesOnElements(e
2736              vector<double> f_110(numComp);              vector<double> f_110(numComp);
2737              vector<double> f_111(numComp);              vector<double> f_111(numComp);
2738  #pragma omp for  #pragma omp for
2739              for (index_t k2=0; k2 < m_NE2; ++k2) {              for (index_t k2=0; k2 < m_NE[2]; ++k2) {
2740                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1=0; k1 < m_NE[1]; ++k1) {
2741                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE[0]; ++k0) {
2742                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
2743                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
2744                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
2745                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
2746                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
2747                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
2748                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
2749                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
2750                          double* o = out.getSampleDataRW(INDEX3(k0,k1,k2,m_NE0,m_NE1));                          double* o = out.getSampleDataRW(INDEX3(k0,k1,k2,m_NE[0],m_NE[1]));
2751                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2752                              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]);                              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]);
2753                              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]);                              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]);
# Line 2270  void Brick::interpolateNodesOnElements(e Line 2766  void Brick::interpolateNodesOnElements(e
2766  }  }
2767    
2768  //protected  //protected
2769  void Brick::interpolateNodesOnFaces(escript::Data& out, escript::Data& in,  void Brick::interpolateNodesOnFaces(escript::Data& out, const escript::Data& in,
2770                                      bool reduced) const                                      bool reduced) const
2771  {  {
2772      const dim_t numComp = in.getDataPointSize();      const dim_t numComp = in.getDataPointSize();
2773      if (reduced) {      if (reduced) {
2774          out.requireWrite();          out.requireWrite();
         const double c0 = .25;  
2775  #pragma omp parallel  #pragma omp parallel
2776          {          {
2777              vector<double> f_000(numComp);              vector<double> f_000(numComp);
# Line 2289  void Brick::interpolateNodesOnFaces(escr Line 2784  void Brick::interpolateNodesOnFaces(escr
2784              vector<double> f_111(numComp);              vector<double> f_111(numComp);
2785              if (m_faceOffset[0] > -1) {              if (m_faceOffset[0] > -1) {
2786  #pragma omp for nowait  #pragma omp for nowait
2787                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE[2]; ++k2) {
2788                      for (index_t k1=0; k1 < m_NE1; ++k1) {                      for (index_t k1=0; k1 < m_NE[1]; ++k1) {
2789                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(0,k1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(0,k1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
2790                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(0,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(0,k1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
2791                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(0,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(0,k1+1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
2792                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(0,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(0,k1+1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
2793                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE[1]));
2794                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2795                              o[INDEX2(i,numComp,0)] = c0*(f_000[i] + f_001[i] + f_010[i] + f_011[i]);                              o[INDEX2(i,numComp,0)] = (f_000[i] + f_001[i] + f_010[i] + f_011[i])/4;
2796                          } // end of component loop i                          } // end of component loop i
2797                      } // end of k1 loop                      } // end of k1 loop
2798                  } // end of k2 loop                  } // end of k2 loop
2799              } // end of face 0              } // end of face 0
2800              if (m_faceOffset[1] > -1) {              if (m_faceOffset[1] > -1) {
2801  #pragma omp for nowait  #pragma omp for nowait
2802                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE[2]; ++k2) {
2803                      for (index_t k1=0; k1 < m_NE1; ++k1) {                      for (index_t k1=0; k1 < m_NE[1]; ++k1) {
2804                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(m_N0-1,k1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(m_NN[0]-1,k1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
2805                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(m_N0-1,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(m_NN[0]-1,k1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
2806                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(m_N0-1,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(m_NN[0]-1,k1+1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
2807                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(m_N0-1,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(m_NN[0]-1,k1+1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
2808                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE[1]));
2809                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2810                              o[INDEX2(i,numComp,0)] = c0*(f_100[i] + f_101[i] + f_110[i] + f_111[i]);                              o[INDEX2(i,numComp,0)] = (f_100[i] + f_101[i] + f_110[i] + f_111[i])/4;
2811                          } // end of component loop i                          } // end of component loop i
2812                      } // end of k1 loop                      } // end of k1 loop
2813                  } // end of k2 loop                  } // end of k2 loop
2814              } // end of face 1              } // end of face 1
2815              if (m_faceOffset[2] > -1) {              if (m_faceOffset[2] > -1) {
2816  #pragma omp for nowait  #pragma omp for nowait
2817                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE[2]; ++k2) {
2818                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE[0]; ++k0) {
2819                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,0,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,0,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
2820                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,0,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,0,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
2821                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,0,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,0,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
2822                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,0,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,0,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
2823                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE[0]));
2824                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2825                              o[INDEX2(i,numComp,0)] = c0*(f_000[i] + f_001[i] + f_100[i] + f_101[i]);                              o[INDEX2(i,numComp,0)] = (f_000[i] + f_001[i] + f_100[i] + f_101[i])/4;
2826                          } // end of component loop i                          } // end of component loop i
2827                      } // end of k0 loop                      } // end of k0 loop
2828                  } // end of k2 loop                  } // end of k2 loop
2829              } // end of face 2              } // end of face 2
2830              if (m_faceOffset[3] > -1) {              if (m_faceOffset[3] > -1) {
2831  #pragma omp for nowait  #pragma omp for nowait
2832                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE[2]; ++k2) {
2833                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE[0]; ++k0) {
2834                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,m_N1-1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,m_NN[1]-1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
2835                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,m_N1-1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,m_NN[1]-1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
2836                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,m_NN[1]-1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
2837                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,m_NN[1]-1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
2838                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE[0]));
2839                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2840                              o[INDEX2(i,numComp,0)] = c0*(f_010[i] + f_011[i] + f_110[i] + f_111[i]);                              o[INDEX2(i,numComp,0)] = (f_010[i] + f_011[i] + f_110[i] + f_111[i])/4;
2841                          } // end of component loop i                          } // end of component loop i
2842                      } // end of k0 loop                      } // end of k0 loop
2843                  } // end of k2 loop                  } // end of k2 loop
2844              } // end of face 3              } // end of face 3
2845              if (m_faceOffset[4] > -1) {              if (m_faceOffset[4] > -1) {
2846  #pragma omp for nowait  #pragma omp for nowait
2847                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1=0; k1 < m_NE[1]; ++k1) {
2848                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE[0]; ++k0) {
2849                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,0, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,0, m_NN[0],m_NN[1])), numComp*sizeof(double));
2850                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,0, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,0, m_NN[0],m_NN[1])), numComp*sizeof(double));
2851                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,0, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,0, m_NN[0],m_NN[1])), numComp*sizeof(double));
2852                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,0, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,0, m_NN[0],m_NN[1])), numComp*sizeof(double));
2853                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE[0]));
2854                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2855                              o[INDEX2(i,numComp,0)] = c0*(f_000[i] + f_010[i] + f_100[i] + f_110[i]);                              o[INDEX2(i,numComp,0)] = (f_000[i] + f_010[i] + f_100[i] + f_110[i])/4;
2856                          } // end of component loop i                          } // end of component loop i
2857                      } // end of k0 loop                      } // end of k0 loop
2858                  } // end of k1 loop                  } // end of k1 loop
2859              } // end of face 4              } // end of face 4
2860              if (m_faceOffset[5] > -1) {              if (m_faceOffset[5] > -1) {
2861  #pragma omp for nowait  #pragma omp for nowait
2862                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1=0; k1 < m_NE[1]; ++k1) {
2863                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE[0]; ++k0) {
2864                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,m_NN[2]-1, m_NN[0],m_NN[1])), numComp*sizeof(double));
2865                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,m_NN[2]-1, m_NN[0],m_NN[1])), numComp*sizeof(double));
2866                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,m_NN[2]-1, m_NN[0],m_NN[1])), numComp*sizeof(double));
2867                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,m_NN[2]-1, m_NN[0],m_NN[1])), numComp*sizeof(double));
2868                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE[0]));
2869                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2870                              o[INDEX2(i,numComp,0)] = c0*(f_001[i] + f_011[i] + f_101[i] + f_111[i]);                              o[INDEX2(i,numComp,0)] = (f_001[i] + f_011[i] + f_101[i] + f_111[i])/4;
2871                          } // end of component loop i                          } // end of component loop i
2872                      } // end of k0 loop                      } // end of k0 loop
2873                  } // end of k1 loop                  } // end of k1 loop
# Line 2395  void Brick::interpolateNodesOnFaces(escr Line 2890  void Brick::interpolateNodesOnFaces(escr
2890              vector<double> f_111(numComp);              vector<double> f_111(numComp);
2891              if (m_faceOffset[0] > -1) {              if (m_faceOffset[0] > -1) {
2892  #pragma omp for nowait  #pragma omp for nowait
2893                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE[2]; ++k2) {
2894                      for (index_t k1=0; k1 < m_NE1; ++k1) {                      for (index_t k1=0; k1 < m_NE[1]; ++k1) {
2895                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(0,k1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(0,k1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
2896                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(0,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(0,k1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
2897                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(0,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(0,k1+1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
2898                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(0,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(0,k1+1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
2899                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE[1]));
2900                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2901                              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]);
2902                              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]);
# Line 2413  void Brick::interpolateNodesOnFaces(escr Line 2908  void Brick::interpolateNodesOnFaces(escr
2908              } // end of face 0              } // end of face 0
2909              if (m_faceOffset[1] > -1) {              if (m_faceOffset[1] > -1) {
2910  #pragma omp for nowait  #pragma omp for nowait
2911                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE[2]; ++k2) {
2912                      for (index_t k1=0; k1 < m_NE1; ++k1) {                      for (index_t k1=0; k1 < m_NE[1]; ++k1) {
2913                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(m_N0-1,k1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(m_NN[0]-1,k1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
2914                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(m_N0-1,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(m_NN[0]-1,k1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
2915                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(m_N0-1,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(m_NN[0]-1,k1+1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
2916                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(m_N0-1,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(m_NN[0]-1,k1+1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
2917                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE[1]));
2918                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2919                              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]);
2920                              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]);
# Line 2431  void Brick::interpolateNodesOnFaces(escr Line 2926  void Brick::interpolateNodesOnFaces(escr
2926              } // end of face 1              } // end of face 1
2927              if (m_faceOffset[2] > -1) {              if (m_faceOffset[2] > -1) {
2928  #pragma omp for nowait  #pragma omp for nowait
2929                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE[2]; ++k2) {
2930                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE[0]; ++k0) {
2931                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,0,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,0,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
2932                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,0,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,0,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
2933                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,0,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,0,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
2934                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,0,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,0,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
2935                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE[0]));
2936                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2937                              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]);
2938                              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]);
# Line 2449  void Brick::interpolateNodesOnFaces(escr Line 2944  void Brick::interpolateNodesOnFaces(escr
2944              } // end of face 2              } // end of face 2
2945              if (m_faceOffset[3] > -1) {              if (m_faceOffset[3] > -1) {
2946  #pragma omp for nowait  #pragma omp for nowait
2947                  for (index_t k2=0; k2 < m_NE2; ++k2) {                  for (index_t k2=0; k2 < m_NE[2]; ++k2) {
2948                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE[0]; ++k0) {
2949                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,m_N1-1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,m_NN[1]-1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
2950                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,m_N1-1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,m_NN[1]-1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
2951                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-1,k2, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,m_NN[1]-1,k2, m_NN[0],m_NN[1])), numComp*sizeof(double));
2952                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-1,k2+1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,m_NN[1]-1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
2953                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE[0]));
2954                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2955                              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]);
2956                              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]);
# Line 2467  void Brick::interpolateNodesOnFaces(escr Line 2962  void Brick::interpolateNodesOnFaces(escr
2962              } // end of face 3              } // end of face 3
2963              if (m_faceOffset[4] > -1) {              if (m_faceOffset[4] > -1) {
2964  #pragma omp for nowait  #pragma omp for nowait
2965                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1=0; k1 < m_NE[1]; ++k1) {
2966                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE[0]; ++k0) {
2967                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,0, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,0, m_NN[0],m_NN[1])), numComp*sizeof(double));
2968                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,0, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,0, m_NN[0],m_NN[1])), numComp*sizeof(double));
2969                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,0, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,0, m_NN[0],m_NN[1])), numComp*sizeof(double));
2970                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,0, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,0, m_NN[0],m_NN[1])), numComp*sizeof(double));
2971                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE[0]));
2972                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2973                              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]);
2974                              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]);
# Line 2485  void Brick::interpolateNodesOnFaces(escr Line 2980  void Brick::interpolateNodesOnFaces(escr
2980              } // end of face 4              } // end of face 4
2981              if (m_faceOffset[5] > -1) {              if (m_faceOffset[5] > -1) {
2982  #pragma omp for nowait  #pragma omp for nowait
2983                  for (index_t k1=0; k1 < m_NE1; ++k1) {                  for (index_t k1=0; k1 < m_NE[1]; ++k1) {
2984                      for (index_t k0=0; k0 < m_NE0; ++k0) {                      for (index_t k0=0; k0 < m_NE[0]; ++k0) {
2985                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,m_NN[2]-1, m_NN[0],m_NN[1])), numComp*sizeof(double));
2986                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,m_NN[2]-1, m_NN[0],m_NN[1])), numComp*sizeof(double));
2987                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,m_NN[2]-1, m_NN[0],m_NN[1])), numComp*sizeof(double));
2988                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,m_NN[2]-1, m_NN[0],m_NN[1])), numComp*sizeof(double));
2989                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE[0]));
2990                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2991                              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]);
2992                              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]);
# Line 2505  void Brick::interpolateNodesOnFaces(escr Line 3000  void Brick::interpolateNodesOnFaces(escr
3000      }      }
3001  }  }
3002    
3003  //protected  namespace
 void Brick::assemblePDESingle(Paso_SystemMatrix* mat, escript::Data& rhs,  
         const escript::Data& A, const escript::Data& B,  
         const escript::Data& C, const escript::Data& D,  
         const escript::Data& X, const escript::Data& Y) const  
3004  {  {
3005      const double h0 = m_l0/m_gNE0;      // Calculates a guassian blur colvolution matrix for 3D
3006      const double h1 = m_l1/m_gNE1;      // See wiki article on the subject
3007      const double h2 = m_l2/m_gNE2;      double* get3DGauss(unsigned radius, double sigma)
     const double w0 = 0.0009303791403858427308*h1*h2/h0;  
     const double w1 = 0.0009303791403858427308*h2;  
     const double w2 = -0.00024929433932114870101*h1;  
     const double w3 = 0.0009303791403858427308*h0*h2/h1;  
     const double w4 = -0.00024929433932114870101*h0;  
     const double w5 = 0.0009303791403858427308*h1;  
     const double w6 = 0.0009303791403858427308*h0;  
     const double w7 = -0.00024929433932114870101*h0*h1/h2;  
     const double w8 = 0.0034722222222222222222*h2;  
     const double w9 = -0.0009303791403858427308*h1;  
     const double w10 = 0.012958509748503046158*h0*h2/h1;  
     const double w11 = -0.0034722222222222222222*h0;  
     const double w12 = 0.0034722222222222222222*h1;  
     const double w13 = 0.012958509748503046158*h0;  
     const double w14 = -0.0034722222222222222222*h0*h1/h2;  
     const double w15 = 0.012958509748503046158*h1*h2/h0;  
     const double w16 = -0.0034722222222222222222*h1;  
     const double w17 = -0.0009303791403858427308*h0;  
     const double w18 = 0.012958509748503046158*h1;  
     const double w19 = 0.0034722222222222222222*h0;  
     const double w20 = 0.012958509748503046158*h2;  
     const double w21 = -0.012958509748503046158*h1;  
     const double w22 = -0.012958509748503046158*h0;  
     const double w23 = 0.04836181677178996241*h1;  
     const double w24 = 0.04836181677178996241*h0;  
     const double w25 = -0.04836181677178996241*h0*h1/h2;  
     const double w26 = 0.00024929433932114870101*h1;  
     const double w27 = 0.00024929433932114870101*h0;  
     const double w28 = -0.04836181677178996241*h1;  
     const double w29 = -0.04836181677178996241*h0;  
     const double w30 = -0.0009303791403858427308*h1*h2/h0;  
     const double w31 = -0.0009303791403858427308*h2;  
     const double w32 = -0.0009303791403858427308*h0*h2/h1;  
     const double w33 = 0.0034722222222222222222*h0*h1/h2;  
     const double w34 = -0.0034722222222222222222*h2;  
     const double w35 = -0.00024929433932114870101*h2;  
     const double w36 = -0.012958509748503046158*h1*h2/h0;  
     const double w37 = -0.012958509748503046158*h2;  
     const double w38 = -0.012958509748503046158*h0*h2/h1;  
     const double w39 = -0.04836181677178996241*h2;  
     const double w40 = -0.0034722222222222222222*h0*h2/h1;  
     const double w41 = 0.0009303791403858427308*h0*h1/h2;  
     const double w42 = 0.04836181677178996241*h2;  
     const double w43 = -0.04836181677178996241*h0*h2/h1;  
     const double w44 = 0.012958509748503046158*h0*h1/h2;  
     const double w45 = -0.00024929433932114870101*h0*h2/h1;  
     const double w46 = 0.00024929433932114870101*h2;  
     const double w47 = -0.0034722222222222222222*h1*h2/h0;  
     const double w48 = -0.00024929433932114870101*h1*h2/h0;  
     const double w49 = -0.04836181677178996241*h1*h2/h0;  
     const double w50 = 0.0034722222222222222222*h0*h2/h1;  
     const double w51 = -0.0009303791403858427308*h0*h1/h2;  
     const double w52 = -0.012958509748503046158*h0*h1/h2;  
     const double w53 = 0.0034722222222222222222*h1*h2/h0;  
     const double w54 = 0.00024929433932114870101*h0*h1/h2;  
     const double w55 = 0.04836181677178996241*h0*h2/h1;  
     const double w56 = 0.04836181677178996241*h1*h2/h0;  
     const double w57 = 0.04836181677178996241*h0*h1/h2;  
     const double w58 = 0.00024929433932114870101*h1*h2/h0;  
     const double w59 = 0.00024929433932114870101*h0*h2/h1;  
     const double w60 = 0.055555555555555555556*h1*h2/h0;  
     const double w61 = 0.041666666666666666667*h2;  
     const double w62 = -0.083333333333333333333*h1;  
     const double w63 = 0.055555555555555555556*h0*h2/h1;  
     const double w64 = -0.083333333333333333333*h0;  
     const double w65 = 0.083333333333333333333*h1;  
     const double w66 = 0.083333333333333333333*h0;  
     const double w67 = -0.11111111111111111111*h0*h1/h2;  
     const double w68 = -0.055555555555555555556*h1*h2/h0;  
     const double w69 = -0.083333333333333333333*h2;  
     const double w70 = -0.041666666666666666667*h1;  
     const double w71 = -0.055555555555555555556*h0*h2/h1;  
     const double w72 = -0.041666666666666666667*h0;  
     const double w73 = 0.041666666666666666667*h1;  
     const double w74 = 0.041666666666666666667*h0;  
     const double w75 = 0.027777777777777777778*h0*h1/h2;  
     const double w76 = 0.083333333333333333333*h2;  
     const double w77 = -0.11111111111111111111*h0*h2/h1;  
     const double w78 = 0.055555555555555555556*h0*h1/h2;  
     const double w79 = -0.11111111111111111111*h1*h2/h0;  
     const double w80 = -0.027777777777777777778*h1*h2/h0;  
     const double w81 = -0.041666666666666666667*h2;  
     const double w82 = -0.027777777777777777778*h0*h2/h1;  
     const double w83 = -0.027777777777777777778*h0*h1/h2;  
     const double w84 = 0.027777777777777777778*h0*h2/h1;  
     const double w85 = -0.055555555555555555556*h0*h1/h2;  
     const double w86 = 0.11111111111111111111*h1*h2/h0;  
     const double w87 = 0.11111111111111111111*h0*h2/h1;  
     const double w88 = 0.11111111111111111111*h0*h1/h2;  
     const double w89 = 0.027777777777777777778*h1*h2/h0;  
     const double w90 = 0.0001966122466178319053*h1*h2;  
     const double w91 = 0.0001966122466178319053*h0*h2;  
     const double w92 = 0.0001966122466178319053*h0*h1;  
     const double w93 = 0.0007337668937680108255*h1*h2;  
     const double w94 = 0.0027384553284542113967*h0*h2;  
     const double w95 = 0.0027384553284542113967*h0*h1;  
     const double w96 = 0.0027384553284542113967*h1*h2;  
     const double w97 = 0.0007337668937680108255*h0*h2;  
     const double w98 = 0.010220054420048834761*h1*h2;  
     const double w99 = 0.010220054420048834761*h0*h2;  
     const double w100 = 0.038141762351741127649*h0*h1;  
     const double w101 = 0.000052682092703316795705*h0*h1;  
     const double w102 = 0.0007337668937680108255*h0*h1;  
     const double w103 = 0.010220054420048834761*h0*h1;  
     const double w104 = -0.0001966122466178319053*h1*h2;  
     const double w105 = -0.0001966122466178319053*h0*h2;  
     const double w106 = -0.0007337668937680108255*h1*h2;  
     const double w107 = -0.0007337668937680108255*h0*h2;  
     const double w108 = -0.0027384553284542113967*h1*h2;  
     const double w109 = -0.0027384553284542113967*h0*h2;  
     const double w110 = -0.010220054420048834761*h1*h2;  
     const double w111 = -0.010220054420048834761*h0*h2;  
     const double w112 = -0.0007337668937680108255*h0*h1;  
     const double w113 = -0.010220054420048834761*h0*h1;  
     const double w114 = -0.038141762351741127649*h0*h2;  
     const double w115 = -0.000052682092703316795705*h0*h2;  
     const double w116 = -0.0001966122466178319053*h0*h1;  
     const double w117 = -0.0027384553284542113967*h0*h1;  
     const double w118 = 0.000052682092703316795705*h0*h2;  
     const double w119 = 0.038141762351741127649*h0*h2;  
     const double w120 = 0.000052682092703316795705*h1*h2;  
     const double w121 = 0.038141762351741127649*h1*h2;  
     const double w122 = -0.000052682092703316795705*h0*h1;  
     const double w123 = -0.038141762351741127649*h0*h1;  
     const double w124 = -0.000052682092703316795705*h1*h2;  
     const double w125 = -0.038141762351741127649*h1*h2;  
     const double w126 = 0.027777777777777777778*h1*h2;  
     const double w127 = 0.027777777777777777778*h0*h2;  
     const double w128 = 0.055555555555555555556*h0*h1;  
     const double w129 = -0.027777777777777777778*h1*h2;  
     const double w130 = -0.027777777777777777778*h0*h2;  
     const double w131 = 0.013888888888888888889*h0*h1;  
     const double w132 = -0.055555555555555555556*h0*h2;  
     const double w133 = -0.027777777777777777778*h0*h1;  
     const double w134 = 0.055555555555555555556*h0*h2;  
     const double w135 = 0.027777777777777777778*h0*h1;  
     const double w136 = -0.013888888888888888889*h0*h1;  
     const double w137 = 0.055555555555555555556*h1*h2;  
     const double w138 = -0.013888888888888888889*h1*h2;  
     const double w139 = -0.013888888888888888889*h0*h2;  
     const double w140 = -0.055555555555555555556*h0*h1;  
     const double w141 = 0.013888888888888888889*h1*h2;  
     const double w142 = 0.013888888888888888889*h0*h2;  
     const double w143 = -0.055555555555555555556*h1*h2;  
     const double w144 = 0.000041549056553524783501*h0*h1*h2;  
     const double w145 = 0.0005787037037037037037*h0*h1*h2;  
     const double w146 = 0.0080603027952983270684*h0*h1*h2;  
     const double w147 = 0.0001550631900643071218*h0*h1*h2;  
     const double w148 = 0.002159751624750507693*h0*h1*h2;  
     const double w149 = 0.03008145955644280058*h0*h1*h2;  
     const double w150 = 0.000011133036149792012204*h0*h1*h2;  
     const double w151 = 0.018518518518518518519*h0*h1*h2;  
     const double w152 = 0.0092592592592592592592*h0*h1*h2;  
     const double w153 = 0.0046296296296296296296*h0*h1*h2;  
     const double w154 = 0.037037037037037037037*h0*h1*h2;  
     const double w155 = -0.077751058491018276949*h1*h2;  
     const double w156 = -0.077751058491018276949*h0*h2;  
     const double w157 = -0.077751058491018276949*h0*h1;  
     const double w158 = -0.020833333333333333333*h0*h2;  
     const double w159 = -0.020833333333333333333*h0*h1;  
     const double w160 = -0.020833333333333333333*h1*h2;  
     const double w161 = -0.0055822748423150563848*h0*h1;  
     const double w162 = -0.0055822748423150563848*h0*h2;  
     const double w163 = -0.0055822748423150563848*h1*h2;  
     const double w164 = 0.077751058491018276949*h1*h2;  
     const double w165 = 0.020833333333333333333*h1*h2;  
     const double w166 = 0.0055822748423150563848*h1*h2;  
     const double w167 = 0.077751058491018276949*h0*h2;  
     const double w168 = 0.020833333333333333333*h0*h2;  
     const double w169 = 0.0055822748423150563848*h0*h2;  
     const double w170 = 0.077751058491018276949*h0*h1;  
     const double w171 = 0.020833333333333333333*h0*h1;  
     const double w172 = 0.0055822748423150563848*h0*h1;  
     const double w173 = -0.25*h1*h2;  
     const double w174 = -0.25*h0*h2;  
     const double w175 = -0.25*h0*h1;  
     const double w176 = 0.25*h1*h2;  
     const double w177 = 0.25*h0*h2;  
     const double w178 = 0.25*h0*h1;  
     const double w179 = 0.061320326520293008568*h0*h1*h2;  
     const double w180 = 0.01643073197072526838*h0*h1*h2;  
     const double w181 = 0.004402601362608064953*h0*h1*h2;  
     const double w182 = 0.0011796734797069914318*h0*h1*h2;  
     const double w183 = 0.125*h0*h1*h2;  
   
     rhs.requireWrite();  
 #pragma omp parallel  
3008      {      {
3009          for (index_t k2_0=0; k2_0<2; k2_0++) { // colouring          double* arr=new double[(radius*2+1)*(radius*2+1)*(radius*2+1)];
3010  #pragma omp for          double common=pow(M_1_PI*0.5*1/(sigma*sigma), 3./2);
3011              for (index_t k2=k2_0; k2<m_NE2; k2+=2) {          double total=0;
3012                  for (index_t k1=0; k1<m_NE1; ++k1) {          int r=static_cast<int>(radius);
3013                      for (index_t k0=0; k0<m_NE0; ++k0)  {          for (int z=-r;z<=r;++z)
3014                          bool add_EM_S=false;          {
3015                          bool add_EM_F=false;              for (int y=-r;y<=r;++y)
3016                          vector<double> EM_S(8*8, 0);              {
3017                          vector<double> EM_F(8, 0);                  for (int x=-r;x<=r;++x)
3018                          const index_t e = k0 + m_NE0*k1 + m_NE0*m_NE1*k2;                  {        
3019                          ///////////////                      arr[(x+r)+(y+r)*(r*2+1)+(z+r)*(r*2+1)*(r*2+1)]=common*exp(-(x*x+y*y+z*z)/(2*sigma*sigma));
3020                          // process A //                      total+=arr[(x+r)+(y+r)*(r*2+1)+(z+r)*(r*2+1)*(r*2+1)];    
3021                          ///////////////                  }
3022                          if (!A.isEmpty()) {              }
3023                              add_EM_S=true;          }
3024                              const double* A_p=const_cast<escript::Data*>(&A)->getSampleDataRO(e);          double invtotal=1/total;
3025                              if (A.actsExpanded()) {          for (size_t p=0;p<(radius*2+1)*(radius*2+1)*(radius*2+1);++p)
3026                                  const double A_00_0 = A_p[INDEX3(0,0,0,3,3)];          {
3027                                  const double A_01_0 = A_p[INDEX3(0,1,0,3,3)];              arr[p]*=invtotal;
3028                                  const double A_02_0 = A_p[INDEX3(0,2,0,3,3)];          }
3029                                  const double A_10_0 = A_p[INDEX3(1,0,0,3,3)];          return arr;
3030                                  const double A_11_0 = A_p[INDEX3(1,1,0,3,3)];      }
3031                                  const double A_12_0 = A_p[INDEX3(1,2,0,3,3)];      
3032                                  const double A_20_0 = A_p[INDEX3(2,0,0,3,3)];      // applies conv to source to get a point.
3033                                  const double A_21_0 = A_p[INDEX3(2,1,0,3,3)];      // (xp, yp) are the coords in the source matrix not the destination matrix
3034                                  const double A_22_0 = A_p[INDEX3(2,2,0,3,3)];      double Convolve3D(double* conv, double* source, size_t xp, size_t yp, size_t zp, unsigned radius, size_t width, size_t height)
3035                                  const double A_00_1 = A_p[INDEX3(0,0,1,3,3)];      {
3036                                  const double A_01_1 = A_p[INDEX3(0,1,1,3,3)];          size_t bx=xp-radius, by=yp-radius, bz=zp-radius;
3037                                  const double A_02_1 = A_p[INDEX3(0,2,1,3,3)];          size_t sbase=bx+by*width+bz*width*height;
3038                                  const double A_10_1 = A_p[INDEX3(1,0,1,3,3)];          double result=0;
3039                                  const double A_11_1 = A_p[INDEX3(1,1,1,3,3)];          for (int z=0;z<2*radius+1;++z)
3040                                  const double A_12_1 = A_p[INDEX3(1,2,1,3,3)];          {
3041                                  const double A_20_1 = A_p[INDEX3(2,0,1,3,3)];              for (int y=0;y<2*radius+1;++y)
3042                                  const double A_21_1 = A_p[INDEX3(2,1,1,3,3)];              {    
3043                                  const double A_22_1 = A_p[INDEX3(2,2,1,3,3)];                  for (int x=0;x<2*radius+1;++x)
3044                                  const double A_00_2 = A_p[INDEX3(0,0,2,3,3)];                  {
3045                                  const double A_01_2 = A_p[INDEX3(0,1,2,3,3)];                      result+=conv[x+y*(2*radius+1)+z*(2*radius+1)*(2*radius+1)] * source[sbase + x+y*width+z*width*height];
3046                                  const double A_02_2 = A_p[INDEX3(0,2,2,3,3)];                  }
3047                                  const double A_10_2 = A_p[INDEX3(1,0,2,3,3)];              }
3048                                  const double A_11_2 = A_p[INDEX3(1,1,2,3,3)];          }
3049                                  const double A_12_2 = A_p[INDEX3(1,2,2,3,3)];          // use this line for "pass-though" (return the centre point value)
3050                                  const double A_20_2 = A_p[INDEX3(2,0,2,3,3)];  //      return source[sbase+(radius)+(radius)*width+(radius)*width*height];
3051                                  const double A_21_2 = A_p[INDEX3(2,1,2,3,3)];          return result;      
3052                                  const double A_22_2 = A_p[INDEX3(2,2,2,3,3)];      }