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

trunk/ripley/src/Brick.cpp revision 4346 by jfenwick, Tue Apr 2 04:46:45 2013 UTC branches/diaplayground/ripley/src/Brick.cpp revision 4988 by caltinay, Wed Jun 4 01:15:10 2014 UTC
# Line 1  Line 1 
1    
2  /*****************************************************************************  /*****************************************************************************
3  *  *
4  * Copyright (c) 2003-2013 by University of Queensland  * Copyright (c) 2003-2014 by University of Queensland
5  * http://www.uq.edu.au  * http://www.uq.edu.au
6  *  *
7  * Primary Business: Queensland, Australia  * Primary Business: Queensland, Australia
# Line 9  Line 9 
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)  * Development until 2012 by Earth Systems Science Computational Center (ESSCC)
12  * Development since 2012 by School of Earth Sciences  * Development 2012-2013 by School of Earth Sciences
13    * Development from 2014 by Centre for Geoscience Computing (GeoComp)
14  *  *
15  *****************************************************************************/  *****************************************************************************/
16    
17    #include <limits>
18    
19  #include <ripley/Brick.h>  #include <ripley/Brick.h>
 #include <paso/SystemMatrix.h>  
20  #include <esysUtils/esysFileWriter.h>  #include <esysUtils/esysFileWriter.h>
21    #include <ripley/DefaultAssembler3D.h>
22    #include <ripley/WaveAssembler3D.h>
23    #include <ripley/LameAssembler3D.h>
24    #include <ripley/domainhelpers.h>
25    #include <boost/scoped_array.hpp>
26    
27  #ifdef USE_NETCDF  #ifdef USE_NETCDF
28  #include <netcdfcpp.h>  #include <netcdfcpp.h>
# Line 30  Line 37 
37    
38  #include <iomanip>  #include <iomanip>
39    
40    #include "esysUtils/EsysRandom.h"
41    #include "blocktools.h"
42    
43    
44  using namespace std;  using namespace std;
45  using esysUtils::FileWriter;  using esysUtils::FileWriter;
46    
47  namespace ripley {  namespace ripley {
48    
49    int indexOfMax(int a, int b, int c) {
50        if (a > b) {
51            if (c > a) {
52                return 2;
53            }
54            return 0;
55        } else if (b > c) {
56            return 1;
57        }
58        return 2;
59    }
60    
61  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,
62               double x1, double y1, double z1, int d0, int d1, int d2) :               double x1, double y1, double z1, int d0, int d1, int d2,
63      RipleyDomain(3)               const std::vector<double>& points, const std::vector<int>& tags,
64  {               const simap_t& tagnamestonums,
65                 escript::SubWorld_ptr w) :
66        RipleyDomain(3, w)
67    {
68        if (static_cast<long>(n0 + 1) * static_cast<long>(n1 + 1)
69                * static_cast<long>(n2 + 1) > std::numeric_limits<int>::max())
70            throw RipleyException("The number of elements has overflowed, this "
71                    "limit may be raised in future releases.");
72    
73        if (n0 <= 0 || n1 <= 0 || n2 <= 0)
74            throw RipleyException("Number of elements in each spatial dimension "
75                    "must be positive");
76    
77      // ignore subdivision parameters for serial run      // ignore subdivision parameters for serial run
78      if (m_mpiInfo->size == 1) {      if (m_mpiInfo->size == 1) {
79          d0=1;          d0=1;
80          d1=1;          d1=1;
81          d2=1;          d2=1;
82      }      }
   
83      bool warn=false;      bool warn=false;
84      // if number of subdivisions is non-positive, try to subdivide by the same  
85      // ratio as the number of elements      std::vector<int> factors;
86      if (d0<=0 && d1<=0 && d2<=0) {      int ranks = m_mpiInfo->size;
87          warn=true;      int epr[3] = {n0,n1,n2};
88          d0=(int)(pow(m_mpiInfo->size*(n0+1)*(n0+1)/((float)(n1+1)*(n2+1)), 1.f/3));      int d[3] = {d0,d1,d2};
89          d0=max(1, d0);      if (d0<=0 || d1<=0 || d2<=0) {
90          d1=max(1, (int)(d0*n1/(float)n0));          for (int i = 0; i < 3; i++) {
91          d2=m_mpiInfo->size/(d0*d1);              if (d[i] < 1) {
92          if (d0*d1*d2 != m_mpiInfo->size) {                  d[i] = 1;
93              // ratios not the same so leave "smallest" side undivided and try                  continue;
94              // dividing 2 sides only              }
95              if (n0>=n1) {              epr[i] = -1; // can no longer be max
96                  if (n1>=n2) {              if (ranks % d[i] != 0) {
97                      d0=d1=0;                  throw RipleyException("Invalid number of spatial subdivisions");
98                      d2=1;              }
99                  } else {              //remove
100                      d0=d2=0;              ranks /= d[i];
101                      d1=1;          }
102                  }          factorise(factors, ranks);
103              } else {          if (factors.size() != 0) {
104                  if (n0>=n2) {              warn = true;
105                      d0=d1=0;          }
106                      d2=1;      }
107                  } else {      while (factors.size() > 0) {
108                      d0=1;          int i = indexOfMax(epr[0],epr[1],epr[2]);
109                      d1=d2=0;          int f = factors.back();
110                  }          factors.pop_back();
111              }          d[i] *= f;
112          }          epr[i] /= f;
     }  
     if (d0<=0 && d1<=0) {  
         warn=true;  
         d0=max(1, 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=max(1, 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=max(1, 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;  
             }  
         }  
     }  
     if (d0<=0) {  
         // 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);  
113      }      }
114        d0 = d[0]; d1 = d[1]; d2 = d[2];
115    
116      // ensure number of subdivisions is valid and nodes can be distributed      // ensure number of subdivisions is valid and nodes can be distributed
117      // among number of ranks      // among number of ranks
118      if (d0*d1*d2 != m_mpiInfo->size)      if (d0*d1*d2 != m_mpiInfo->size){
119          throw RipleyException("Invalid number of spatial subdivisions");          throw RipleyException("Invalid number of spatial subdivisions");
120        }
121      if (warn) {      if (warn) {
122          cout << "Warning: Automatic domain subdivision (d0=" << d0 << ", d1="          cout << "Warning: Automatic domain subdivision (d0=" << d0 << ", d1="
123              << d1 << ", d2=" << d2 << "). This may not be optimal!" << endl;              << d1 << ", d2=" << d2 << "). This may not be optimal!" << endl;
# Line 220  Brick::Brick(int n0, int n1, int n2, dou Line 202  Brick::Brick(int n0, int n1, int n2, dou
202    
203      populateSampleIds();      populateSampleIds();
204      createPattern();      createPattern();
205        
206        for (map<string, int>::const_iterator i = tagnamestonums.begin();
207                i != tagnamestonums.end(); i++) {
208            setTagMap(i->first, i->second);
209        }
210        addPoints(tags.size(), &points[0], &tags[0]);
211  }  }
212    
213    
214  Brick::~Brick()  Brick::~Brick()
215  {  {
     Paso_SystemMatrixPattern_free(m_pattern);  
     Paso_Connector_free(m_connector);  
216  }  }
217    
218  string Brick::getDescription() const  string Brick::getDescription() const
# Line 249  bool Brick::operator==(const AbstractDom Line 235  bool Brick::operator==(const AbstractDom
235  }  }
236    
237  void Brick::readNcGrid(escript::Data& out, string filename, string varname,  void Brick::readNcGrid(escript::Data& out, string filename, string varname,
238              const vector<int>& first, const vector<int>& numValues,              const ReaderParameters& params) const
             const vector<int>& multiplier) const  
239  {  {
240  #ifdef USE_NETCDF  #ifdef USE_NETCDF
241      // check destination function space      // check destination function space
# Line 267  void Brick::readNcGrid(escript::Data& ou Line 252  void Brick::readNcGrid(escript::Data& ou
252      } else      } else
253          throw RipleyException("readNcGrid(): invalid function space for output data object");          throw RipleyException("readNcGrid(): invalid function space for output data object");
254    
255      if (first.size() != 3)      if (params.first.size() != 3)
256          throw RipleyException("readNcGrid(): argument 'first' must have 3 entries");          throw RipleyException("readNcGrid(): argument 'first' must have 3 entries");
257    
258      if (numValues.size() != 3)      if (params.numValues.size() != 3)
259          throw RipleyException("readNcGrid(): argument 'numValues' must have 3 entries");          throw RipleyException("readNcGrid(): argument 'numValues' must have 3 entries");
260    
261      if (multiplier.size() != 3)      if (params.multiplier.size() != 3)
262          throw RipleyException("readNcGrid(): argument 'multiplier' must have 3 entries");          throw RipleyException("readNcGrid(): argument 'multiplier' must have 3 entries");
263      for (size_t i=0; i<multiplier.size(); i++)      for (size_t i=0; i<params.multiplier.size(); i++)
264          if (multiplier[i]<1)          if (params.multiplier[i]<1)
265              throw RipleyException("readNcGrid(): all multipliers must be positive");              throw RipleyException("readNcGrid(): all multipliers must be positive");
266    
267      // check file existence and size      // check file existence and size
# Line 294  void Brick::readNcGrid(escript::Data& ou Line 279  void Brick::readNcGrid(escript::Data& ou
279          throw RipleyException("readNcGrid(): only scalar data supported");          throw RipleyException("readNcGrid(): only scalar data supported");
280    
281      const int dims = var->num_dims();      const int dims = var->num_dims();
282      const long *edges = var->edges();      boost::scoped_array<long> edges(var->edges());
283    
284      // is this a slice of the data object (dims!=3)?      // is this a slice of the data object (dims!=3)?
285      // note the expected ordering of edges (as in numpy: z,y,x)      // note the expected ordering of edges (as in numpy: z,y,x)
286      if ( (dims==3 && (numValues[2] > edges[0] || numValues[1] > edges[1]      if ( (dims==3 && (params.numValues[2] > edges[0] ||
287                        || numValues[0] > edges[2]))                        params.numValues[1] > edges[1] ||
288              || (dims==2 && numValues[2]>1)                        params.numValues[0] > edges[2]))
289              || (dims==1 && (numValues[2]>1 || numValues[1]>1)) ) {              || (dims==2 && params.numValues[2]>1)
290                || (dims==1 && (params.numValues[2]>1 || params.numValues[1]>1)) ) {
291          throw RipleyException("readNcGrid(): not enough data in file");          throw RipleyException("readNcGrid(): not enough data in file");
292      }      }
293    
294      // check if this rank contributes anything      // check if this rank contributes anything
295      if (first[0] >= m_offset[0]+myN0 || first[0]+numValues[0]*multiplier[0] <= m_offset[0] ||      if (params.first[0] >= m_offset[0]+myN0 ||
296              first[1] >= m_offset[1]+myN1 || first[1]+numValues[1]*multiplier[1] <= m_offset[1] ||              params.first[0]+params.numValues[0]*params.multiplier[0] <= m_offset[0] ||
297              first[2] >= m_offset[2]+myN2 || first[2]+numValues[2]*multiplier[2] <= m_offset[2]) {              params.first[1] >= m_offset[1]+myN1 ||
298                params.first[1]+params.numValues[1]*params.multiplier[1] <= m_offset[1] ||
299                params.first[2] >= m_offset[2]+myN2 ||
300                params.first[2]+params.numValues[2]*params.multiplier[2] <= m_offset[2]) {
301          return;          return;
302      }      }
303    
304      // now determine how much this rank has to write      // now determine how much this rank has to write
305    
306      // first coordinates in data object to write to      // first coordinates in data object to write to
307      const int first0 = max(0, first[0]-m_offset[0]);      const int first0 = max(0, params.first[0]-m_offset[0]);
308      const int first1 = max(0, first[1]-m_offset[1]);      const int first1 = max(0, params.first[1]-m_offset[1]);
309      const int first2 = max(0, first[2]-m_offset[2]);      const int first2 = max(0, params.first[2]-m_offset[2]);
310      // indices to first value in file      // indices to first value in file (not accounting for reverse yet)
311      const int idx0 = max(0, m_offset[0]-first[0]);      int idx0 = max(0, m_offset[0]-params.first[0]);
312      const int idx1 = max(0, m_offset[1]-first[1]);      int idx1 = max(0, m_offset[1]-params.first[1]);
313      const int idx2 = max(0, m_offset[2]-first[2]);      int idx2 = max(0, m_offset[2]-params.first[2]);
314      // number of values to read      // number of values to read
315      const int num0 = min(numValues[0]-idx0, myN0-first0);      const int num0 = min(params.numValues[0]-idx0, myN0-first0);
316      const int num1 = min(numValues[1]-idx1, myN1-first1);      const int num1 = min(params.numValues[1]-idx1, myN1-first1);
317      const int num2 = min(numValues[2]-idx2, myN2-first2);      const int num2 = min(params.numValues[2]-idx2, myN2-first2);
318    
319        // make sure we read the right block if going backwards through file
320        if (params.reverse[0])
321            idx0 = edges[dims-1]-num0-idx0;
322        if (dims>1 && params.reverse[1])
323            idx1 = edges[dims-2]-num1-idx1;
324        if (dims>2 && params.reverse[2])
325            idx2 = edges[dims-3]-num2-idx2;
326    
327    
328      vector<double> values(num0*num1*num2);      vector<double> values(num0*num1*num2);
329      if (dims==3) {      if (dims==3) {
# Line 342  void Brick::readNcGrid(escript::Data& ou Line 340  void Brick::readNcGrid(escript::Data& ou
340      const int dpp = out.getNumDataPointsPerSample();      const int dpp = out.getNumDataPointsPerSample();
341      out.requireWrite();      out.requireWrite();
342    
343        // helpers for reversing
344        const int x0 = (params.reverse[0] ? num0-1 : 0);
345        const int x_mult = (params.reverse[0] ? -1 : 1);
346        const int y0 = (params.reverse[1] ? num1-1 : 0);
347        const int y_mult = (params.reverse[1] ? -1 : 1);
348        const int z0 = (params.reverse[2] ? num2-1 : 0);
349        const int z_mult = (params.reverse[2] ? -1 : 1);
350    
351      for (index_t z=0; z<num2; z++) {      for (index_t z=0; z<num2; z++) {
352          for (index_t y=0; y<num1; y++) {          for (index_t y=0; y<num1; y++) {
353  #pragma omp parallel for  #pragma omp parallel for
354              for (index_t x=0; x<num0; x++) {              for (index_t x=0; x<num0; x++) {
355                  const int baseIndex = first0+x*multiplier[0]                  const int baseIndex = first0+x*params.multiplier[0]
356                                          +(first1+y*multiplier[1])*myN0                                       +(first1+y*params.multiplier[1])*myN0
357                                          +(first2+z*multiplier[2])*myN0*myN1;                                       +(first2+z*params.multiplier[2])*myN0*myN1;
358                  const int srcIndex=z*num1*num0+y*num0+x;                  const int srcIndex=(z0+z_mult*z)*num1*num0
359                                      +(y0+y_mult*y)*num0
360                                      +(x0+x_mult*x);
361                  if (!isnan(values[srcIndex])) {                  if (!isnan(values[srcIndex])) {
362                      for (index_t m2=0; m2<multiplier[2]; m2++) {                      for (index_t m2=0; m2<params.multiplier[2]; m2++) {
363                          for (index_t m1=0; m1<multiplier[1]; m1++) {                          for (index_t m1=0; m1<params.multiplier[1]; m1++) {
364                              for (index_t m0=0; m0<multiplier[0]; m0++) {                              for (index_t m0=0; m0<params.multiplier[0]; m0++) {
365                                  const int dataIndex = baseIndex+m0                                  const int dataIndex = baseIndex+m0
366                                                 +m1*myN0                                                 +m1*myN0
367                                                 +m2*myN0*myN1;                                                 +m2*myN0*myN1;
# Line 373  void Brick::readNcGrid(escript::Data& ou Line 381  void Brick::readNcGrid(escript::Data& ou
381  #endif  #endif
382  }  }
383    
384    #ifdef USE_BOOSTIO
385    void Brick::readBinaryGridFromZipped(escript::Data& out, string filename,
386                               const ReaderParameters& params) const
387    {
388        // the mapping is not universally correct but should work on our
389        // supported platforms
390        switch (params.dataType) {
391            case DATATYPE_INT32:
392                readBinaryGridZippedImpl<int>(out, filename, params);
393                break;
394            case DATATYPE_FLOAT32:
395                readBinaryGridZippedImpl<float>(out, filename, params);
396                break;
397            case DATATYPE_FLOAT64:
398                readBinaryGridZippedImpl<double>(out, filename, params);
399                break;
400            default:
401                throw RipleyException("readBinaryGrid(): invalid or unsupported datatype");
402        }
403    }
404    #endif
405    
406  void Brick::readBinaryGrid(escript::Data& out, string filename,  void Brick::readBinaryGrid(escript::Data& out, string filename,
407                             const vector<int>& first,                             const ReaderParameters& params) const
408                             const vector<int>& numValues,  {
409                             const vector<int>& multiplier) const      // the mapping is not universally correct but should work on our
410        // supported platforms
411        switch (params.dataType) {
412            case DATATYPE_INT32:
413                readBinaryGridImpl<int>(out, filename, params);
414                break;
415            case DATATYPE_FLOAT32:
416                readBinaryGridImpl<float>(out, filename, params);
417                break;
418            case DATATYPE_FLOAT64:
419                readBinaryGridImpl<double>(out, filename, params);
420                break;
421            default:
422                throw RipleyException("readBinaryGrid(): invalid or unsupported datatype");
423        }
424    }
425    
426    template<typename ValueType>
427    void Brick::readBinaryGridImpl(escript::Data& out, const string& filename,
428                                   const ReaderParameters& params) const
429  {  {
430      // check destination function space      // check destination function space
431      int myN0, myN1, myN2;      int myN0, myN1, myN2;
# Line 392  void Brick::readBinaryGrid(escript::Data Line 441  void Brick::readBinaryGrid(escript::Data
441      } else      } else
442          throw RipleyException("readBinaryGrid(): invalid function space for output data object");          throw RipleyException("readBinaryGrid(): invalid function space for output data object");
443    
444      if (first.size() != 3)      if (params.first.size() != 3)
445          throw RipleyException("readBinaryGrid(): argument 'first' must have 3 entries");          throw RipleyException("readBinaryGrid(): argument 'first' must have 3 entries");
446    
447      if (numValues.size() != 3)      if (params.numValues.size() != 3)
448          throw RipleyException("readBinaryGrid(): argument 'numValues' must have 3 entries");          throw RipleyException("readBinaryGrid(): argument 'numValues' must have 3 entries");
449    
450      if (multiplier.size() != 3)      if (params.multiplier.size() != 3)
451          throw RipleyException("readBinaryGrid(): argument 'multiplier' must have 3 entries");          throw RipleyException("readBinaryGrid(): argument 'multiplier' must have 3 entries");
452      for (size_t i=0; i<multiplier.size(); i++)      for (size_t i=0; i<params.multiplier.size(); i++)
453          if (multiplier[i]<1)          if (params.multiplier[i]<1)
454              throw RipleyException("readBinaryGrid(): all multipliers must be positive");              throw RipleyException("readBinaryGrid(): all multipliers must be positive");
455        if (params.reverse[0] != 0 || params.reverse[1] != 0)
456            throw RipleyException("readBinaryGrid(): reversing only supported in Z-direction currently");
457    
458      // check file existence and size      // check file existence and size
459      ifstream f(filename.c_str(), ifstream::binary);      ifstream f(filename.c_str(), ifstream::binary);
# Line 412  void Brick::readBinaryGrid(escript::Data Line 463  void Brick::readBinaryGrid(escript::Data
463      f.seekg(0, ios::end);      f.seekg(0, ios::end);
464      const int numComp = out.getDataPointSize();      const int numComp = out.getDataPointSize();
465      const int filesize = f.tellg();      const int filesize = f.tellg();
466      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);
467      if (filesize < reqsize) {      if (filesize < reqsize) {
468          f.close();          f.close();
469          throw RipleyException("readBinaryGrid(): not enough data in file");          throw RipleyException("readBinaryGrid(): not enough data in file");
470      }      }
471    
472      // check if this rank contributes anything      // check if this rank contributes anything
473      if (first[0] >= m_offset[0]+myN0 || first[0]+numValues[0]*multiplier[0] <= m_offset[0] ||      if (params.first[0] >= m_offset[0]+myN0 ||
474              first[1] >= m_offset[1]+myN1 || first[1]+numValues[1]*multiplier[1] <= m_offset[1] ||              params.first[0]+params.numValues[0]*params.multiplier[0] <= m_offset[0] ||
475              first[2] >= m_offset[2]+myN2 || first[2]+numValues[2]*multiplier[2] <= m_offset[2]) {              params.first[1] >= m_offset[1]+myN1 ||
476                params.first[1]+params.numValues[1]*params.multiplier[1] <= m_offset[1] ||
477                params.first[2] >= m_offset[2]+myN2 ||
478                params.first[2]+params.numValues[2]*params.multiplier[2] <= m_offset[2]) {
479          f.close();          f.close();
480          return;          return;
481      }      }
# Line 429  void Brick::readBinaryGrid(escript::Data Line 483  void Brick::readBinaryGrid(escript::Data
483      // now determine how much this rank has to write      // now determine how much this rank has to write
484    
485      // first coordinates in data object to write to      // first coordinates in data object to write to
486      const int first0 = max(0, first[0]-m_offset[0]);      const int first0 = max(0, params.first[0]-m_offset[0]);
487      const int first1 = max(0, first[1]-m_offset[1]);      const int first1 = max(0, params.first[1]-m_offset[1]);
488      const int first2 = max(0, first[2]-m_offset[2]);      const int first2 = max(0, params.first[2]-m_offset[2]);
489      // indices to first value in file      // indices to first value in file (not accounting for reverse yet)
490      const int idx0 = max(0, m_offset[0]-first[0]);      int idx0 = max(0, m_offset[0]-params.first[0]);
491      const int idx1 = max(0, m_offset[1]-first[1]);      int idx1 = max(0, m_offset[1]-params.first[1]);
492      const int idx2 = max(0, m_offset[2]-first[2]);      int idx2 = max(0, m_offset[2]-params.first[2]);
493      // number of values to read      // number of values to read
494      const int num0 = min(numValues[0]-idx0, myN0-first0);      const int num0 = min(params.numValues[0]-idx0, myN0-first0);
495      const int num1 = min(numValues[1]-idx1, myN1-first1);      const int num1 = min(params.numValues[1]-idx1, myN1-first1);
496      const int num2 = min(numValues[2]-idx2, myN2-first2);      const int num2 = min(params.numValues[2]-idx2, myN2-first2);
497    
498        // make sure we read the right block if going backwards through file
499        if (params.reverse[2])
500            idx2 = params.numValues[2]-idx2-1;
501    
502        // helpers for reversing
503        const int z_mult = (params.reverse[2] ? -1 : 1);
504    
505      out.requireWrite();      out.requireWrite();
506      vector<float> values(num0*numComp);      vector<ValueType> values(num0*numComp);
507      const int dpp = out.getNumDataPointsPerSample();      const int dpp = out.getNumDataPointsPerSample();
508    
509      for (index_t z=0; z<num2; z++) {      for (int z=0; z<num2; z++) {
510          for (index_t y=0; y<num1; y++) {          for (int y=0; y<num1; y++) {
511              const int fileofs = numComp*(idx0+(idx1+y)*numValues[0]+(idx2+z)*numValues[0]*numValues[1]);              const int fileofs = numComp*(idx0 +
512              f.seekg(fileofs*sizeof(float));                                  (idx1+y)*params.numValues[0] +
513              f.read((char*)&values[0], num0*numComp*sizeof(float));                                  (idx2+z_mult*z)*params.numValues[0]*params.numValues[1]);
514                f.seekg(fileofs*sizeof(ValueType));
515              for (index_t x=0; x<num0; x++) {              f.read((char*)&values[0], num0*numComp*sizeof(ValueType));
516                  const int baseIndex = first0+x*multiplier[0]  
517                                          +(first1+y*multiplier[1])*myN0              for (int x=0; x<num0; x++) {
518                                          +(first2+z*multiplier[2])*myN0*myN1;                  const int baseIndex = first0+x*params.multiplier[0]
519                  for (index_t m2=0; m2<multiplier[2]; m2++) {                                       +(first1+y*params.multiplier[1])*myN0
520                      for (index_t m1=0; m1<multiplier[1]; m1++) {                                       +(first2+z*params.multiplier[2])*myN0*myN1;
521                          for (index_t m0=0; m0<multiplier[0]; m0++) {                  for (int m2=0; m2<params.multiplier[2]; m2++) {
522                        for (int m1=0; m1<params.multiplier[1]; m1++) {
523                            for (int m0=0; m0<params.multiplier[0]; m0++) {
524                              const int dataIndex = baseIndex+m0                              const int dataIndex = baseIndex+m0
525                                             +m1*myN0                                             +m1*myN0
526                                             +m2*myN0*myN1;                                             +m2*myN0*myN1;
527                              double* dest = out.getSampleDataRW(dataIndex);                              double* dest = out.getSampleDataRW(dataIndex);
528                              for (index_t c=0; c<numComp; c++) {                              for (int c=0; c<numComp; c++) {
529                                  if (!isnan(values[x*numComp+c])) {                                  ValueType val = values[x*numComp+c];
530                                      for (index_t q=0; q<dpp; q++) {  
531                                          *dest++ = static_cast<double>(values[x*numComp+c]);                                  if (params.byteOrder != BYTEORDER_NATIVE) {
532                                        char* cval = reinterpret_cast<char*>(&val);
533                                        // this will alter val!!
534                                        byte_swap32(cval);
535                                    }
536                                    if (!std::isnan(val)) {
537                                        for (int q=0; q<dpp; q++) {
538                                            *dest++ = static_cast<double>(val);
539                                      }                                      }
540                                  }                                  }
541                              }                              }
# Line 479  void Brick::readBinaryGrid(escript::Data Line 549  void Brick::readBinaryGrid(escript::Data
549      f.close();      f.close();
550  }  }
551    
552  void Brick::writeBinaryGrid(const escript::Data& in, string filename, int byteOrder) const  #ifdef USE_BOOSTIO
553    template<typename ValueType>
554    void Brick::readBinaryGridZippedImpl(escript::Data& out, const string& filename,
555                                   const ReaderParameters& params) const
556    {
557        // check destination function space
558        int myN0, myN1, myN2;
559        if (out.getFunctionSpace().getTypeCode() == Nodes) {
560            myN0 = m_NN[0];
561            myN1 = m_NN[1];
562            myN2 = m_NN[2];
563        } else if (out.getFunctionSpace().getTypeCode() == Elements ||
564                    out.getFunctionSpace().getTypeCode() == ReducedElements) {
565            myN0 = m_NE[0];
566            myN1 = m_NE[1];
567            myN2 = m_NE[2];
568        } else
569            throw RipleyException("readBinaryGridFromZipped(): invalid function space for output data object");
570    
571        if (params.first.size() != 3)
572            throw RipleyException("readBinaryGridFromZipped(): argument 'first' must have 3 entries");
573    
574        if (params.numValues.size() != 3)
575            throw RipleyException("readBinaryGridFromZipped(): argument 'numValues' must have 3 entries");
576    
577        if (params.multiplier.size() != 3)
578            throw RipleyException("readBinaryGridFromZipped(): argument 'multiplier' must have 3 entries");
579        for (size_t i=0; i<params.multiplier.size(); i++)
580            if (params.multiplier[i]<1)
581                throw RipleyException("readBinaryGridFromZipped(): all multipliers must be positive");
582    
583        // check file existence and size
584        ifstream f(filename.c_str(), ifstream::binary);
585        if (f.fail()) {
586            throw RipleyException("readBinaryGridFromZipped(): cannot open file");
587        }
588        f.seekg(0, ios::end);
589        const int numComp = out.getDataPointSize();
590        int filesize = f.tellg();
591        f.seekg(0, ios::beg);
592        std::vector<char> compressed(filesize);
593        f.read((char*)&compressed[0], filesize);
594        f.close();
595        std::vector<char> decompressed = unzip(compressed);
596        filesize = decompressed.size();
597        const int reqsize = params.numValues[0]*params.numValues[1]*params.numValues[2]*numComp*sizeof(ValueType);
598        if (filesize < reqsize) {
599            throw RipleyException("readBinaryGridFromZipped(): not enough data in file");
600        }
601    
602        // check if this rank contributes anything
603        if (params.first[0] >= m_offset[0]+myN0 ||
604                params.first[0]+params.numValues[0]*params.multiplier[0] <= m_offset[0] ||
605                params.first[1] >= m_offset[1]+myN1 ||
606                params.first[1]+params.numValues[1]*params.multiplier[1] <= m_offset[1] ||
607                params.first[2] >= m_offset[2]+myN2 ||
608                params.first[2]+params.numValues[2]*params.multiplier[2] <= m_offset[2]) {
609            return;
610        }
611    
612        // now determine how much this rank has to write
613    
614        // first coordinates in data object to write to
615        const int first0 = max(0, params.first[0]-m_offset[0]);
616        const int first1 = max(0, params.first[1]-m_offset[1]);
617        const int first2 = max(0, params.first[2]-m_offset[2]);
618        // indices to first value in file
619        const int idx0 = max(0, m_offset[0]-params.first[0]);
620        const int idx1 = max(0, m_offset[1]-params.first[1]);
621        const int idx2 = max(0, m_offset[2]-params.first[2]);
622        // number of values to read
623        const int num0 = min(params.numValues[0]-idx0, myN0-first0);
624        const int num1 = min(params.numValues[1]-idx1, myN1-first1);
625        const int num2 = min(params.numValues[2]-idx2, myN2-first2);
626    
627        out.requireWrite();
628        vector<ValueType> values(num0*numComp);
629        const int dpp = out.getNumDataPointsPerSample();
630    
631        for (int z=0; z<num2; z++) {
632            for (int y=0; y<num1; y++) {
633                const int fileofs = numComp*(idx0+(idx1+y)*params.numValues[0]
634                                 +(idx2+z)*params.numValues[0]*params.numValues[1]);
635                memcpy((char*)&values[0], (char*)&decompressed[fileofs*sizeof(ValueType)], num0*numComp*sizeof(ValueType));
636                
637                for (int x=0; x<num0; x++) {
638                    const int baseIndex = first0+x*params.multiplier[0]
639                                         +(first1+y*params.multiplier[1])*myN0
640                                         +(first2+z*params.multiplier[2])*myN0*myN1;
641                    for (int m2=0; m2<params.multiplier[2]; m2++) {
642                        for (int m1=0; m1<params.multiplier[1]; m1++) {
643                            for (int m0=0; m0<params.multiplier[0]; m0++) {
644                                const int dataIndex = baseIndex+m0
645                                               +m1*myN0
646                                               +m2*myN0*myN1;
647                                double* dest = out.getSampleDataRW(dataIndex);
648                                for (int c=0; c<numComp; c++) {
649                                    ValueType val = values[x*numComp+c];
650    
651                                    if (params.byteOrder != BYTEORDER_NATIVE) {
652                                        char* cval = reinterpret_cast<char*>(&val);
653                                        // this will alter val!!
654                                        byte_swap32(cval);
655                                    }
656                                    if (!std::isnan(val)) {
657                                        for (int q=0; q<dpp; q++) {
658                                            *dest++ = static_cast<double>(val);
659                                        }
660                                    }
661                                }
662                            }
663                        }
664                    }
665                }
666            }
667        }
668    }
669    #endif
670    
671    void Brick::writeBinaryGrid(const escript::Data& in, string filename,
672                                int byteOrder, int dataType) const
673    {
674        // the mapping is not universally correct but should work on our
675        // supported platforms
676        switch (dataType) {
677            case DATATYPE_INT32:
678                writeBinaryGridImpl<int>(in, filename, byteOrder);
679                break;
680            case DATATYPE_FLOAT32:
681                writeBinaryGridImpl<float>(in, filename, byteOrder);
682                break;
683            case DATATYPE_FLOAT64:
684                writeBinaryGridImpl<double>(in, filename, byteOrder);
685                break;
686            default:
687                throw RipleyException("writeBinaryGrid(): invalid or unsupported datatype");
688        }
689    }
690    
691    template<typename ValueType>
692    void Brick::writeBinaryGridImpl(const escript::Data& in,
693                                    const string& filename, int byteOrder) const
694  {  {
695      // check function space and determine number of points      // check function space and determine number of points
696      int myN0, myN1, myN2;      int myN0, myN1, myN2;
# Line 504  void Brick::writeBinaryGrid(const escrip Line 715  void Brick::writeBinaryGrid(const escrip
715    
716      const int numComp = in.getDataPointSize();      const int numComp = in.getDataPointSize();
717      const int dpp = in.getNumDataPointsPerSample();      const int dpp = in.getNumDataPointsPerSample();
718      const int fileSize = sizeof(float)*numComp*dpp*totalN0*totalN1*totalN2;      const int fileSize = sizeof(ValueType)*numComp*dpp*totalN0*totalN1*totalN2;
719    
720      if (numComp > 1 || dpp > 1)      if (numComp > 1 || dpp > 1)
721          throw RipleyException("writeBinaryGrid(): only scalar, single-value data supported");          throw RipleyException("writeBinaryGrid(): only scalar, single-value data supported");
722    
     escript::Data* _in = const_cast<escript::Data*>(&in);  
   
723      // from here on we know that each sample consists of one value      // from here on we know that each sample consists of one value
724      FileWriter* fw = new FileWriter();      FileWriter fw;
725      fw->openFile(filename, fileSize);      fw.openFile(filename, fileSize);
726      MPIBarrier();      MPIBarrier();
727    
728      for (index_t z=0; z<myN2; z++) {      for (index_t z=0; z<myN2; z++) {
729          for (index_t y=0; y<myN1; y++) {          for (index_t y=0; y<myN1; y++) {
730              const int fileofs = (m_offset[0]+(m_offset[1]+y)*totalN0              const int fileofs = (m_offset[0]+(m_offset[1]+y)*totalN0
731                                  +(m_offset[2]+z)*totalN0*totalN1)*sizeof(float);                                  +(m_offset[2]+z)*totalN0*totalN1)*sizeof(ValueType);
732              ostringstream oss;              ostringstream oss;
733    
734              for (index_t x=0; x<myN0; x++) {              for (index_t x=0; x<myN0; x++) {
735                  const double* sample = _in->getSampleDataRO(z*myN0*myN1+y*myN0+x);                  const double* sample = in.getSampleDataRO(z*myN0*myN1+y*myN0+x);
736                  float fvalue = (float)(*sample);                  ValueType fvalue = static_cast<ValueType>(*sample);
737                  if (byteOrder == RIPLEY_BYTE_ORDER) {                  if (byteOrder == BYTEORDER_NATIVE) {
738                      oss.write((char*)&fvalue, sizeof(fvalue));                      oss.write((char*)&fvalue, sizeof(fvalue));
739                  } else {                  } else {
740                      char* value = reinterpret_cast<char*>(&fvalue);                      char* value = reinterpret_cast<char*>(&fvalue);
741                      oss.write(RIPLEY_BYTE_SWAP32(value), sizeof(fvalue));                      oss.write(byte_swap32(value), sizeof(fvalue));
742                  }                  }
743              }              }
744              fw->writeAt(oss, fileofs);              fw.writeAt(oss, fileofs);
745          }          }
746      }      }
747      fw->close();      fw.close();
748  }  }
749    
750  void Brick::dump(const string& fileName) const  void Brick::dump(const string& fileName) const
# Line 698  const int* Brick::borrowSampleReferenceI Line 907  const int* Brick::borrowSampleReferenceI
907          case FaceElements:          case FaceElements:
908          case ReducedFaceElements:          case ReducedFaceElements:
909              return &m_faceId[0];              return &m_faceId[0];
910            case Points:
911                return &m_diracPointNodeIDs[0];
912          default:          default:
913              break;              break;
914      }      }
# Line 1070  void Brick::assembleCoordinates(escript: Line 1281  void Brick::assembleCoordinates(escript:
1281  }  }
1282    
1283  //protected  //protected
1284  void Brick::assembleGradient(escript::Data& out, escript::Data& in) const  void Brick::assembleGradient(escript::Data& out, const escript::Data& in) const
1285  {  {
1286      const dim_t numComp = in.getDataPointSize();      const dim_t numComp = in.getDataPointSize();
     const double h0 = m_length[0]/m_gNE[0];  
     const double h1 = m_length[1]/m_gNE[1];  
     const double h2 = m_length[2]/m_gNE[2];  
1287      const double C0 = .044658198738520451079;      const double C0 = .044658198738520451079;
1288      const double C1 = .16666666666666666667;      const double C1 = .16666666666666666667;
1289      const double C2 = .21132486540518711775;      const double C2 = .21132486540518711775;
# Line 1110  void Brick::assembleGradient(escript::Da Line 1318  void Brick::assembleGradient(escript::Da
1318                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2+1, m_NN[0],m_NN[1])), 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));
1319                          double* o = out.getSampleDataRW(INDEX3(k0,k1,k2,m_NE[0],m_NE[1]));                          double* o = out.getSampleDataRW(INDEX3(k0,k1,k2,m_NE[0],m_NE[1]));
1320                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1321                              const double V0=((f_100[i]-f_000[i])*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];
1322                              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];
1323                              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];
1324                              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];
1325                              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];
1326                              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];
1327                              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];
1328                              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];
1329                              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];
1330                              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];
1331                              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];
1332                              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];
1333                              o[INDEX3(i,0,0,numComp,3)] = V0;                              o[INDEX3(i,0,0,numComp,3)] = V0;
1334                              o[INDEX3(i,1,0,numComp,3)] = V4;                              o[INDEX3(i,1,0,numComp,3)] = V4;
1335                              o[INDEX3(i,2,0,numComp,3)] = V8;                              o[INDEX3(i,2,0,numComp,3)] = V8;
# Line 1177  void Brick::assembleGradient(escript::Da Line 1385  void Brick::assembleGradient(escript::Da
1385                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2+1, m_NN[0],m_NN[1])), 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));
1386                          double* o = out.getSampleDataRW(INDEX3(k0,k1,k2,m_NE[0],m_NE[1]));                          double* o = out.getSampleDataRW(INDEX3(k0,k1,k2,m_NE[0],m_NE[1]));
1387                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1388                              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];
1389                              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];
1390                              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];
1391                          } // end of component loop i                          } // end of component loop i
1392                      } // end of k0 loop                      } // end of k0 loop
1393                  } // end of k1 loop                  } // end of k1 loop
# Line 1211  void Brick::assembleGradient(escript::Da Line 1419  void Brick::assembleGradient(escript::Da
1419                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(1,k1+1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(1,k1+1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1420                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE[1]));                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE[1]));
1421                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1422                              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];
1423                              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];
1424                              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];
1425                              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];
1426                              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];
1427                              o[INDEX3(i,1,0,numComp,3)] = V0;                              o[INDEX3(i,1,0,numComp,3)] = V0;
1428                              o[INDEX3(i,2,0,numComp,3)] = V2;                              o[INDEX3(i,2,0,numComp,3)] = V2;
1429                              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];
1430                              o[INDEX3(i,1,1,numComp,3)] = V0;                              o[INDEX3(i,1,1,numComp,3)] = V0;
1431                              o[INDEX3(i,2,1,numComp,3)] = V3;                              o[INDEX3(i,2,1,numComp,3)] = V3;
1432                              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];
1433                              o[INDEX3(i,1,2,numComp,3)] = V1;                              o[INDEX3(i,1,2,numComp,3)] = V1;
1434                              o[INDEX3(i,2,2,numComp,3)] = V2;                              o[INDEX3(i,2,2,numComp,3)] = V2;
1435                              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];
1436                              o[INDEX3(i,1,3,numComp,3)] = V1;                              o[INDEX3(i,1,3,numComp,3)] = V1;
1437                              o[INDEX3(i,2,3,numComp,3)] = V3;                              o[INDEX3(i,2,3,numComp,3)] = V3;
1438                          } // end of component loop i                          } // end of component loop i
# Line 1245  void Brick::assembleGradient(escript::Da Line 1453  void Brick::assembleGradient(escript::Da
1453                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(m_NN[0]-1,k1+1,k2+1, m_NN[0],m_NN[1])), 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));
1454                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE[1]));                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE[1]));
1455                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1456                              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];
1457                              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];
1458                              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];
1459                              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];
1460                              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];
1461                              o[INDEX3(i,1,0,numComp,3)] = V0;                              o[INDEX3(i,1,0,numComp,3)] = V0;
1462                              o[INDEX3(i,2,0,numComp,3)] = V2;                              o[INDEX3(i,2,0,numComp,3)] = V2;
1463                              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];
1464                              o[INDEX3(i,1,1,numComp,3)] = V0;                              o[INDEX3(i,1,1,numComp,3)] = V0;
1465                              o[INDEX3(i,2,1,numComp,3)] = V3;                              o[INDEX3(i,2,1,numComp,3)] = V3;
1466                              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];
1467                              o[INDEX3(i,1,2,numComp,3)] = V1;                              o[INDEX3(i,1,2,numComp,3)] = V1;
1468                              o[INDEX3(i,2,2,numComp,3)] = V2;                              o[INDEX3(i,2,2,numComp,3)] = V2;
1469                              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];
1470                              o[INDEX3(i,1,3,numComp,3)] = V1;                              o[INDEX3(i,1,3,numComp,3)] = V1;
1471                              o[INDEX3(i,2,3,numComp,3)] = V3;                              o[INDEX3(i,2,3,numComp,3)] = V3;
1472                          } // end of component loop i                          } // end of component loop i
# Line 1279  void Brick::assembleGradient(escript::Da Line 1487  void Brick::assembleGradient(escript::Da
1487                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1488                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE[0]));                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE[0]));
1489                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1490                              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];
1491                              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];
1492                              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];
1493                              o[INDEX3(i,0,0,numComp,3)] = V0;                              o[INDEX3(i,0,0,numComp,3)] = V0;
1494                              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];
1495                              o[INDEX3(i,2,0,numComp,3)] = V1;                              o[INDEX3(i,2,0,numComp,3)] = V1;
1496                              o[INDEX3(i,0,1,numComp,3)] = V0;                              o[INDEX3(i,0,1,numComp,3)] = V0;
1497                              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];
1498                              o[INDEX3(i,2,1,numComp,3)] = V2;                              o[INDEX3(i,2,1,numComp,3)] = V2;
1499                              o[INDEX3(i,0,2,numComp,3)] = V0;                              o[INDEX3(i,0,2,numComp,3)] = V0;
1500                              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];
1501                              o[INDEX3(i,2,2,numComp,3)] = V1;                              o[INDEX3(i,2,2,numComp,3)] = V1;
1502                              o[INDEX3(i,0,3,numComp,3)] = V0;                              o[INDEX3(i,0,3,numComp,3)] = V0;
1503                              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];
1504                              o[INDEX3(i,2,3,numComp,3)] = V2;                              o[INDEX3(i,2,3,numComp,3)] = V2;
1505                          } // end of component loop i                          } // end of component loop i
1506                      } // end of k0 loop                      } // end of k0 loop
# Line 1312  void Brick::assembleGradient(escript::Da Line 1520  void Brick::assembleGradient(escript::Da
1520                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,m_NN[1]-1,k2+1, m_NN[0],m_NN[1])), 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));
1521                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE[0]));                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE[0]));
1522                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1523                              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];
1524                              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];
1525                              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];
1526                              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];
1527                              o[INDEX3(i,0,0,numComp,3)] = V0;                              o[INDEX3(i,0,0,numComp,3)] = V0;
1528                              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];
1529                              o[INDEX3(i,2,0,numComp,3)] = V2;                              o[INDEX3(i,2,0,numComp,3)] = V2;
1530                              o[INDEX3(i,0,1,numComp,3)] = V0;                              o[INDEX3(i,0,1,numComp,3)] = V0;
1531                              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];
1532                              o[INDEX3(i,2,1,numComp,3)] = V3;                              o[INDEX3(i,2,1,numComp,3)] = V3;
1533                              o[INDEX3(i,0,2,numComp,3)] = V1;                              o[INDEX3(i,0,2,numComp,3)] = V1;
1534                              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];
1535                              o[INDEX3(i,2,2,numComp,3)] = V2;                              o[INDEX3(i,2,2,numComp,3)] = V2;
1536                              o[INDEX3(i,0,3,numComp,3)] = V1;                              o[INDEX3(i,0,3,numComp,3)] = V1;
1537                              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];
1538                              o[INDEX3(i,2,3,numComp,3)] = V3;                              o[INDEX3(i,2,3,numComp,3)] = V3;
1539                          } // end of component loop i                          } // end of component loop i
1540                      } // end of k0 loop                      } // end of k0 loop
# Line 1346  void Brick::assembleGradient(escript::Da Line 1554  void Brick::assembleGradient(escript::Da
1554                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,1, m_NN[0],m_NN[1])), numComp*sizeof(double));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1555                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE[0]));                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE[0]));
1556                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1557                              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];
1558                              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];
1559                              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];
1560                              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];
1561                              o[INDEX3(i,0,0,numComp,3)] = V0;                              o[INDEX3(i,0,0,numComp,3)] = V0;
1562                              o[INDEX3(i,1,0,numComp,3)] = V2;                              o[INDEX3(i,1,0,numComp,3)] = V2;
1563                              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];
1564                              o[INDEX3(i,0,1,numComp,3)] = V0;                              o[INDEX3(i,0,1,numComp,3)] = V0;
1565                              o[INDEX3(i,1,1,numComp,3)] = V3;                              o[INDEX3(i,1,1,numComp,3)] = V3;
1566                              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];
1567                              o[INDEX3(i,0,2,numComp,3)] = V1;                              o[INDEX3(i,0,2,numComp,3)] = V1;
1568                              o[INDEX3(i,1,2,numComp,3)] = V2;                              o[INDEX3(i,1,2,numComp,3)] = V2;
1569                              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];
1570                              o[INDEX3(i,0,3,numComp,3)] = V1;                              o[INDEX3(i,0,3,numComp,3)] = V1;
1571                              o[INDEX3(i,1,3,numComp,3)] = V3;                              o[INDEX3(i,1,3,numComp,3)] = V3;
1572                              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];
1573                          } // end of component loop i                          } // end of component loop i
1574                      } // end of k0 loop                      } // end of k0 loop
1575                  } // end of k1 loop                  } // end of k1 loop
# Line 1380  void Brick::assembleGradient(escript::Da Line 1588  void Brick::assembleGradient(escript::Da
1588                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,m_NN[2]-1, m_NN[0],m_NN[1])), 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));
1589                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE[0]));                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE[0]));
1590                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1591                              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];
1592                              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];
1593                              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];
1594                              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];
1595                              o[INDEX3(i,0,0,numComp,3)] = V0;                              o[INDEX3(i,0,0,numComp,3)] = V0;
1596                              o[INDEX3(i,1,0,numComp,3)] = V2;                              o[INDEX3(i,1,0,numComp,3)] = V2;
1597                              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];
1598                              o[INDEX3(i,0,1,numComp,3)] = V0;                              o[INDEX3(i,0,1,numComp,3)] = V0;
1599                              o[INDEX3(i,1,1,numComp,3)] = V3;                              o[INDEX3(i,1,1,numComp,3)] = V3;
1600                              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];
1601                              o[INDEX3(i,0,2,numComp,3)] = V1;                              o[INDEX3(i,0,2,numComp,3)] = V1;
1602                              o[INDEX3(i,1,2,numComp,3)] = V2;                              o[INDEX3(i,1,2,numComp,3)] = V2;
1603                              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];
1604                              o[INDEX3(i,0,3,numComp,3)] = V1;                              o[INDEX3(i,0,3,numComp,3)] = V1;
1605                              o[INDEX3(i,1,3,numComp,3)] = V3;                              o[INDEX3(i,1,3,numComp,3)] = V3;
1606                              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];
1607                          } // end of component loop i                          } // end of component loop i
1608                      } // end of k0 loop                      } // end of k0 loop
1609                  } // end of k1 loop                  } // end of k1 loop
# Line 1427  void Brick::assembleGradient(escript::Da Line 1635  void Brick::assembleGradient(escript::Da
1635                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(1,k1+1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(1,k1+1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1636                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE[1]));                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE[1]));
1637                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1638                              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];
1639                              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];
1640                              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];
1641                          } // end of component loop i                          } // end of component loop i
1642                      } // end of k1 loop                      } // end of k1 loop
1643                  } // end of k2 loop                  } // end of k2 loop
# Line 1448  void Brick::assembleGradient(escript::Da Line 1656  void Brick::assembleGradient(escript::Da
1656                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(m_NN[0]-1,k1+1,k2+1, m_NN[0],m_NN[1])), 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));
1657                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE[1]));                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE[1]));
1658                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1659                              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];
1660                              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];
1661                              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];
1662                          } // end of component loop i                          } // end of component loop i
1663                      } // end of k1 loop                      } // end of k1 loop
1664                  } // end of k2 loop                  } // end of k2 loop
# Line 1469  void Brick::assembleGradient(escript::Da Line 1677  void Brick::assembleGradient(escript::Da
1677                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1678                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE[0]));                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE[0]));
1679                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1680                              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];
1681                              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];
1682                              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];
1683                          } // end of component loop i                          } // end of component loop i
1684                      } // end of k0 loop                      } // end of k0 loop
1685                  } // end of k2 loop                  } // end of k2 loop
# Line 1490  void Brick::assembleGradient(escript::Da Line 1698  void Brick::assembleGradient(escript::Da
1698                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,m_NN[1]-1,k2+1, m_NN[0],m_NN[1])), 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));
1699                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE[0]));                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE[0]));
1700                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1701                              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];
1702                              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];
1703                              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];
1704                          } // end of component loop i                          } // end of component loop i
1705                      } // end of k0 loop                      } // end of k0 loop
1706                  } // end of k2 loop                  } // end of k2 loop
# Line 1511  void Brick::assembleGradient(escript::Da Line 1719  void Brick::assembleGradient(escript::Da
1719                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,1, m_NN[0],m_NN[1])), numComp*sizeof(double));                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,1, m_NN[0],m_NN[1])), numComp*sizeof(double));
1720                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE[0]));                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE[0]));
1721                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1722                              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];
1723                              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];
1724                              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];
1725                          } // end of component loop i                          } // end of component loop i
1726                      } // end of k0 loop                      } // end of k0 loop
1727                  } // end of k1 loop                  } // end of k1 loop
# Line 1532  void Brick::assembleGradient(escript::Da Line 1740  void Brick::assembleGradient(escript::Da
1740                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,m_NN[2]-1, m_NN[0],m_NN[1])), 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));
1741                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE[0]));                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE[0]));
1742                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
1743                              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];
1744                              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];
1745                              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];
1746                          } // end of component loop i                          } // end of component loop i
1747                      } // end of k0 loop                      } // end of k0 loop
1748                  } // end of k1 loop                  } // end of k1 loop
# Line 1544  void Brick::assembleGradient(escript::Da Line 1752  void Brick::assembleGradient(escript::Da
1752  }  }
1753    
1754  //protected  //protected
1755  void Brick::assembleIntegrate(vector<double>& integrals, escript::Data& arg) const  void Brick::assembleIntegrate(vector<double>& integrals, const escript::Data& arg) const
1756  {  {
1757      const dim_t numComp = arg.getDataPointSize();      const dim_t numComp = arg.getDataPointSize();
     const double h0 = m_length[0]/m_gNE[0];  
     const double h1 = m_length[1]/m_gNE[1];  
     const double h2 = m_length[2]/m_gNE[2];  
1758      const index_t left = (m_offset[0]==0 ? 0 : 1);      const index_t left = (m_offset[0]==0 ? 0 : 1);
1759      const index_t bottom = (m_offset[1]==0 ? 0 : 1);      const index_t bottom = (m_offset[1]==0 ? 0 : 1);
1760      const index_t front = (m_offset[2]==0 ? 0 : 1);      const index_t front = (m_offset[2]==0 ? 0 : 1);
1761      const int fs = arg.getFunctionSpace().getTypeCode();      const int fs = arg.getFunctionSpace().getTypeCode();
1762      if (fs == Elements && arg.actsExpanded()) {      if (fs == Elements && arg.actsExpanded()) {
1763          const double w_0 = h0*h1*h2/8.;          const double w_0 = m_dx[0]*m_dx[1]*m_dx[2]/8.;
1764  #pragma omp parallel  #pragma omp parallel
1765          {          {
1766              vector<double> int_local(numComp, 0);              vector<double> int_local(numComp, 0);
# Line 1585  void Brick::assembleIntegrate(vector<dou Line 1790  void Brick::assembleIntegrate(vector<dou
1790          } // end of parallel section          } // end of parallel section
1791    
1792      } else if (fs==ReducedElements || (fs==Elements && !arg.actsExpanded())) {      } else if (fs==ReducedElements || (fs==Elements && !arg.actsExpanded())) {
1793          const double w_0 = h0*h1*h2;          const double w_0 = m_dx[0]*m_dx[1]*m_dx[2];
1794  #pragma omp parallel  #pragma omp parallel
1795          {          {
1796              vector<double> int_local(numComp, 0);              vector<double> int_local(numComp, 0);
# Line 1607  void Brick::assembleIntegrate(vector<dou Line 1812  void Brick::assembleIntegrate(vector<dou
1812          } // end of parallel section          } // end of parallel section
1813    
1814      } else if (fs == FaceElements && arg.actsExpanded()) {      } else if (fs == FaceElements && arg.actsExpanded()) {
1815          const double w_0 = h1*h2/4.;          const double w_0 = m_dx[1]*m_dx[2]/4.;
1816          const double w_1 = h0*h2/4.;          const double w_1 = m_dx[0]*m_dx[2]/4.;
1817          const double w_2 = h0*h1/4.;          const double w_2 = m_dx[0]*m_dx[1]/4.;
1818  #pragma omp parallel  #pragma omp parallel
1819          {          {
1820              vector<double> int_local(numComp, 0);              vector<double> int_local(numComp, 0);
# Line 1715  void Brick::assembleIntegrate(vector<dou Line 1920  void Brick::assembleIntegrate(vector<dou
1920          } // end of parallel section          } // end of parallel section
1921    
1922      } else if (fs==ReducedFaceElements || (fs==FaceElements && !arg.actsExpanded())) {      } else if (fs==ReducedFaceElements || (fs==FaceElements && !arg.actsExpanded())) {
1923          const double w_0 = h1*h2;          const double w_0 = m_dx[1]*m_dx[2];
1924          const double w_1 = h0*h2;          const double w_1 = m_dx[0]*m_dx[2];
1925          const double w_2 = h0*h1;          const double w_2 = m_dx[0]*m_dx[1];
1926  #pragma omp parallel  #pragma omp parallel
1927          {          {
1928              vector<double> int_local(numComp, 0);              vector<double> int_local(numComp, 0);
# Line 1801  void Brick::assembleIntegrate(vector<dou Line 2006  void Brick::assembleIntegrate(vector<dou
2006  }  }
2007    
2008  //protected  //protected
2009  dim_t Brick::insertNeighbourNodes(IndexVector& index, index_t node) const  IndexVector Brick::getDiagonalIndices() const
2010  {  {
2011        IndexVector ret;
2012      const dim_t nDOF0 = (m_gNE[0]+1)/m_NX[0];      const dim_t nDOF0 = (m_gNE[0]+1)/m_NX[0];
2013      const dim_t nDOF1 = (m_gNE[1]+1)/m_NX[1];      const dim_t nDOF1 = (m_gNE[1]+1)/m_NX[1];
     const dim_t nDOF2 = (m_gNE[2]+1)/m_NX[2];  
     const int x=node%nDOF0;  
     const int y=node%(nDOF0*nDOF1)/nDOF0;  
     const int z=node/(nDOF0*nDOF1);  
     int num=0;  
     // loop through potential neighbours and add to index if positions are  
     // within bounds  
2014      for (int i2=-1; i2<2; i2++) {      for (int i2=-1; i2<2; i2++) {
2015          for (int i1=-1; i1<2; i1++) {          for (int i1=-1; i1<2; i1++) {
2016              for (int i0=-1; i0<2; i0++) {              for (int i0=-1; i0<2; i0++) {
2017                  // skip node itself                  ret.push_back(i2*nDOF0*nDOF1+i1*nDOF0+i0);
                 if (i0==0 && i1==0 && i2==0)  
                     continue;  
                 // location of neighbour node  
                 const int nx=x+i0;  
                 const int ny=y+i1;  
                 const int nz=z+i2;  
                 if (nx>=0 && ny>=0 && nz>=0  
                         && nx<nDOF0 && ny<nDOF1 && nz<nDOF2) {  
                     index.push_back(nz*nDOF0*nDOF1+ny*nDOF0+nx);  
                     num++;  
                 }  
2018              }              }
2019          }          }
2020      }      }
2021    
2022      return num;      return ret;
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();
# Line 1859  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_ptr coupler(new paso::Coupler(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        coupler->startCollect(in.getDataRO());
2057    
2058      const dim_t numDOF = getNumDOF();      const dim_t numDOF = getNumDOF();
2059      out.requireWrite();      out.requireWrite();
2060      const double* buffer = Paso_Coupler_finishCollect(coupler);      const double* buffer = coupler->finishCollect();
2061    
2062  #pragma omp parallel for  #pragma omp parallel for
2063      for (index_t i=0; i<getNumNodes(); i++) {      for (index_t i=0; i<getNumNodes(); i++) {
# Line 1877  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      }      }
     Paso_Coupler_free(coupler);  
2069  }  }
2070    
2071  //private  //private
# Line 1898  void Brick::populateSampleIds() Line 2086  void Brick::populateSampleIds()
2086          m_nodeDistribution[k]=k*numDOF;          m_nodeDistribution[k]=k*numDOF;
2087      }      }
2088      m_nodeDistribution[m_mpiInfo->size]=getNumDataPointsGlobal();      m_nodeDistribution[m_mpiInfo->size]=getNumDataPointsGlobal();
2089      m_nodeId.resize(getNumNodes());      
2090      m_dofId.resize(numDOF);      try {
2091      m_elementId.resize(getNumElements());          m_nodeId.resize(getNumNodes());
2092            m_dofId.resize(numDOF);
2093            m_elementId.resize(getNumElements());
2094        } catch (const std::length_error& le) {
2095            throw RipleyException("The system does not have sufficient memory for a domain of this size.");
2096        }
2097        
2098      // populate face element counts      // populate face element counts
2099      //left      //left
2100      if (m_offset[0]==0)      if (m_offset[0]==0)
# Line 2145  void Brick::createPattern() Line 2338  void Brick::createPattern()
2338      RankVector neighbour;      RankVector neighbour;
2339      IndexVector offsetInShared(1,0);      IndexVector offsetInShared(1,0);
2340      IndexVector sendShared, recvShared;      IndexVector sendShared, recvShared;
2341      int numShared=0;      int numShared=0, expectedShared=0;;
2342      const int x=m_mpiInfo->rank%m_NX[0];      const int x=m_mpiInfo->rank%m_NX[0];
2343      const int y=m_mpiInfo->rank%(m_NX[0]*m_NX[1])/m_NX[0];      const int y=m_mpiInfo->rank%(m_NX[0]*m_NX[1])/m_NX[0];
2344      const int z=m_mpiInfo->rank/(m_NX[0]*m_NX[1]);      const int z=m_mpiInfo->rank/(m_NX[0]*m_NX[1]);
# Line 2159  void Brick::createPattern() Line 2352  void Brick::createPattern()
2352                  const int nx=x+i0;                  const int nx=x+i0;
2353                  const int ny=y+i1;                  const int ny=y+i1;
2354                  const int nz=z+i2;                  const int nz=z+i2;
2355                    if (!(nx>=0 && ny>=0 && nz>=0 && nx<m_NX[0] && ny<m_NX[1] && nz<m_NX[2])) {
2356                        continue;
2357                    }
2358                    if (i0==0 && i1==0)
2359                        expectedShared += nDOF0*nDOF1;
2360                    else if (i0==0 && i2==0)
2361                        expectedShared += nDOF0*nDOF2;
2362                    else if (i1==0 && i2==0)
2363                        expectedShared += nDOF1*nDOF2;
2364                    else if (i0==0)
2365                        expectedShared += nDOF0;
2366                    else if (i1==0)
2367                        expectedShared += nDOF1;
2368                    else if (i2==0)
2369                        expectedShared += nDOF2;
2370                    else
2371                        expectedShared++;
2372                }
2373            }
2374        }
2375        
2376        vector<IndexVector> rowIndices(expectedShared);
2377        
2378        for (int i2=-1; i2<2; i2++) {
2379            for (int i1=-1; i1<2; i1++) {
2380                for (int i0=-1; i0<2; i0++) {
2381                    // skip this rank
2382                    if (i0==0 && i1==0 && i2==0)
2383                        continue;
2384                    // location of neighbour rank
2385                    const int nx=x+i0;
2386                    const int ny=y+i1;
2387                    const int nz=z+i2;
2388                  if (nx>=0 && ny>=0 && nz>=0 && nx<m_NX[0] && ny<m_NX[1] && nz<m_NX[2]) {                  if (nx>=0 && ny>=0 && nz>=0 && nx<m_NX[0] && ny<m_NX[1] && nz<m_NX[2]) {
2389                      neighbour.push_back(nz*m_NX[0]*m_NX[1]+ny*m_NX[0]+nx);                      neighbour.push_back(nz*m_NX[0]*m_NX[1]+ny*m_NX[0]+nx);
2390                      if (i0==0 && i1==0) {                      if (i0==0 && i1==0) {
# Line 2174  void Brick::createPattern() Line 2400  void Brick::createPattern()
2400                                  recvShared.push_back(numDOF+numShared);                                  recvShared.push_back(numDOF+numShared);
2401                                  if (j>0) {                                  if (j>0) {
2402                                      if (i>0)                                      if (i>0)
2403                                          colIndices[firstDOF+j-1-nDOF0].push_back(numShared);                                          doublyLink(colIndices, rowIndices, firstDOF+j-1-nDOF0, numShared);
2404                                      colIndices[firstDOF+j-1].push_back(numShared);                                      doublyLink(colIndices, rowIndices, firstDOF+j-1, numShared);
2405                                      if (i<nDOF1-1)                                      if (i<nDOF1-1)
2406                                          colIndices[firstDOF+j-1+nDOF0].push_back(numShared);                                          doublyLink(colIndices, rowIndices, firstDOF+j-1+nDOF0, numShared);
2407                                  }                                  }
2408                                  if (i>0)                                  if (i>0)
2409                                      colIndices[firstDOF+j-nDOF0].push_back(numShared);                                      doublyLink(colIndices, rowIndices, firstDOF+j-nDOF0, numShared);
2410                                  colIndices[firstDOF+j].push_back(numShared);                                  doublyLink(colIndices, rowIndices, firstDOF+j, numShared);
2411                                  if (i<nDOF1-1)                                  if (i<nDOF1-1)
2412                                      colIndices[firstDOF+j+nDOF0].push_back(numShared);                                      doublyLink(colIndices, rowIndices, firstDOF+j+nDOF0, numShared);
2413                                  if (j<nDOF0-1) {                                  if (j<nDOF0-1) {
2414                                      if (i>0)                                      if (i>0)
2415                                          colIndices[firstDOF+j+1-nDOF0].push_back(numShared);                                          doublyLink(colIndices, rowIndices, firstDOF+j+1-nDOF0, numShared);
2416                                      colIndices[firstDOF+j+1].push_back(numShared);                                      doublyLink(colIndices, rowIndices, firstDOF+j+1, numShared);
2417                                      if (i<nDOF1-1)                                      if (i<nDOF1-1)
2418                                          colIndices[firstDOF+j+1+nDOF0].push_back(numShared);                                          doublyLink(colIndices, rowIndices, firstDOF+j+1+nDOF0, numShared);
2419                                  }                                  }
2420                                  m_dofMap[firstNode+j]=numDOF+numShared;                                  m_dofMap[firstNode+j]=numDOF+numShared;
2421                              }                              }
# Line 2208  void Brick::createPattern() Line 2434  void Brick::createPattern()
2434                                  recvShared.push_back(numDOF+numShared);                                  recvShared.push_back(numDOF+numShared);
2435                                  if (j>0) {                                  if (j>0) {
2436                                      if (i>0)                                      if (i>0)
2437                                          colIndices[firstDOF+j-1-nDOF0*nDOF1].push_back(numShared);                                          doublyLink(colIndices, rowIndices, firstDOF+j-1-nDOF0*nDOF1, numShared);
2438                                      colIndices[firstDOF+j-1].push_back(numShared);                                      doublyLink(colIndices, rowIndices, firstDOF+j-1, numShared);
2439                                      if (i<nDOF2-1)                                      if (i<nDOF2-1)
2440                                          colIndices[firstDOF+j-1+nDOF0*nDOF1].push_back(numShared);                                          doublyLink(colIndices, rowIndices, firstDOF+j-1+nDOF0*nDOF1, numShared);
2441                                  }                                  }
2442                                  if (i>0)                                  if (i>0)
2443                                      colIndices[firstDOF+j-nDOF0*nDOF1].push_back(numShared);                                      doublyLink(colIndices, rowIndices, firstDOF+j-nDOF0*nDOF1, numShared);
2444                                  colIndices[firstDOF+j].push_back(numShared);                                  doublyLink(colIndices, rowIndices, firstDOF+j, numShared);
2445                                  if (i<nDOF2-1)                                  if (i<nDOF2-1)
2446                                      colIndices[firstDOF+j+nDOF0*nDOF1].push_back(numShared);                                      doublyLink(colIndices, rowIndices, firstDOF+j+nDOF0*nDOF1, numShared);
2447                                  if (j<nDOF0-1) {                                  if (j<nDOF0-1) {
2448                                      if (i>0)                                      if (i>0)
2449                                          colIndices[firstDOF+j+1-nDOF0*nDOF1].push_back(numShared);                                          doublyLink(colIndices, rowIndices, firstDOF+j+1-nDOF0*nDOF1, numShared);
2450                                      colIndices[firstDOF+j+1].push_back(numShared);                                      doublyLink(colIndices, rowIndices, firstDOF+j+1, numShared);
2451                                      if (i<nDOF2-1)                                      if (i<nDOF2-1)
2452                                          colIndices[firstDOF+j+1+nDOF0*nDOF1].push_back(numShared);                                          doublyLink(colIndices, rowIndices, firstDOF+j+1+nDOF0*nDOF1, numShared);
2453                                  }                                  }
2454                                  m_dofMap[firstNode+j]=numDOF+numShared;                                  m_dofMap[firstNode+j]=numDOF+numShared;
2455                              }                              }
# Line 2242  void Brick::createPattern() Line 2468  void Brick::createPattern()
2468                                  recvShared.push_back(numDOF+numShared);                                  recvShared.push_back(numDOF+numShared);
2469                                  if (j>0) {                                  if (j>0) {
2470                                      if (i>0)                                      if (i>0)
2471                                          colIndices[firstDOF+(j-1)*nDOF0-nDOF0*nDOF1].push_back(numShared);                                          doublyLink(colIndices, rowIndices, firstDOF+(j-1)*nDOF0-nDOF0*nDOF1, numShared);
2472                                      colIndices[firstDOF+(j-1)*nDOF0].push_back(numShared);                                      doublyLink(colIndices, rowIndices, firstDOF+(j-1)*nDOF0, numShared);
2473                                      if (i<nDOF2-1)                                      if (i<nDOF2-1)
2474                                          colIndices[firstDOF+(j-1)*nDOF0+nDOF0*nDOF1].push_back(numShared);                                          doublyLink(colIndices, rowIndices, firstDOF+(j-1)*nDOF0+nDOF0*nDOF1, numShared);
2475                                  }                                  }
2476                                  if (i>0)                                  if (i>0)
2477                                      colIndices[firstDOF+j*nDOF0-nDOF0*nDOF1].push_back(numShared);                                      doublyLink(colIndices, rowIndices, firstDOF+j*nDOF0-nDOF0*nDOF1, numShared);
2478                                  colIndices[firstDOF+j*nDOF0].push_back(numShared);                                  doublyLink(colIndices, rowIndices, firstDOF+j*nDOF0, numShared);
2479                                  if (i<nDOF2-1)                                  if (i<nDOF2-1)
2480                                      colIndices[firstDOF+j*nDOF0+nDOF0*nDOF1].push_back(numShared);                                      doublyLink(colIndices, rowIndices, firstDOF+j*nDOF0+nDOF0*nDOF1, numShared);
2481                                  if (j<nDOF1-1) {                                  if (j<nDOF1-1) {
2482                                      if (i>0)                                      if (i>0)
2483                                          colIndices[firstDOF+(j+1)*nDOF0-nDOF0*nDOF1].push_back(numShared);                                          doublyLink(colIndices, rowIndices, firstDOF+(j+1)*nDOF0-nDOF0*nDOF1, numShared);
2484                                      colIndices[firstDOF+(j+1)*nDOF0].push_back(numShared);                                      doublyLink(colIndices, rowIndices, firstDOF+(j+1)*nDOF0, numShared);
2485                                      if (i<nDOF2-1)                                      if (i<nDOF2-1)
2486                                          colIndices[firstDOF+(j+1)*nDOF0+nDOF0*nDOF1].push_back(numShared);                                          doublyLink(colIndices, rowIndices, firstDOF+(j+1)*nDOF0+nDOF0*nDOF1, numShared);
2487                                  }                                  }
2488                                  m_dofMap[firstNode+j*m_NN[0]]=numDOF+numShared;                                  m_dofMap[firstNode+j*m_NN[0]]=numDOF+numShared;
2489                              }                              }
# Line 2273  void Brick::createPattern() Line 2499  void Brick::createPattern()
2499                              sendShared.push_back(firstDOF+i);                              sendShared.push_back(firstDOF+i);
2500                              recvShared.push_back(numDOF+numShared);                              recvShared.push_back(numDOF+numShared);
2501                              if (i>0)                              if (i>0)
2502                                  colIndices[firstDOF+i-1].push_back(numShared);                                  doublyLink(colIndices, rowIndices, firstDOF+i-1, numShared);
2503                              colIndices[firstDOF+i].push_back(numShared);                              doublyLink(colIndices, rowIndices, firstDOF+i, numShared);
2504                              if (i<nDOF0-1)                              if (i<nDOF0-1)
2505                                  colIndices[firstDOF+i+1].push_back(numShared);                                  doublyLink(colIndices, rowIndices, firstDOF+i+1, numShared);
2506                              m_dofMap[firstNode+i]=numDOF+numShared;                              m_dofMap[firstNode+i]=numDOF+numShared;
2507                          }                          }
2508                      } else if (i1==0) {                      } else if (i1==0) {
# Line 2291  void Brick::createPattern() Line 2517  void Brick::createPattern()
2517                              sendShared.push_back(firstDOF+i*nDOF0);                              sendShared.push_back(firstDOF+i*nDOF0);
2518                              recvShared.push_back(numDOF+numShared);                              recvShared.push_back(numDOF+numShared);
2519                              if (i>0)                              if (i>0)
2520                                  colIndices[firstDOF+(i-1)*nDOF0].push_back(numShared);                                  doublyLink(colIndices, rowIndices, firstDOF+(i-1)*nDOF0, numShared);
2521                              colIndices[firstDOF+i*nDOF0].push_back(numShared);                              doublyLink(colIndices, rowIndices, firstDOF+i*nDOF0, numShared);
2522                              if (i<nDOF1-1)                              if (i<nDOF1-1)
2523                                  colIndices[firstDOF+(i+1)*nDOF0].push_back(numShared);                                  doublyLink(colIndices, rowIndices, firstDOF+(i+1)*nDOF0, numShared);
2524                              m_dofMap[firstNode+i*m_NN[0]]=numDOF+numShared;                              m_dofMap[firstNode+i*m_NN[0]]=numDOF+numShared;
2525                          }                          }
2526                      } else if (i2==0) {                      } else if (i2==0) {
# Line 2309  void Brick::createPattern() Line 2535  void Brick::createPattern()
2535                              sendShared.push_back(firstDOF+i*nDOF0*nDOF1);                              sendShared.push_back(firstDOF+i*nDOF0*nDOF1);
2536                              recvShared.push_back(numDOF+numShared);                              recvShared.push_back(numDOF+numShared);
2537                              if (i>0)                              if (i>0)
2538                                  colIndices[firstDOF+(i-1)*nDOF0*nDOF1].push_back(numShared);                                  doublyLink(colIndices, rowIndices, firstDOF+(i-1)*nDOF0*nDOF1, numShared);
2539                              colIndices[firstDOF+i*nDOF0*nDOF1].push_back(numShared);                              doublyLink(colIndices, rowIndices, firstDOF+i*nDOF0*nDOF1, numShared);
2540                              if (i<nDOF2-1)                              if (i<nDOF2-1)
2541                                  colIndices[firstDOF+(i+1)*nDOF0*nDOF1].push_back(numShared);                                  doublyLink(colIndices, rowIndices, firstDOF+(i+1)*nDOF0*nDOF1, numShared);
2542                              m_dofMap[firstNode+i*m_NN[0]*m_NN[1]]=numDOF+numShared;                              m_dofMap[firstNode+i*m_NN[0]*m_NN[1]]=numDOF+numShared;
2543                          }                          }
2544                      } else {                      } else {
# Line 2326  void Brick::createPattern() Line 2552  void Brick::createPattern()
2552                          offsetInShared.push_back(offsetInShared.back()+1);                          offsetInShared.push_back(offsetInShared.back()+1);
2553                          sendShared.push_back(dof);                          sendShared.push_back(dof);
2554                          recvShared.push_back(numDOF+numShared);                          recvShared.push_back(numDOF+numShared);
2555                          colIndices[dof].push_back(numShared);                          doublyLink(colIndices, rowIndices, dof, numShared);
2556                          m_dofMap[node]=numDOF+numShared;                          m_dofMap[node]=numDOF+numShared;
2557                          ++numShared;                          ++numShared;
2558                      }                      }
# Line 2335  void Brick::createPattern() Line 2561  void Brick::createPattern()
2561          }          }
2562      }      }
2563    
2564    #pragma omp parallel for
2565        for (int i = 0; i < numShared; i++) {
2566            std::sort(rowIndices[i].begin(), rowIndices[i].end());
2567        }
2568    
2569      // create connector      // create connector
2570      Paso_SharedComponents *snd_shcomp = Paso_SharedComponents_alloc(      paso::SharedComponents_ptr snd_shcomp(new paso::SharedComponents(
2571              numDOF, neighbour.size(), &neighbour[0], &sendShared[0],              numDOF, neighbour.size(), &neighbour[0], &sendShared[0],
2572              &offsetInShared[0], 1, 0, m_mpiInfo);              &offsetInShared[0], 1, 0, m_mpiInfo));
2573      Paso_SharedComponents *rcv_shcomp = Paso_SharedComponents_alloc(      paso::SharedComponents_ptr rcv_shcomp(new paso::SharedComponents(
2574              numDOF, neighbour.size(), &neighbour[0], &recvShared[0],              numDOF, neighbour.size(), &neighbour[0], &recvShared[0],
2575              &offsetInShared[0], 1, 0, m_mpiInfo);              &offsetInShared[0], 1, 0, m_mpiInfo));
2576      m_connector = Paso_Connector_alloc(snd_shcomp, rcv_shcomp);      m_connector.reset(new paso::Connector(snd_shcomp, rcv_shcomp));
     Paso_SharedComponents_free(snd_shcomp);  
     Paso_SharedComponents_free(rcv_shcomp);  
   
     // create main and couple blocks  
     Paso_Pattern *mainPattern = createMainPattern();  
     Paso_Pattern *colPattern, *rowPattern;  
     createCouplePatterns(colIndices, numShared, &colPattern, &rowPattern);  
   
     // allocate paso distribution  
     Paso_Distribution* distribution = Paso_Distribution_alloc(m_mpiInfo,  
             const_cast<index_t*>(&m_nodeDistribution[0]), 1, 0);  
   
     // finally create the system matrix  
     m_pattern = Paso_SystemMatrixPattern_alloc(MATRIX_FORMAT_DEFAULT,  
             distribution, distribution, mainPattern, colPattern, rowPattern,  
             m_connector, m_connector);  
   
     Paso_Distribution_free(distribution);  
2577    
2578      // useful debug output      // useful debug output
2579      /*      /*
# Line 2419  void Brick::createPattern() Line 2632  void Brick::createPattern()
2632          cout << "index[" << i << "]=" << rowPattern->index[i] << endl;          cout << "index[" << i << "]=" << rowPattern->index[i] << endl;
2633      }      }
2634      */      */
   
     Paso_Pattern_free(mainPattern);  
     Paso_Pattern_free(colPattern);  
     Paso_Pattern_free(rowPattern);  
2635  }  }
2636    
2637  //private  //private
2638  void Brick::addToMatrixAndRHS(Paso_SystemMatrix* S, escript::Data& F,  void Brick::addToMatrixAndRHS(SystemMatrix* S, escript::Data& F,
2639           const vector<double>& EM_S, const vector<double>& EM_F, bool addS,           const vector<double>& EM_S, const vector<double>& EM_F, bool addS,
2640           bool addF, index_t firstNode, dim_t nEq, dim_t nComp) const           bool addF, index_t firstNode, dim_t nEq, dim_t nComp) const
2641  {  {
# Line 2450  void Brick::addToMatrixAndRHS(Paso_Syste Line 2659  void Brick::addToMatrixAndRHS(Paso_Syste
2659          }          }
2660      }      }
2661      if (addS) {      if (addS) {
2662          addToSystemMatrix(S, rowIndex, nEq, rowIndex, nComp, EM_S);          S->add(rowIndex, EM_S);
2663      }      }
2664  }  }
2665    
2666  //protected  //protected
2667  void Brick::interpolateNodesOnElements(escript::Data& out, escript::Data& in,  void Brick::interpolateNodesOnElements(escript::Data& out,
2668                                           const escript::Data& in,
2669                                         bool reduced) const                                         bool reduced) const
2670  {  {
2671      const dim_t numComp = in.getDataPointSize();      const dim_t numComp = in.getDataPointSize();
2672      if (reduced) {      if (reduced) {
2673          out.requireWrite();          out.requireWrite();
         const double c0 = .125;  
2674  #pragma omp parallel  #pragma omp parallel
2675          {          {
2676              vector<double> f_000(numComp);              vector<double> f_000(numComp);
# Line 2486  void Brick::interpolateNodesOnElements(e Line 2695  void Brick::interpolateNodesOnElements(e
2695                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2+1, m_NN[0],m_NN[1])), 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));
2696                          double* o = out.getSampleDataRW(INDEX3(k0,k1,k2,m_NE[0],m_NE[1]));                          double* o = out.getSampleDataRW(INDEX3(k0,k1,k2,m_NE[0],m_NE[1]));
2697                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2698                              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;
2699                          } // end of component loop i                          } // end of component loop i
2700                      } // end of k0 loop                      } // end of k0 loop
2701                  } // end of k1 loop                  } // end of k1 loop
# Line 2539  void Brick::interpolateNodesOnElements(e Line 2748  void Brick::interpolateNodesOnElements(e
2748  }  }
2749    
2750  //protected  //protected
2751  void Brick::interpolateNodesOnFaces(escript::Data& out, escript::Data& in,  void Brick::interpolateNodesOnFaces(escript::Data& out, const escript::Data& in,
2752                                      bool reduced) const                                      bool reduced) const
2753  {  {
2754      const dim_t numComp = in.getDataPointSize();      const dim_t numComp = in.getDataPointSize();
2755      if (reduced) {      if (reduced) {
2756          out.requireWrite();          out.requireWrite();
         const double c0 = .25;  
2757  #pragma omp parallel  #pragma omp parallel
2758          {          {
2759              vector<double> f_000(numComp);              vector<double> f_000(numComp);
# Line 2566  void Brick::interpolateNodesOnFaces(escr Line 2774  void Brick::interpolateNodesOnFaces(escr
2774                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(0,k1+1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));                          memcpy(&f_011[0], in.getSampleDataRO(INDEX3(0,k1+1,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
2775                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE[1]));                          double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE[1]));
2776                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2777                              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;
2778                          } // end of component loop i                          } // end of component loop i
2779                      } // end of k1 loop                      } // end of k1 loop
2780                  } // end of k2 loop                  } // end of k2 loop
# Line 2581  void Brick::interpolateNodesOnFaces(escr Line 2789  void Brick::interpolateNodesOnFaces(escr
2789                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(m_NN[0]-1,k1+1,k2+1, m_NN[0],m_NN[1])), 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));
2790                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE[1]));                          double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE[1]));
2791                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2792                              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;
2793                          } // end of component loop i                          } // end of component loop i
2794                      } // end of k1 loop                      } // end of k1 loop
2795                  } // end of k2 loop                  } // end of k2 loop
# Line 2596  void Brick::interpolateNodesOnFaces(escr Line 2804  void Brick::interpolateNodesOnFaces(escr
2804                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,0,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));                          memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,0,k2+1, m_NN[0],m_NN[1])), numComp*sizeof(double));
2805                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE[0]));                          double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE[0]));
2806                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2807                              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;
2808                          } // end of component loop i                          } // end of component loop i
2809                      } // end of k0 loop                      } // end of k0 loop
2810                  } // end of k2 loop                  } // end of k2 loop
# Line 2611  void Brick::interpolateNodesOnFaces(escr Line 2819  void Brick::interpolateNodesOnFaces(escr
2819                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,m_NN[1]-1,k2+1, m_NN[0],m_NN[1])), 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));
2820                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE[0]));                          double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE[0]));
2821                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2822                              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;
2823                          } // end of component loop i                          } // end of component loop i
2824                      } // end of k0 loop                      } // end of k0 loop
2825                  } // end of k2 loop                  } // end of k2 loop
# Line 2626  void Brick::interpolateNodesOnFaces(escr Line 2834  void Brick::interpolateNodesOnFaces(escr
2834                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,0, m_NN[0],m_NN[1])), numComp*sizeof(double));                          memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,0, m_NN[0],m_NN[1])), numComp*sizeof(double));
2835                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE[0]));                          double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE[0]));
2836                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2837                              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;
2838                          } // end of component loop i                          } // end of component loop i
2839                      } // end of k0 loop                      } // end of k0 loop
2840                  } // end of k1 loop                  } // end of k1 loop
# Line 2641  void Brick::interpolateNodesOnFaces(escr Line 2849  void Brick::interpolateNodesOnFaces(escr
2849                          memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,m_NN[2]-1, m_NN[0],m_NN[1])), 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));
2850                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE[0]));                          double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE[0]));
2851                          for (index_t i=0; i < numComp; ++i) {                          for (index_t i=0; i < numComp; ++i) {
2852                              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;
2853                          } // end of component loop i                          } // end of component loop i
2854                      } // end of k0 loop                      } // end of k0 loop
2855                  } // end of k1 loop                  } // end of k1 loop
# Line 2774  void Brick::interpolateNodesOnFaces(escr Line 2982  void Brick::interpolateNodesOnFaces(escr
2982      }      }
2983  }  }
2984    
2985  //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  
2986  {  {
2987      const double h0 = m_length[0]/m_gNE[0];      // Calculates a gaussian blur convolution matrix for 3D
2988      const double h1 = m_length[1]/m_gNE[1];      // See wiki article on the subject
2989      const double h2 = m_length[2]/m_gNE[2];      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  
2990      {      {
2991          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)];
2992  #pragma omp for          double common=pow(M_1_PI*0.5*1/(sigma*sigma), 3./2);
2993              for (index_t k2=k2_0; k2<m_NE[2]; k2+=2) {          double total=0;
2994                  for (index_t k1=0; k1<m_NE[1]; ++k1) {          int r=static_cast<int>(radius);
2995                      for (index_t k0=0; k0<m_NE[0]; ++k0)  {          for (int z=-r;z<=r;++z)
2996                          bool add_EM_S=false;          {
2997                          bool add_EM_F=false;              for (int y=-r;y<=r;++y)
2998                          vector<double> EM_S(8*8, 0);              {
2999                          vector<double> EM_F(8, 0);                  for (int x=-r;x<=r;++x)
3000                          const index_t e = k0 + m_NE[0]*k1 + m_NE[0]*m_NE[1]*k2;                  {        
3001                          ///////////////                      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));
3002                          // process A //                      total+=arr[(x+r)+(y+r)*(r*2+1)+(z+r)*(r*2+1)*(r*2+1)];    
3003                          ///////////////                  }
3004                          if (!A.isEmpty()) {              }
3005                              add_EM_S=true;          }
3006                              const double* A_p=const_cast<escript::Data*>(&A)->getSampleDataRO(e);          double invtotal=1/total;
3007                              if (A.actsExpanded()) {          for (size_t p=0;p<(radius*2+1)*(radius*2+1)*(radius*2+1);++p)
3008                                  const double A_00_0 = A_p[INDEX3(0,0,0,3,3)];          {
3009                                  const double A_01_0 = A_p[INDEX3(0,1,0,3,3)];              arr[p]*=invtotal;
3010                                  const double A_02_0 = A_p[INDEX3(0,2,0,3,3)];          }
3011                                  const double A_10_0 = A_p[INDEX3(1,0,0,3,3)];          return arr;
3012                                  const double A_11_0 = A_p[INDEX3(1,1,0,3,3)];      }
3013                                  const double A_12_0 = A_p[INDEX3(1,2,0,3,3)];      
3014                                  const double A_20_0 = A_p[INDEX3(2,0,0,3,3)];      // applies conv to source to get a point.
3015                                  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
3016                                  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)
                                 const double A_00_1 = A_p[INDEX3(0,0,1,3,3)];  
                                 const double A_01_1 = A_p[INDEX3(0,1,1,3,3)];  
                                 const double A_02_1 = A_p[INDEX3(0,2,1,3,3)];  
                                 const double A_10_1 = A_p[INDEX3(1,0,1,3,3)];  
                                 const double A_11_1 = A_p[INDEX3(1,1,1,3,3)];  
                                 const double A_12_1 = A_p[INDEX3(1,2,1,3,3)];  
                                 const double A_20_1 = A_p[INDEX3(2,0,1,3,3)];  
                                 const double A_21_1 = A_p[INDEX3(2,1,1,3,3)];  
                                 const double A_22_1 = A_p[INDEX3(2,2,1,3,3)];  
                                 const double A_00_2 = A_p[INDEX3(0,0,2,3,3)];  
                                 const double A_01_2 = A_p[INDEX3(0,1,2,3,3)];  
                                 const double A_02_2 = A_p[INDEX3(0,2,2,3,3)];  
                                 const double A_10_2 = A_p[INDEX3(1,0,2,3,3)];  
                                 const double A_11_2 = A_p[INDEX3(1,1,2,3,3)];  
                                 const double A_12_2 = A_p[INDEX3(1,2,2,3,3)];  
                                 const double A_20_2 = A_p[INDEX3(2,0,2,3,3)];  
                                 const double A_21_2 = A_p[INDEX3(2,1,2,3,3)];  
                                 const double A_22_2 = A_p[INDEX3(2,2,2,3,3)];  
                                 const double A_00_3 = A_p[INDEX3(0,0,3,3,3)];  
                                 const double A_01_3 = A_p[INDEX3(0,1,3,3,3)];  
                                 const double A_02_3 = A_p[INDEX3(0,2,3,3,3)];  
                                 const double A_10_3 = A_p[INDEX3(1,0,3,3,3)];  
                                 const double A_11_3 = A_p[INDEX3(1,1,3,3,3)];  
                                 const double A_12_3 = A_p[INDEX3(1,2,3,3,3)];  
                                 const double A_20_3 = A_p[INDEX3(2,0,3,3,3)];  
                                 const double A_21_3 = A_p[INDEX3(2,1,3,3,3)];  
                                 const double A_22_3 = A_p[INDEX3(2,2,3,3,3)];  
                                 const double A_00_4 = A_p[INDEX3(0,0,4,3,3)];  
                                 const double A_01_4 = A_p[INDEX3(0,1,4,3,3)];  
                                 const double A_02_4 = A_p[INDEX3(0,2,4,3,3)];  
                                 const double A_10_4 = A_p[INDEX3(1,0,4,3,3)];  
                                 const double A_11_4 = A_p[INDEX3(1,1,4,3,3)];  
                                 const double A_12_4 = A_p[INDEX3(1,2,4,3,3)];  
                                 const double A_20_4 = A_p[INDEX3(2,0,4,3,3)];  
                                 const double A_21_4 = A_p[INDEX3(2,1,4,3,3)];  
                                 const double A_22_4 = A_p[INDEX3(2,2,4,3,3)];  
                                 const double A_00_5 = A_p[INDEX3(0,0,5,3,3)];  
                                 const double A_01_5 = A_p[INDEX3(0,1,5,3,3)];  
                                 const double A_02_5 = A_p[INDEX3(0,2,5,3,3)];  
                                 const double A_10_5 = A_p[INDEX3(1,0,5,3,3)];  
                                 const double A_11_5 = A_p[INDEX3(1,1,5,3,3)];  
                                 const double A_12_5 = A_p[INDEX3(1,2,5,3,3)];  
                                 const double A_20_5 = A_p[INDEX3(2,0,5,3,3)];  
                                 const double A_21_5 = A_p[INDEX3(2,1,5,3,3)];  
                                 const double A_22_5 = A_p[INDEX3(2,2,5,3,3)];  
                                 const double A_00_6 = A_p[INDEX3(0,0,6,3,3)];  
                                 const double A_01_6 = A_p[INDEX3(0,1,6,3,3)];  
                                 const double A_02_6 = A_p[INDEX3(0,2,6,3,3)];  
                                 const double A_10_6 = A_p[INDEX3(1,0,6,3,3)];  
                                 const double A_11_6 = A_p[INDEX3(1,1,6,3,3)];  
                                 const double A_12_6 = A_p[INDEX3(1,2,6,3,3)];  
                                 const double A_20_6 = A_p[INDEX3(2,0,6,3,3)];  
                                 const double A_21_6 = A_p[INDEX3(2,1,6,3,3)];  
                                 const double A_22_6 = A_p[INDEX3(2,2,6,3,3)];  
                                 const double A_00_7 = A_p[INDEX3(0,0,7,3,3)];  
                                 const double A_01_7 = A_p[INDEX3(0,1,7,3,3)];  
                                 const double A_02_7 = A_p[INDEX3(0,2,7,3,3)];  
                                 const double A_10_7 = A_p[INDEX3(1,0,7,3,3)];  
                                 const double A_11_7 = A_p[INDEX3(1,1,7,3,3)];  
                                 const double A_12_7 = A_p[INDEX3(1,2,7,3,3)];  
                                 const double A_20_7 = A_p[INDEX3(2,0,7,3,3)];  
                                 const double A_21_7 = A_p[INDEX3(2,1,7,3,3)];  
                                 const double A_22_7 = A_p[INDEX3(2,2,7,3,3)];  
                                 const double tmp160_0 = A_12_0 + A_12_6 + A_21_0 + A_21_6;  
                                 const double tmp8_0 = A_21_0 + A_21_6;  
                                 const double tmp135_0 = A_10_1 + A_10_2 + A_10_5 + A_10_6;  
                                 const double tmp67_0 = A_02_2 + A_02_7;  
                                 const double tmp211_0 = A_12_6 + A_21_6;  
                                 const double tmp180_0 = A_10_2 + A_10_6;  
                                 const double tmp37_0 = A_00_0 + A_00_1 + A_00_2 + A_00_3;  
                                 const double tmp92_0 = A_11_0 + A_11_1 + A_11_2 + A_11_3 + A_11_4 + A_11_5 + A_11_6 + A_11_7;  
                                 const double tmp195_0 = A_02_2 + A_20_2;  
                                 const double tmp70_0 = A_01_0 + A_01_7;  
                                 const double tmp139_0 = A_02_3 + A_02_4 + A_20_1 + A_20_6;  
                                 const double tmp200_0 = A_12_3 + A_12_5 + A_21_3 + A_21_5;  
                                 const double tmp60_0 = A_22_0 + A_22_2 + A_22_4 + A_22_6;  
                                 const double tmp192_0 = A_01_5 + A_10_5;  
                                 const double tmp46_0 = A_21_0 + A_21_7;  
                                 const double tmp48_0 = A_10_0 + A_10_7;  
                                 const double tmp166_0 = A_11_5 + A_11_7;  
                                 const double tmp221_0 = A_02_1 + A_02_6 + A_20_3 + A_20_4;  
                                 const double tmp50_0 = A_02_4 + A_02_6 + A_20_4 + A_20_6;  
                                 const double tmp217_0 = A_02_3 + A_02_4 + A_20_3 + A_20_4;  
                                 const double tmp216_0 = A_01_2 + A_01_5 + A_10_2 + A_10_5;  
                                 const double tmp104_0 = A_22_2 + A_22_6;  
                                 const double tmp72_0 = A_20_3 + A_20_6;  
                                 const double tmp79_0 = A_10_4 + A_10_7;  
                                 const double tmp86_0 = A_01_2 + A_01_6 + A_10_1 + A_10_5;  
                                 const double tmp214_0 = A_12_0 + A_12_7 + A_21_0 + A_21_7;  
                                 const double tmp32_0 = A_02_0 + A_02_2;  
                                 const double tmp112_0 = A_01_0 + A_01_4 + A_10_3 + A_10_7;  
                                 const double tmp197_0 = A_12_0 + A_21_0;  
                                 const double tmp106_0 = A_22_1 + A_22_5;  
                                 const double tmp2_0 = A_00_0 + A_00_1 + A_00_4 + A_00_5;  
                                 const double tmp115_0 = A_02_5 + A_02_7 + A_20_0 + A_20_2;  
                                 const double tmp175_0 = A_01_3 + A_01_7;  
                                 const double tmp126_0 = A_01_2 + A_01_5 + A_10_1 + A_10_6;  
                                 const double tmp90_0 = A_00_0 + A_00_1 + A_00_2 + A_00_3 + A_00_4 + A_00_5 + A_00_6 + A_00_7;  
                                 const double tmp47_0 = A_12_0 + A_12_6;  
                                 const double tmp205_0 = A_02_7 + A_20_7;  
                                 const double tmp148_0 = A_01_3 + A_01_4;  
                                 const double tmp113_0 = A_01_3 + A_01_7 + A_10_0 + A_10_4;  
                                 const double tmp43_0 = A_20_4 + A_20_6;  
                                 const double tmp161_0 = A_02_1 + A_02_6 + A_20_1 + A_20_6;  
                                 const double tmp69_0 = A_12_0 + A_12_1 + A_12_6 + A_12_7 + A_21_0 + A_21_1 + A_21_6 + A_21_7;  
                                 const double tmp176_0 = A_01_1 + A_01_2 + A_01_5 + A_01_6;  
                                 const double tmp105_0 = A_01_2 + A_01_6 + A_10_2 + A_10_6;  
                                 const double tmp22_0 = A_01_5 + A_10_6;  
                                 const double tmp91_0 = A_02_4 + A_02_6 + A_20_1 + A_20_3;  
                                 const double tmp206_0 = A_12_7 + A_21_7;  
                                 const double tmp188_0 = A_02_5 + A_20_5;  
                                 const double tmp117_0 = A_21_1 + A_21_6;  
                                 const double tmp165_0 = A_01_1 + A_01_6;  
                                 const double tmp66_0 = A_00_4 + A_00_5;  
                                 const double tmp57_0 = A_02_0 + A_02_2 + A_02_5 + A_02_7 + A_20_0 + A_20_2 + A_20_5 + A_20_7;  
                                 const double tmp31_0 = A_21_4 + A_21_5;  
                                 const double tmp3_0 = A_11_0 + A_11_2 + A_11_4 + A_11_6;  
                                 const double tmp183_0 = A_12_0 + A_12_7;  
                                 const double tmp61_0 = A_02_1 + A_02_3 + A_20_1 + A_20_3;  
                                 const double tmp54_0 = A_10_5 + A_10_6;  
                                 const double tmp18_0 = A_02_3 + A_02_6;  
                                 const double tmp119_0 = A_12_2 + A_12_3 + A_12_4 + A_12_5 + A_21_2 + A_21_3 + A_21_4 + A_21_5;  
                                 const double tmp29_0 = A_21_2 + A_21_3;  
                                 const double tmp17_0 = A_01_3 + A_01_7 + A_10_3 + A_10_7;  
                                 const double tmp212_0 = A_02_6 + A_20_6;  
                                 const double tmp220_0 = A_02_3 + A_20_6;  
                                 const double tmp78_0 = A_20_0 + A_20_7;  
                                 const double tmp215_0 = A_01_6 + A_10_6;  
                                 const double tmp203_0 = A_01_7 + A_10_7;  
                                 const double tmp87_0 = A_12_2 + A_12_3 + A_21_4 + A_21_5;  
                                 const double tmp114_0 = A_02_0 + A_02_2 + A_20_5 + A_20_7;  
                                 const double tmp0_0 = A_01_0 + A_01_4 + A_10_0 + A_10_4;  
                                 const double tmp202_0 = A_01_3 + A_01_4 + A_10_3 + A_10_4;  
                                 const double tmp4_0 = A_20_0 + A_20_5;  
                                 const double tmp65_0 = A_00_2 + A_00_3;  
                                 const double tmp24_0 = A_20_1 + A_20_3;  
                                 const double tmp64_0 = A_10_0 + A_10_3;  
                                 const double tmp170_0 = A_02_0 + A_02_2 + A_20_0 + A_20_2;  
                                 const double tmp11_0 = A_20_1 + A_20_6;  
                                 const double tmp82_0 = A_12_4 + A_12_5 + A_21_4 + A_21_5;  
                                 const double tmp99_0 = A_01_4 + A_10_7;  
                                 const double tmp49_0 = A_12_1 + A_12_7;  
                                 const double tmp130_0 = A_12_0 + A_12_1 + A_12_6 + A_12_7;  
                                 const double tmp144_0 = A_01_0 + A_10_3;  
                                 const double tmp109_0 = A_22_0 + A_22_3 + A_22_4 + A_22_7;  
                                 const double tmp185_0 = A_02_0 + A_02_7 + A_20_2 + A_20_5;  
                                 const double tmp157_0 = A_01_4 + A_10_4;  
                                 const double tmp51_0 = A_22_1 + A_22_3 + A_22_5 + A_22_7;  
                                 const double tmp146_0 = A_00_6 + A_00_7;  
                                 const double tmp147_0 = A_12_0 + A_12_1 + A_21_0 + A_21_1;  
                                 const double tmp150_0 = A_00_2 + A_00_3 + A_00_4 + A_00_5;  
                                 const double tmp62_0 = A_21_3 + A_21_5;  
                                 const double tmp223_0 = A_12_2 + A_21_4;  
                                 const double tmp16_0 = A_02_2 + A_02_5;  
                                 const double tmp168_0 = A_11_1 + A_11_3 + A_11_4 + A_11_6;  
                                 const double tmp88_0 = A_12_4 + A_12_5 + A_21_2 + A_21_3;  
                                 const double tmp142_0 = A_01_7 + A_10_4;  
                                 const double tmp34_0 = A_20_0 + A_20_2 + A_20_5 + A_20_7;  
                                 const double tmp71_0 = A_00_0 + A_00_1 + A_00_6 + A_00_7;  
                                 const double tmp213_0 = A_02_1 + A_20_1;  
                                 const double tmp227_0 = A_12_2 + A_12_5 + A_21_3 + A_21_4;  
                                 const double tmp228_0 = A_12_1 + A_21_7;  
                                 const double tmp140_0 = A_01_2 + A_01_6;  
                                 const double tmp74_0 = A_22_0 + A_22_1 + A_22_4 + A_22_5;  
                                 const double tmp167_0 = A_11_0 + A_11_2;  
                                 const double tmp143_0 = A_01_3 + A_01_4 + A_10_0 + A_10_7;  
                                 const double tmp83_0 = A_02_0 + A_02_5;  
                                 const double tmp14_0 = A_22_1 + A_22_2 + A_22_5 + A_22_6;  
                                 const double tmp5_0 = A_12_1 + A_12_6;  
                                 const double tmp94_0 = A_02_1 + A_02_3;  
                                 const double tmp193_0 = A_01_1 + A_01_6 + A_10_1 + A_10_6;  
                                 const double tmp97_0 = A_02_0 + A_02_2 + A_02_5 + A_02_7;  
                                 const double tmp131_0 = A_01_1 + A_01_5;  
                                 const double tmp124_0 = A_01_6 + A_10_5;  
                                 const double tmp149_0 = A_12_6 + A_12_7 + A_21_6 + A_21_7;  
                                 const double tmp187_0 = A_01_2 + A_10_2;  
                                 const double tmp93_0 = A_01_1 + A_01_2 + A_10_1 + A_10_2;  
                                 const double tmp25_0 = A_01_4 + A_01_7 + A_10_4 + A_10_7;  
                                 const double tmp156_0 = A_12_2 + A_12_5 + A_21_2 + A_21_5;  
                                 const double tmp20_0 = A_21_2 + A_21_5;  
                                 const double tmp55_0 = A_21_2 + A_21_4;  
                                 const double tmp208_0 = A_12_1 + A_12_6 + A_21_0 + A_21_7;  
                                 const double tmp125_0 = A_12_4 + A_12_5;  
                                 const double tmp158_0 = A_01_0 + A_01_7 + A_10_0 + A_10_7;  
                                 const double tmp108_0 = A_01_1 + A_01_5 + A_10_1 + A_10_5;  
                                 const double tmp199_0 = A_12_2 + A_12_4 + A_21_2 + A_21_4;  
                                 const double tmp10_0 = A_02_1 + A_02_4;  
                                 const double tmp182_0 = A_02_3 + A_02_6 + A_20_3 + A_20_6;  
                                 const double tmp132_0 = A_02_1 + A_20_4;  
                                 const double tmp191_0 = A_12_3 + A_12_4 + A_21_3 + A_21_4;  
                                 const double tmp35_0 = A_11_0 + A_11_1 + A_11_2 + A_11_3;  
                                 const double tmp164_0 = A_10_3 + A_10_4;  
                                 const double tmp190_0 = A_12_5 + A_21_5;  
                                 const double tmp73_0 = A_02_1 + A_02_6;  
                                 const double tmp98_0 = A_01_0 + A_01_7 + A_10_3 + A_10_4;  
                                 const double tmp225_0 = A_12_4 + A_21_2;  
                                 const double tmp103_0 = A_02_4 + A_02_6;  
                                 const double tmp194_0 = A_02_0 + A_02_7 + A_20_0 + A_20_7;  
                                 const double tmp207_0 = A_12_0 + A_21_6;  
                                 const double tmp102_0 = A_20_5 + A_20_7;  
                                 const double tmp1_0 = A_22_3 + A_22_7;  
                                 const double tmp172_0 = A_10_1 + A_10_5;  
                                 const double tmp222_0 = A_12_5 + A_21_3;  
                                 const double tmp201_0 = A_02_2 + A_02_5 + A_20_2 + A_20_5;  
                                 const double tmp155_0 = A_12_4 + A_21_4;  
                                 const double tmp174_0 = A_02_1 + A_02_4 + A_20_1 + A_20_4;  
                                 const double tmp59_0 = A_01_0 + A_01_3;  
                                 const double tmp21_0 = A_20_2 + A_20_7;  
                                 const double tmp141_0 = A_02_2 + A_02_7 + A_20_2 + A_20_7;  
                                 const double tmp210_0 = A_01_1 + A_10_1;  
                                 const double tmp145_0 = A_00_0 + A_00_1;  
                                 const double tmp121_0 = A_12_0 + A_12_1 + A_21_6 + A_21_7;  
                                 const double tmp224_0 = A_12_3 + A_12_4 + A_21_2 + A_21_5;  
                                 const double tmp186_0 = A_02_2 + A_20_7;  
                                 const double tmp53_0 = A_11_4 + A_11_6;  
                                 const double tmp184_0 = A_02_5 + A_20_0;  
                                 const double tmp38_0 = A_12_0 + A_12_1;  
                                 const double tmp12_0 = A_01_1 + A_01_2 + A_01_5 + A_01_6 + A_10_1 + A_10_2 + A_10_5 + A_10_6;  
                                 const double tmp230_0 = A_12_6 + A_21_0;  
                                 const double tmp23_0 = A_11_4 + A_11_5 + A_11_6 + A_11_7;  
                                 const double tmp81_0 = A_20_1 + A_20_4;  
                                 const double tmp134_0 = A_10_3 + A_10_7;  
                                 const double tmp129_0 = A_21_0 + A_21_1;  
                                 const double tmp137_0 = A_01_0 + A_01_3 + A_01_4 + A_01_7;  
                                 const double tmp198_0 = A_01_0 + A_10_0;  
                                 const double tmp9_0 = A_21_1 + A_21_7;  
                                 const double tmp179_0 = A_01_0 + A_01_4;  
                                 const double tmp100_0 = A_20_1 + A_20_3 + A_20_4 + A_20_6;  
                                 const double tmp173_0 = A_02_0 + A_20_5;  
                                 const double tmp42_0 = A_21_0 + A_21_1 + A_21_6 + A_21_7;  
                                 const double tmp226_0 = A_12_3 + A_21_5;  
                                 const double tmp6_0 = A_22_0 + A_22_4;  
                                 const double tmp218_0 = A_12_1 + A_21_1;  
                                 const double tmp28_0 = A_01_2 + A_10_1;  
                                 const double tmp133_0 = A_02_6 + A_20_3;  
                                 const double tmp13_0 = A_00_2 + A_00_3 + A_00_6 + A_00_7;  
                                 const double tmp27_0 = A_12_2 + A_12_3 + A_12_4 + A_12_5;  
                                 const double tmp75_0 = A_10_1 + A_10_6;  
                                 const double tmp36_0 = A_01_0 + A_01_3 + A_10_0 + A_10_3;  
                                 const double tmp138_0 = A_10_0 + A_10_4;  
                                 const double tmp189_0 = A_12_2 + A_21_2;  
                                 const double tmp181_0 = A_02_7 + A_20_2;  
                                 const double tmp85_0 = A_02_1 + A_02_3 + A_20_4 + A_20_6;  
                                 const double tmp122_0 = A_01_1 + A_10_2;  
                                 const double tmp95_0 = A_01_3 + A_10_0;  
                                 const double tmp120_0 = A_12_6 + A_12_7 + A_21_0 + A_21_1;  
                                 const double tmp196_0 = A_02_0 + A_20_0;  
                                 const double tmp171_0 = A_02_3 + A_02_4;  
                                 const double tmp204_0 = A_12_1 + A_12_6 + A_21_1 + A_21_6;  
                                 const double tmp45_0 = A_10_1 + A_10_2;  
                                 const double tmp101_0 = A_01_5 + A_01_6 + A_10_5 + A_10_6;  
                                 const double tmp58_0 = A_11_0 + A_11_2 + A_11_5 + A_11_7;  
                                 const double tmp107_0 = A_20_3 + A_20_4;  
                                 const double tmp30_0 = A_01_1 + A_01_6 + A_10_2 + A_10_5;  
                                 const double tmp63_0 = A_12_2 + A_12_5;  
                                 const double tmp127_0 = A_12_2 + A_12_3;  
                                 const double tmp177_0 = A_02_2 + A_02_5 + A_20_0 + A_20_7;  
                                 const double tmp178_0 = A_10_0 + A_10_3 + A_10_4 + A_10_7;  
                                 const double tmp76_0 = A_01_1 + A_01_2;  
                                 const double tmp80_0 = A_22_2 + A_22_3 + A_22_6 + A_22_7;  
                                 const double tmp41_0 = A_12_6 + A_12_7;  
                                 const double tmp89_0 = A_01_0 + A_01_3 + A_01_4 + A_01_7 + A_10_0 + A_10_3 + A_10_4 + A_10_7;  
                                 const double tmp116_0 = A_02_1 + A_02_3 + A_02_4 + A_02_6 + A_20_1 + A_20_3 + A_20_4 + A_20_6;  
                                 const double tmp33_0 = A_22_0 + A_22_1 + A_22_2 + A_22_3 + A_22_4 + A_22_5 + A_22_6 + A_22_7;  
                                 const double tmp169_0 = A_21_3 + A_21_4;  
                                 const double tmp96_0 = A_20_0 + A_20_2;  
                                 const double tmp111_0 = A_12_3 + A_12_4;  
                                 const double tmp118_0 = A_20_2 + A_20_5;  
                                 const double tmp19_0 = A_12_3 + A_12_5;  
                                 const double tmp68_0 = A_01_5 + A_01_6;  
                                 const double tmp7_0 = A_11_1 + A_11_3 + A_11_5 + A_11_7;  
                                 const double tmp154_0 = A_12_3 + A_21_3;  
                                 const double tmp152_0 = A_02_4 + A_20_4;  
                                 const double tmp153_0 = A_02_3 + A_20_3;  
                                 const double tmp163_0 = A_02_5 + A_02_7 + A_20_5 + A_20_7;  
                                 const double tmp44_0 = A_01_4 + A_01_7;  
                                 const double tmp39_0 = A_02_1 + A_02_3 + A_02_4 + A_02_6;  
                                 const double tmp123_0 = A_21_2 + A_21_3 + A_21_4 + A_21_5;  
                                 const double tmp40_0 = A_02_5 + A_02_7;  
                                 const double tmp110_0 = A_02_0 + A_02_7;  
                                 const double tmp77_0 = A_12_2 + A_12_3 + A_21_2 + A_21_3;  
                                 const double tmp209_0 = A_12_7 + A_21_1;  
                                 const double tmp219_0 = A_02_4 + A_20_1;  
                                 const double tmp84_0 = A_01_1 + A_01_5 + A_10_2 + A_10_6;  
                                 const double tmp162_0 = A_12_1 + A_12_7 + A_21_1 + A_21_7;  
                                 const double tmp159_0 = A_01_3 + A_10_3;  
                                 const double tmp56_0 = A_11_1 + A_11_3;  
                                 const double tmp52_0 = A_01_2 + A_01_5;  
                                 const double tmp26_0 = A_00_4 + A_00_5 + A_00_6 + A_00_7;  
                                 const double tmp229_0 = A_12_0 + A_12_7 + A_21_1 + A_21_6;  
                                 const double tmp151_0 = A_10_2 + A_10_5;  
                                 const double tmp136_0 = A_02_0 + A_02_5 + A_20_0 + A_20_5;  
                                 const double tmp128_0 = A_21_6 + A_21_7;  
                                 const double tmp15_0 = A_12_2 + A_12_4;  
                                 const double tmp296_1 = tmp159_0*w42;  
                                 const double tmp130_1 = tmp67_0*w5;  
                                 const double tmp98_1 = A_01_6*w42;  
                                 const double tmp231_1 = tmp125_0*w6;  
                                 const double tmp42_1 = tmp34_0*w12;  
                                 const double tmp199_1 = A_02_5*w28;  
                                 const double tmp113_1 = tmp29_0*w13;  
                                 const double tmp330_1 = tmp152_0*w28;  
                                 const double tmp90_1 = A_01_1*w46;  
                                 const double tmp446_1 = tmp77_0*w22;  
                                 const double tmp108_1 = tmp43_0*w5;  
                                 const double tmp524_1 = A_12_6*w29;  
                                 const double tmp232_1 = tmp126_0*w34;  
                                 const double tmp33_1 = tmp25_0*w37;  
                                 const double tmp461_1 = tmp180_0*w1;  
                                 const double tmp14_1 = tmp8_0*w6;  
                                 const double tmp447_1 = tmp205_0*w26;  
                                 const double tmp452_1 = tmp198_0*w42;  
                                 const double tmp217_1 = tmp81_0*w9;  
                                 const double tmp76_1 = tmp59_0*w20;  
                                 const double tmp421_1 = tmp134_0*w31;  
                                 const double tmp485_1 = tmp51_0*w51;  
                                 const double tmp240_1 = tmp131_0*w1;  
                                 const double tmp160_1 = tmp91_0*w9;  
                                 const double tmp174_1 = A_20_1*w26;  
                                 const double tmp273_1 = A_10_1*w46;  
                                 const double tmp159_1 = tmp90_0*w47;  
                                 const double tmp228_1 = tmp103_0*w5;  
                                 const double tmp313_1 = tmp166_0*w45;  
                                 const double tmp45_1 = tmp37_0*w30;  
                                 const double tmp512_1 = tmp147_0*w13;  
                                 const double tmp73_1 = tmp56_0*w43;  
                                 const double tmp61_1 = A_01_6*w46;  
                                 const double tmp316_1 = tmp167_0*w43;  
                                 const double tmp189_1 = tmp112_0*w20;  
                                 const double tmp455_1 = tmp215_0*w39;  
                                 const double tmp360_1 = A_21_5*w24;  
                                 const double tmp258_1 = A_20_7*w2;  
                                 const double tmp196_1 = A_20_6*w26;  
                                 const double tmp37_1 = tmp29_0*w6;  
                                 const double tmp9_1 = A_12_7*w29;  
                                 const double tmp80_1 = tmp63_0*w19;  
                                 const double tmp312_1 = tmp165_0*w8;  
                                 const double tmp264_1 = tmp101_0*w1;  
                                 const double tmp124_1 = A_02_3*w26;  
                                 const double tmp229_1 = tmp123_0*w11;  
                                 const double tmp333_1 = tmp159_0*w46;  
                                 const double tmp533_1 = tmp222_0*w4;  
                                 const double tmp201_1 = tmp108_0*w37;  
                                 const double tmp444_1 = tmp35_0*w10;  
                                 const double tmp51_1 = tmp43_0*w18;  
                                 const double tmp214_1 = A_21_7*w29;  
                                 const double tmp518_1 = tmp86_0*w37;  
                                 const double tmp192_1 = tmp115_0*w5;  
                                 const double tmp355_1 = A_21_2*w27;  
                                 const double tmp156_1 = tmp87_0*w22;  
                                 const double tmp516_1 = tmp230_0*w27;  
                                 const double tmp366_1 = tmp104_0*w57;  
                                 const double tmp271_1 = tmp146_0*w49;  
                                 const double tmp437_1 = tmp218_0*w24;  
                                 const double tmp436_1 = tmp104_0*w54;  
                                 const double tmp167_1 = tmp98_0*w8;  
                                 const double tmp136_1 = tmp70_0*w34;  
                                 const double tmp406_1 = tmp207_0*w27;  
                                 const double tmp193_1 = tmp116_0*w12;  
                                 const double tmp486_1 = tmp225_0*w29;  
                                 const double tmp469_1 = tmp224_0*w11;  
                                 const double tmp287_1 = tmp71_0*w53;  
                                 const double tmp430_1 = tmp213_0*w28;  
                                 const double tmp462_1 = tmp220_0*w2;  
                                 const double tmp294_1 = tmp53_0*w59;  
                                 const double tmp218_1 = tmp118_0*w16;  
                                 const double tmp116_1 = tmp25_0*w31;  
                                 const double tmp495_1 = tmp76_0*w37;  
                                 const double tmp501_1 = tmp99_0*w46;  
                                 const double tmp0_1 = tmp0_0*w1;  
                                 const double tmp99_1 = tmp62_0*w17;  
                                 const double tmp429_1 = tmp212_0*w2;  
                                 const double tmp249_1 = tmp136_0*w9;  
                                 const double tmp504_1 = tmp229_0*w19;  
                                 const double tmp197_1 = A_12_2*w27;  
                                 const double tmp531_1 = tmp122_0*w35;  
                                 const double tmp265_1 = tmp142_0*w46;  
                                 const double tmp488_1 = tmp226_0*w4;  
                                 const double tmp528_1 = tmp115_0*w18;  
                                 const double tmp438_1 = tmp219_0*w2;  
                                 const double tmp233_1 = tmp127_0*w13;  
                                 const double tmp491_1 = tmp79_0*w1;  
                                 const double tmp215_1 = A_21_0*w4;  
                                 const double tmp24_1 = tmp18_0*w21;  
                                 const double tmp538_1 = tmp209_0*w27;  
                                 const double tmp379_1 = tmp167_0*w55;  
                                 const double tmp332_1 = tmp154_0*w4;  
                                 const double tmp498_1 = tmp68_0*w31;  
                                 const double tmp41_1 = tmp33_0*w33;  
                                 const double tmp464_1 = tmp179_0*w37;  
                                 const double tmp317_1 = tmp168_0*w40;  
                                 const double tmp378_1 = tmp106_0*w54;  
                                 const double tmp184_1 = tmp109_0*w14;  
                                 const double tmp292_1 = tmp14_0*w33;  
                                 const double tmp11_1 = tmp5_0*w11;  
                                 const double tmp354_1 = A_02_6*w26;  
                                 const double tmp84_1 = tmp37_0*w0;  
                                 const double tmp422_1 = tmp13_0*w30;  
                                 const double tmp132_1 = tmp69_0*w11;  
                                 const double tmp251_1 = tmp138_0*w31;  
                                 const double tmp18_1 = tmp12_0*w8;  
                                 const double tmp88_1 = A_21_1*w4;  
                                 const double tmp188_1 = A_12_2*w24;  
                                 const double tmp465_1 = tmp175_0*w31;  
                                 const double tmp235_1 = tmp128_0*w17;  
                                 const double tmp323_1 = A_02_1*w26;  
                                 const double tmp31_1 = tmp23_0*w38;  
                                 const double tmp397_1 = tmp170_0*w5;  
                                 const double tmp175_1 = tmp7_0*w3;  
                                 const double tmp148_1 = tmp81_0*w21;  
                                 const double tmp238_1 = tmp130_0*w19;  
                                 const double tmp59_1 = tmp46_0*w11;  
                                 const double tmp432_1 = tmp215_0*w35;  
                                 const double tmp398_1 = A_01_2*w46;  
                                 const double tmp497_1 = A_10_5*w46;  
                                 const double tmp28_1 = tmp21_0*w18;  
                                 const double tmp115_1 = tmp23_0*w32;  
                                 const double tmp441_1 = tmp23_0*w3;  
                                 const double tmp131_1 = tmp68_0*w37;  
                                 const double tmp289_1 = tmp155_0*w4;  
                                 const double tmp278_1 = tmp80_0*w44;  
                                 const double tmp5_1 = A_21_4*w27;  
                                 const double tmp254_1 = tmp140_0*w20;  
                                 const double tmp183_1 = tmp108_0*w31;  
                                 const double tmp279_1 = tmp151_0*w8;  
                                 const double tmp298_1 = tmp161_0*w16;  
                                 const double tmp505_1 = tmp230_0*w24;  
                                 const double tmp246_1 = tmp80_0*w52;  
                                 const double tmp100_1 = tmp53_0*w43;  
                                 const double tmp440_1 = tmp221_0*w16;  
                                 const double tmp481_1 = tmp188_0*w23;  
                                 const double tmp480_1 = tmp187_0*w35;  
                                 const double tmp384_1 = tmp150_0*w53;  
                                 const double tmp142_1 = tmp76_0*w31;  
                                 const double tmp372_1 = tmp191_0*w11;  
                                 const double tmp307_1 = A_10_7*w35;  
                                 const double tmp186_1 = tmp111_0*w19;  
                                 const double tmp127_1 = A_20_2*w2;  
                                 const double tmp391_1 = tmp167_0*w59;  
                                 const double tmp223_1 = tmp113_0*w20;  
                                 const double tmp454_1 = tmp197_0*w24;  
                                 const double tmp241_1 = tmp74_0*w51;  
                                 const double tmp529_1 = tmp114_0*w5;  
                                 const double tmp202_1 = tmp104_0*w7;  
                                 const double tmp236_1 = tmp96_0*w21;  
                                 const double tmp358_1 = tmp183_0*w11;  
                                 const double tmp102_1 = tmp51_0*w41;  
                                 const double tmp493_1 = A_20_5*w2;  
                                 const double tmp468_1 = tmp223_0*w4;  
                                 const double tmp435_1 = tmp217_0*w16;  
                                 const double tmp110_1 = tmp37_0*w36;  
                                 const double tmp479_1 = tmp189_0*w4;  
                                 const double tmp120_1 = tmp38_0*w22;  
                                 const double tmp16_1 = tmp10_0*w9;  
                                 const double tmp407_1 = tmp90_0*w53;  
                                 const double tmp442_1 = tmp66_0*w48;  
                                 const double tmp60_1 = A_10_4*w35;  
                                 const double tmp69_1 = tmp53_0*w45;  
                                 const double tmp144_1 = tmp77_0*w17;  
                                 const double tmp507_1 = tmp146_0*w48;  
                                 const double tmp424_1 = tmp174_0*w18;  
                                 const double tmp352_1 = tmp181_0*w23;  
                                 const double tmp451_1 = tmp199_0*w13;  
                                 const double tmp253_1 = tmp139_0*w16;  
                                 const double tmp353_1 = tmp182_0*w18;  
                                 const double tmp521_1 = tmp88_0*w22;  
                                 const double tmp346_1 = tmp175_0*w37;  
                                 const double tmp416_1 = tmp138_0*w37;  
                                 const double tmp324_1 = A_10_0*w35;  
                                 const double tmp152_1 = tmp84_0*w37;  
                                 const double tmp119_1 = tmp32_0*w21;  
                                 const double tmp86_1 = A_21_6*w29;  
                                 const double tmp290_1 = tmp156_0*w11;  
                                 const double tmp382_1 = tmp196_0*w26;  
                                 const double tmp91_1 = tmp49_0*w6;  
                                 const double tmp499_1 = A_10_2*w42;  
                                 const double tmp226_1 = tmp121_0*w13;  
                                 const double tmp477_1 = tmp195_0*w26;  
                                 const double tmp150_1 = A_02_4*w23;  
                                 const double tmp318_1 = tmp15_0*w22;  
                                 const double tmp396_1 = tmp206_0*w24;  
                                 const double tmp474_1 = A_02_0*w28;  
                                 const double tmp245_1 = tmp134_0*w37;  
                                 const double tmp3_1 = A_20_4*w26;  
                                 const double tmp44_1 = tmp36_0*w31;  
                                 const double tmp487_1 = tmp60_0*w52;  
                                 const double tmp293_1 = tmp158_0*w8;  
                                 const double tmp314_1 = A_01_2*w42;  
                                 const double tmp414_1 = tmp80_0*w51;  
                                 const double tmp472_1 = A_21_3*w27;  
                                 const double tmp321_1 = A_21_2*w24;  
                                 const double tmp225_1 = tmp120_0*w6;  
                                 const double tmp377_1 = tmp166_0*w59;  
                                 const double tmp413_1 = tmp186_0*w26;  
                                 const double tmp385_1 = tmp166_0*w55;  
                                 const double tmp310_1 = tmp164_0*w34;  
                                 const double tmp158_1 = tmp89_0*w34;  
                                 const double tmp449_1 = tmp203_0*w46;  
                                 const double tmp439_1 = tmp220_0*w28;  
                                 const double tmp22_1 = tmp16_0*w16;  
                                 const double tmp164_1 = tmp95_0*w46;  
                                 const double tmp417_1 = tmp74_0*w52;  
                                 const double tmp257_1 = tmp6_0*w25;  
                                 const double tmp203_1 = tmp18_0*w9;  
                                 const double tmp286_1 = tmp153_0*w28;  
                                 const double tmp155_1 = tmp33_0*w14;  
                                 const double tmp389_1 = tmp201_0*w12;  
                                 const double tmp508_1 = tmp145_0*w49;  
                                 const double tmp300_1 = tmp56_0*w55;  
                                 const double tmp299_1 = tmp162_0*w22;  
                                 const double tmp173_1 = tmp104_0*w25;  
                                 const double tmp32_1 = tmp24_0*w5;  
                                 const double tmp227_1 = tmp122_0*w39;  
                                 const double tmp484_1 = tmp3_0*w38;  
                                 const double tmp171_1 = tmp102_0*w21;  
                                 const double tmp478_1 = tmp190_0*w29;  
                                 const double tmp320_1 = tmp170_0*w18;  
                                 const double tmp327_1 = tmp6_0*w57;  
                                 const double tmp490_1 = tmp7_0*w32;  
                                 const double tmp419_1 = tmp127_0*w6;  
                                 const double tmp463_1 = tmp219_0*w28;  
                                 const double tmp12_1 = tmp6_0*w7;  
                                 const double tmp49_1 = tmp41_0*w22;  
                                 const double tmp344_1 = tmp173_0*w26;  
                                 const double tmp243_1 = tmp132_0*w2;  
                                 const double tmp83_1 = A_10_4*w39;  
                                 const double tmp297_1 = tmp160_0*w17;  
                                 const double tmp275_1 = tmp148_0*w34;  
                                 const double tmp168_1 = tmp99_0*w42;  
                                 const double tmp409_1 = tmp3_0*w32;  
                                 const double tmp1_1 = tmp1_0*w25;  
                                 const double tmp426_1 = tmp210_0*w39;  
                                 const double tmp375_1 = tmp109_0*w33;  
                                 const double tmp50_1 = tmp42_0*w19;  
                                 const double tmp513_1 = A_10_1*w42;  
                                 const double tmp97_1 = tmp45_0*w31;  
                                 const double tmp403_1 = tmp140_0*w1;  
                                 const double tmp71_1 = A_01_1*w42;  
                                 const double tmp520_1 = tmp84_0*w31;  
                                 const double tmp510_1 = A_10_6*w46;  
                                 const double tmp302_1 = A_10_0*w39;  
                                 const double tmp364_1 = tmp128_0*w22;  
                                 const double tmp515_1 = tmp142_0*w42;  
                                 const double tmp283_1 = tmp65_0*w56;  
                                 const double tmp222_1 = tmp112_0*w1;  
                                 const double tmp428_1 = tmp211_0*w27;  
                                 const double tmp371_1 = tmp190_0*w4;  
                                 const double tmp423_1 = tmp184_0*w23;  
                                 const double tmp276_1 = tmp149_0*w13;  
                                 const double tmp65_1 = tmp50_0*w9;  
                                 const double tmp305_1 = A_12_0*w29;  
                                 const double tmp170_1 = tmp101_0*w20;  
                                 const double tmp350_1 = tmp179_0*w31;  
                                 const double tmp466_1 = tmp172_0*w20;  
                                 const double tmp361_1 = tmp184_0*w26;  
                                 const double tmp431_1 = tmp214_0*w19;  
                                 const double tmp363_1 = tmp129_0*w17;  
                                 const double tmp178_1 = A_02_2*w28;  
                                 const double tmp527_1 = tmp120_0*w13;  
                                 const double tmp415_1 = tmp182_0*w5;  
                                 const double tmp450_1 = tmp200_0*w6;  
                                 const double tmp269_1 = A_01_7*w39;  
                                 const double tmp285_1 = tmp152_0*w2;  
                                 const double tmp272_1 = A_01_0*w35;  
                                 const double tmp339_1 = tmp136_0*w21;  
                                 const double tmp502_1 = tmp95_0*w42;  
                                 const double tmp38_1 = tmp30_0*w34;  
                                 const double tmp514_1 = tmp144_0*w46;  
                                 const double tmp96_1 = tmp56_0*w45;  
                                 const double tmp399_1 = tmp167_0*w45;  
                                 const double tmp483_1 = tmp173_0*w23;  
                                 const double tmp522_1 = tmp87_0*w17;  
                                 const double tmp519_1 = tmp91_0*w21;  
                                 const double tmp209_1 = A_12_5*w24;  
                                 const double tmp126_1 = tmp65_0*w48;  
                                 const double tmp367_1 = tmp187_0*w39;  
                                 const double tmp221_1 = tmp67_0*w18;  
                                 const double tmp381_1 = tmp146_0*w56;  
                                 const double tmp70_1 = tmp54_0*w31;  
                                 const double tmp216_1 = tmp117_0*w11;  
                                 const double tmp473_1 = A_02_7*w2;  
                                 const double tmp149_1 = tmp82_0*w22;  
                                 const double tmp357_1 = A_12_6*w4;  
                                 const double tmp534_1 = tmp226_0*w29;  
                                 const double tmp95_1 = tmp26_0*w15;  
                                 const double tmp500_1 = tmp64_0*w20;  
                                 const double tmp387_1 = tmp199_0*w6;  
                                 const double tmp471_1 = A_20_4*w23;  
                                 const double tmp281_1 = tmp74_0*w41;  
                                 const double tmp351_1 = tmp180_0*w20;  
                                 const double tmp63_1 = tmp48_0*w34;  
                                 const double tmp365_1 = tmp186_0*w23;  
                                 const double tmp448_1 = tmp206_0*w27;  
                                 const double tmp39_1 = tmp31_0*w13;  
                                 const double tmp453_1 = tmp196_0*w23;  
                                 const double tmp402_1 = tmp163_0*w18;  
                                 const double tmp137_1 = tmp71_0*w47;  
                                 const double tmp6_1 = A_02_0*w2;  
                                 const double tmp34_1 = tmp26_0*w36;  
                                 const double tmp383_1 = tmp197_0*w27;  
                                 const double tmp166_1 = tmp97_0*w12;  
                                 const double tmp114_1 = tmp40_0*w9;  
                                 const double tmp306_1 = A_12_7*w4;  
                                 const double tmp530_1 = tmp124_0*w39;  
                                 const double tmp388_1 = tmp200_0*w13;  
                                 const double tmp252_1 = tmp2_0*w30;  
                                 const double tmp210_1 = A_02_4*w26;  
                                 const double tmp200_1 = tmp21_0*w5;  
                                 const double tmp181_1 = tmp3_0*w10;  
                                 const double tmp425_1 = tmp106_0*w57;  
                                 const double tmp261_1 = A_21_7*w4;  
                                 const double tmp64_1 = tmp49_0*w13;  
                                 const double tmp506_1 = A_01_0*w39;  
                                 const double tmp457_1 = tmp213_0*w2;  
                                 const double tmp2_1 = tmp2_0*w0;  
                                 const double tmp393_1 = tmp203_0*w42;  
                                 const double tmp133_1 = A_01_3*w35;  
                                 const double tmp147_1 = tmp80_0*w41;  
                                 const double tmp8_1 = tmp4_0*w5;  
                                 const double tmp267_1 = tmp144_0*w42;  
                                 const double tmp17_1 = tmp11_0*w12;  
                                 const double tmp284_1 = tmp58_0*w50;  
                                 const double tmp328_1 = tmp66_0*w56;  
                                 const double tmp405_1 = tmp60_0*w51;  
                                 const double tmp467_1 = tmp222_0*w29;  
                                 const double tmp535_1 = tmp225_0*w4;  
                                 const double tmp356_1 = A_12_1*w29;  
                                 const double tmp274_1 = tmp147_0*w6;  
                                 const double tmp476_1 = tmp192_0*w39;  
                                 const double tmp206_1 = tmp10_0*w21;  
                                 const double tmp334_1 = tmp141_0*w9;  
                                 const double tmp482_1 = tmp181_0*w26;  
                                 const double tmp212_1 = A_20_7*w28;  
                                 const double tmp219_1 = tmp72_0*w21;  
                                 const double tmp47_1 = tmp39_0*w16;  
                                 const double tmp89_1 = A_10_3*w35;  
                                 const double tmp52_1 = tmp44_0*w1;  
                                 const double tmp492_1 = A_01_3*w39;  
                                 const double tmp81_1 = A_12_3*w24;  
                                 const double tmp77_1 = tmp60_0*w41;  
                                 const double tmp153_1 = tmp85_0*w21;  
                                 const double tmp304_1 = tmp163_0*w5;  
                                 const double tmp489_1 = tmp227_0*w11;  
                                 const double tmp107_1 = tmp35_0*w38;  
                                 const double tmp30_1 = tmp22_0*w39;  
                                 const double tmp260_1 = A_21_0*w29;  
                                 const double tmp343_1 = tmp172_0*w1;  
                                 const double tmp511_1 = tmp149_0*w6;  
                                 const double tmp139_1 = tmp73_0*w12;  
                                 const double tmp66_1 = tmp51_0*w44;  
                                 const double tmp208_1 = tmp4_0*w18;  
                                 const double tmp134_1 = tmp23_0*w10;  
                                 const double tmp205_1 = tmp105_0*w31;  
                                 const double tmp349_1 = tmp178_0*w8;  
                                 const double tmp341_1 = tmp53_0*w55;  
                                 const double tmp72_1 = tmp55_0*w17;  
                                 const double tmp79_1 = tmp62_0*w22;  
                                 const double tmp26_1 = tmp20_0*w19;  
                                 const double tmp141_1 = tmp75_0*w8;  
                                 const double tmp118_1 = tmp41_0*w17;  
                                 const double tmp259_1 = A_20_0*w28;  
                                 const double tmp458_1 = tmp212_0*w28;  
                                 const double tmp68_1 = tmp37_0*w15;  
                                 const double tmp154_1 = tmp86_0*w31;  
                                 const double tmp335_1 = tmp56_0*w59;  
                                 const double tmp359_1 = A_02_1*w23;  
                                 const double tmp56_1 = A_21_1*w29;  
                                 const double tmp392_1 = tmp145_0*w58;  
                                 const double tmp270_1 = tmp145_0*w48;  
                                 const double tmp92_1 = tmp47_0*w13;  
                                 const double tmp433_1 = tmp216_0*w34;  
                                 const double tmp420_1 = tmp125_0*w13;  
                                 const double tmp408_1 = tmp51_0*w52;  
                                 const double tmp494_1 = A_20_2*w28;  
                                 const double tmp362_1 = tmp185_0*w12;  
                                 const double tmp411_1 = tmp208_0*w19;  
                                 const double tmp336_1 = tmp65_0*w58;  
                                 const double tmp475_1 = A_21_4*w24;  
                                 const double tmp85_1 = A_12_3*w27;  
                                 const double tmp19_1 = tmp13_0*w15;  
                                 const double tmp537_1 = tmp132_0*w28;  
                                 const double tmp67_1 = tmp52_0*w8;  
                                 const double tmp459_1 = tmp210_0*w35;  
                                 const double tmp248_1 = tmp135_0*w34;  
                                 const double tmp326_1 = A_02_6*w23;  
                                 const double tmp23_1 = tmp17_0*w20;  
                                 const double tmp35_1 = tmp27_0*w11;  
                                 const double tmp62_1 = tmp47_0*w6;  
                                 const double tmp180_1 = tmp106_0*w7;  
                                 const double tmp277_1 = tmp150_0*w47;  
                                 const double tmp373_1 = tmp192_0*w35;  
                                 const double tmp337_1 = tmp157_0*w42;  
                                 const double tmp106_1 = tmp28_0*w39;  
                                 const double tmp369_1 = tmp168_0*w50;  
                                 const double tmp434_1 = tmp146_0*w58;  
                                 const double tmp331_1 = tmp155_0*w29;  
                                 const double tmp503_1 = tmp228_0*w27;  
                                 const double tmp93_1 = tmp61_0*w9;  
                                 const double tmp25_1 = tmp19_0*w22;  
                                 const double tmp146_1 = tmp79_0*w20;  
                                 const double tmp280_1 = A_10_6*w42;  
                                 const double tmp94_1 = tmp60_0*w44;  
                                 const double tmp400_1 = A_01_5*w42;  
                                 const double tmp151_1 = tmp83_0*w18;  
                                 const double tmp78_1 = tmp61_0*w21;  
                                 const double tmp301_1 = tmp6_0*w54;  
                                 const double tmp48_1 = tmp40_0*w21;  
                                 const double tmp75_1 = tmp58_0*w40;  
                                 const double tmp82_1 = tmp59_0*w1;  
                                 const double tmp74_1 = tmp57_0*w16;  
                                 const double tmp36_1 = tmp28_0*w35;  
                                 const double tmp370_1 = tmp189_0*w29;  
                                 const double tmp224_1 = tmp119_0*w19;  
                                 const double tmp109_1 = tmp36_0*w37;  
                                 const double tmp345_1 = tmp174_0*w5;  
                                 const double tmp101_1 = tmp44_0*w20;  
                                 const double tmp308_1 = A_01_5*w46;  
                                 const double tmp295_1 = tmp66_0*w58;  
                                 const double tmp117_1 = tmp26_0*w30;  
                                 const double tmp125_1 = tmp35_0*w3;  
                                 const double tmp309_1 = tmp9_0*w6;  
                                 const double tmp412_1 = tmp209_0*w24;  
                                 const double tmp46_1 = tmp38_0*w17;  
                                 const double tmp7_1 = A_02_7*w28;  
                                 const double tmp40_1 = tmp32_0*w9;  
                                 const double tmp386_1 = tmp198_0*w46;  
                                 const double tmp517_1 = tmp228_0*w24;  
                                 const double tmp532_1 = tmp223_0*w29;  
                                 const double tmp220_1 = A_02_3*w23;  
                                 const double tmp268_1 = tmp93_0*w20;  
                                 const double tmp322_1 = A_10_7*w39;  
                                 const double tmp311_1 = tmp8_0*w13;  
                                 const double tmp123_1 = A_01_4*w39;  
                                 const double tmp187_1 = A_20_6*w23;  
                                 const double tmp177_1 = A_02_5*w2;  
                                 const double tmp58_1 = A_21_6*w4;  
                                 const double tmp404_1 = tmp7_0*w38;  
                                 const double tmp122_1 = tmp64_0*w1;  
                                 const double tmp163_1 = tmp94_0*w5;  
                                 const double tmp15_1 = tmp9_0*w13;  
                                 const double tmp128_1 = A_20_5*w28;  
                                 const double tmp204_1 = tmp2_0*w15;  
                                 const double tmp539_1 = tmp207_0*w24;  
                                 const double tmp57_1 = tmp45_0*w37;  
                                 const double tmp53_1 = A_10_3*w39;  
                                 const double tmp157_1 = tmp88_0*w17;  
                                 const double tmp169_1 = tmp100_0*w16;  
                                 const double tmp162_1 = tmp93_0*w1;  
                                 const double tmp325_1 = tmp171_0*w12;  
                                 const double tmp179_1 = tmp105_0*w37;  
                                 const double tmp207_1 = A_20_1*w23;  
                                 const double tmp427_1 = tmp145_0*w56;  
                                 const double tmp368_1 = tmp188_0*w26;  
                                 const double tmp460_1 = tmp211_0*w24;  
                                 const double tmp347_1 = tmp176_0*w34;  
                                 const double tmp234_1 = tmp102_0*w9;  
                                 const double tmp21_1 = tmp15_0*w17;  
                                 const double tmp112_1 = tmp31_0*w6;  
                                 const double tmp319_1 = tmp169_0*w19;  
                                 const double tmp509_1 = A_01_7*w35;  
                                 const double tmp418_1 = tmp2_0*w36;  
                                 const double tmp266_1 = tmp143_0*w8;  
                                 const double tmp244_1 = tmp133_0*w28;  
                                 const double tmp138_1 = tmp72_0*w9;  
                                 const double tmp20_1 = tmp14_0*w14;  
                                 const double tmp29_1 = A_21_3*w24;  
                                 const double tmp190_1 = tmp113_0*w1;  
                                 const double tmp338_1 = tmp162_0*w17;  
                                 const double tmp87_1 = tmp54_0*w37;  
                                 const double tmp374_1 = tmp193_0*w34;  
                                 const double tmp195_1 = tmp13_0*w0;  
                                 const double tmp194_1 = tmp106_0*w25;  
                                 const double tmp111_1 = tmp22_0*w35;  
                                 const double tmp213_1 = tmp83_0*w5;  
                                 const double tmp291_1 = tmp157_0*w46;  
                                 const double tmp329_1 = tmp153_0*w2;  
                                 const double tmp256_1 = tmp17_0*w1;  
                                 const double tmp342_1 = tmp1_0*w54;  
                                 const double tmp376_1 = tmp194_0*w12;  
                                 const double tmp239_1 = tmp94_0*w18;  
                                 const double tmp340_1 = tmp160_0*w22;  
                                 const double tmp262_1 = tmp1_0*w7;  
                                 const double tmp54_1 = tmp26_0*w0;  
                                 const double tmp470_1 = A_20_3*w26;  
                                 const double tmp121_1 = tmp24_0*w18;  
                                 const double tmp523_1 = tmp85_0*w9;  
                                 const double tmp182_1 = tmp107_0*w12;  
                                 const double tmp140_1 = tmp74_0*w44;  
                                 const double tmp250_1 = tmp137_0*w8;  
                                 const double tmp104_1 = tmp55_0*w22;  
                                 const double tmp303_1 = A_21_5*w27;  
                                 const double tmp4_1 = tmp3_0*w3;  
                                 const double tmp526_1 = tmp121_0*w6;  
                                 const double tmp410_1 = tmp131_0*w20;  
                                 const double tmp255_1 = tmp141_0*w21;  
                                 const double tmp394_1 = tmp204_0*w19;  
                                 const double tmp172_1 = tmp103_0*w18;  
                                 const double tmp211_1 = A_20_0*w2;  
                                 const double tmp263_1 = tmp0_0*w20;  
                                 const double tmp230_1 = tmp124_0*w35;  
                                 const double tmp496_1 = A_01_4*w35;  
                                 const double tmp176_1 = A_12_5*w27;  
                                 const double tmp401_1 = tmp166_0*w43;  
                                 const double tmp43_1 = tmp35_0*w32;  
                                 const double tmp395_1 = tmp205_0*w23;  
                                 const double tmp348_1 = tmp177_0*w12;  
                                 const double tmp390_1 = tmp202_0*w8;  
                                 const double tmp525_1 = A_12_1*w4;  
                                 const double tmp237_1 = tmp129_0*w22;  
                                 const double tmp105_1 = A_12_4*w24;  
                                 const double tmp242_1 = tmp92_0*w50;  
                                 const double tmp161_1 = tmp92_0*w40;  
                                 const double tmp10_1 = A_12_0*w4;  
                                 const double tmp536_1 = tmp133_0*w2;  
                                 const double tmp55_1 = A_12_4*w27;  
                                 const double tmp445_1 = tmp82_0*w17;  
                                 const double tmp198_1 = A_02_2*w2;  
                                 const double tmp27_1 = A_20_3*w23;  
                                 const double tmp143_1 = A_10_5*w42;  
                                 const double tmp165_1 = tmp96_0*w9;  
                                 const double tmp145_1 = tmp78_0*w16;  
                                 const double tmp282_1 = tmp1_0*w57;  
                                 const double tmp13_1 = tmp7_0*w10;  
                                 const double tmp129_1 = tmp66_0*w49;  
                                 const double tmp443_1 = tmp65_0*w49;  
                                 const double tmp135_1 = A_10_2*w46;  
                                 const double tmp103_1 = tmp50_0*w21;  
                                 const double tmp247_1 = tmp13_0*w36;  
                                 const double tmp185_1 = tmp110_0*w16;  
                                 const double tmp191_1 = tmp114_0*w18;  
                                 const double tmp315_1 = tmp19_0*w17;  
                                 const double tmp380_1 = tmp195_0*w23;  
                                 const double tmp456_1 = tmp218_0*w27;  
                                 const double tmp288_1 = tmp154_0*w29;  
                                 EM_S[INDEX2(0,0,8)]+=tmp264_1 + tmp268_1 + tmp292_1 + tmp327_1 + tmp342_1 + tmp369_1 + tmp377_1 + tmp379_1 + tmp384_1 + tmp389_1 + tmp390_1 + tmp394_1 + tmp415_1 + tmp424_1 + tmp427_1 + tmp434_1 + tmp447_1 + tmp448_1 + tmp449_1 + tmp450_1 + tmp451_1 + tmp452_1 + tmp453_1 + tmp454_1;  
                                 EM_S[INDEX2(1,0,8)]+=tmp140_1 + tmp147_1 + tmp182_1 + tmp196_1 + tmp200_1 + tmp203_1 + tmp206_1 + tmp207_1 + tmp208_1 + tmp224_1 + tmp22_1 + tmp275_1 + tmp277_1 + tmp279_1 + tmp441_1 + tmp444_1 + tmp473_1 + tmp474_1 + tmp491_1 + tmp495_1 + tmp498_1 + tmp500_1 + tmp506_1 + tmp507_1 + tmp508_1 + tmp509_1 + tmp510_1 + tmp511_1 + tmp512_1 + tmp513_1;  
                                 EM_S[INDEX2(2,0,8)]+=tmp102_1 + tmp11_1 + tmp193_1 + tmp302_1 + tmp303_1 + tmp304_1 + tmp305_1 + tmp306_1 + tmp307_1 + tmp308_1 + tmp309_1 + tmp310_1 + tmp311_1 + tmp312_1 + tmp313_1 + tmp314_1 + tmp315_1 + tmp316_1 + tmp317_1 + tmp318_1 + tmp319_1 + tmp320_1 + tmp321_1 + tmp52_1 + tmp54_1 + tmp57_1 + tmp68_1 + tmp70_1 + tmp76_1 + tmp94_1;  
                                 EM_S[INDEX2(3,0,8)]+=tmp106_1 + tmp107_1 + tmp108_1 + tmp109_1 + tmp110_1 + tmp111_1 + tmp112_1 + tmp113_1 + tmp114_1 + tmp115_1 + tmp116_1 + tmp117_1 + tmp118_1 + tmp119_1 + tmp120_1 + tmp121_1 + tmp35_1 + tmp38_1 + tmp41_1 + tmp42_1 + tmp47_1 + tmp50_1;  
                                 EM_S[INDEX2(4,0,8)]+=tmp104_1 + tmp105_1 + tmp124_1 + tmp130_1 + tmp138_1 + tmp139_1 + tmp148_1 + tmp150_1 + tmp151_1 + tmp175_1 + tmp181_1 + tmp18_1 + tmp195_1 + tmp204_1 + tmp20_1 + tmp216_1 + tmp218_1 + tmp256_1 + tmp257_1 + tmp258_1 + tmp259_1 + tmp260_1 + tmp261_1 + tmp262_1 + tmp263_1 + tmp80_1 + tmp85_1 + tmp91_1 + tmp92_1 + tmp99_1;  
                                 EM_S[INDEX2(5,0,8)]+=tmp229_1 + tmp235_1 + tmp237_1 + tmp238_1 + tmp242_1 + tmp334_1 + tmp339_1 + tmp347_1 + tmp349_1 + tmp414_1 + tmp417_1 + tmp418_1 + tmp419_1 + tmp420_1 + tmp422_1 + tmp440_1 + tmp461_1 + tmp462_1 + tmp463_1 + tmp464_1 + tmp465_1 + tmp466_1;  
                                 EM_S[INDEX2(6,0,8)]+=tmp163_1 + tmp166_1 + tmp169_1 + tmp172_1 + tmp234_1 + tmp236_1 + tmp240_1 + tmp248_1 + tmp250_1 + tmp254_1 + tmp338_1 + tmp340_1 + tmp407_1 + tmp416_1 + tmp421_1 + tmp484_1 + tmp485_1 + tmp486_1 + tmp487_1 + tmp488_1 + tmp489_1 + tmp490_1;  
                                 EM_S[INDEX2(7,0,8)]+=tmp132_1 + tmp155_1 + tmp158_1 + tmp159_1 + tmp161_1 + tmp518_1 + tmp519_1 + tmp520_1 + tmp521_1 + tmp522_1 + tmp523_1 + tmp74_1;  
                                 EM_S[INDEX2(0,1,8)]+=tmp130_1 + tmp138_1 + tmp140_1 + tmp147_1 + tmp148_1 + tmp151_1 + tmp218_1 + tmp224_1 + tmp258_1 + tmp259_1 + tmp277_1 + tmp302_1 + tmp307_1 + tmp310_1 + tmp325_1 + tmp354_1 + tmp359_1 + tmp441_1 + tmp444_1 + tmp507_1 + tmp508_1 + tmp511_1 + tmp512_1 + tmp52_1 + tmp57_1 + tmp61_1 + tmp67_1 + tmp70_1 + tmp71_1 + tmp76_1;  
                                 EM_S[INDEX2(1,1,8)]+=tmp109_1 + tmp116_1 + tmp284_1 + tmp294_1 + tmp300_1 + tmp334_1 + tmp339_1 + tmp375_1 + tmp384_1 + tmp387_1 + tmp388_1 + tmp425_1 + tmp426_1 + tmp427_1 + tmp428_1 + tmp429_1 + tmp430_1 + tmp431_1 + tmp432_1 + tmp433_1 + tmp434_1 + tmp435_1 + tmp436_1 + tmp437_1;  
                                 EM_S[INDEX2(2,1,8)]+=tmp107_1 + tmp110_1 + tmp112_1 + tmp113_1 + tmp115_1 + tmp117_1 + tmp118_1 + tmp120_1 + tmp166_1 + tmp167_1 + tmp169_1 + tmp228_1 + tmp234_1 + tmp236_1 + tmp239_1 + tmp264_1 + tmp268_1 + tmp35_1 + tmp41_1 + tmp501_1 + tmp502_1 + tmp50_1;  
                                 EM_S[INDEX2(3,1,8)]+=tmp136_1 + tmp14_1 + tmp15_1 + tmp21_1 + tmp25_1 + tmp26_1 + tmp279_1 + tmp29_1 + tmp356_1 + tmp357_1 + tmp358_1 + tmp491_1 + tmp492_1 + tmp495_1 + tmp496_1 + tmp498_1 + tmp500_1 + tmp510_1 + tmp513_1 + tmp54_1 + tmp5_1 + tmp65_1 + tmp66_1 + tmp68_1 + tmp69_1 + tmp73_1 + tmp74_1 + tmp75_1 + tmp77_1 + tmp78_1;  
                                 EM_S[INDEX2(4,1,8)]+=tmp229_1 + tmp235_1 + tmp237_1 + tmp238_1 + tmp242_1 + tmp248_1 + tmp250_1 + tmp362_1 + tmp403_1 + tmp410_1 + tmp413_1 + tmp414_1 + tmp415_1 + tmp416_1 + tmp417_1 + tmp418_1 + tmp419_1 + tmp420_1 + tmp421_1 + tmp422_1 + tmp423_1 + tmp424_1;  
                                 EM_S[INDEX2(5,1,8)]+=tmp13_1 + tmp158_1 + tmp182_1 + tmp184_1 + tmp185_1 + tmp186_1 + tmp194_1 + tmp195_1 + tmp196_1 + tmp197_1 + tmp198_1 + tmp199_1 + tmp200_1 + tmp201_1 + tmp202_1 + tmp203_1 + tmp204_1 + tmp205_1 + tmp206_1 + tmp207_1 + tmp208_1 + tmp209_1 + tmp4_1 + tmp56_1 + tmp58_1 + tmp59_1 + tmp62_1 + tmp64_1 + tmp72_1 + tmp79_1;  
                                 EM_S[INDEX2(6,1,8)]+=tmp132_1 + tmp155_1 + tmp159_1 + tmp161_1 + tmp18_1 + tmp193_1 + tmp222_1 + tmp223_1 + tmp521_1 + tmp522_1 + tmp528_1 + tmp529_1;  
                                 EM_S[INDEX2(7,1,8)]+=tmp108_1 + tmp121_1 + tmp297_1 + tmp299_1 + tmp346_1 + tmp347_1 + tmp349_1 + tmp350_1 + tmp404_1 + tmp405_1 + tmp407_1 + tmp408_1 + tmp409_1 + tmp40_1 + tmp42_1 + tmp461_1 + tmp466_1 + tmp467_1 + tmp468_1 + tmp469_1 + tmp47_1 + tmp48_1;  
                                 EM_S[INDEX2(0,2,8)]+=tmp102_1 + tmp104_1 + tmp141_1 + tmp176_1 + tmp186_1 + tmp188_1 + tmp193_1 + tmp216_1 + tmp260_1 + tmp261_1 + tmp275_1 + tmp304_1 + tmp313_1 + tmp316_1 + tmp317_1 + tmp320_1 + tmp491_1 + tmp495_1 + tmp497_1 + tmp498_1 + tmp499_1 + tmp500_1 + tmp506_1 + tmp509_1 + tmp54_1 + tmp68_1 + tmp91_1 + tmp92_1 + tmp94_1 + tmp99_1;  
                                 EM_S[INDEX2(1,2,8)]+=tmp107_1 + tmp108_1 + tmp110_1 + tmp114_1 + tmp115_1 + tmp117_1 + tmp119_1 + tmp121_1 + tmp229_1 + tmp231_1 + tmp233_1 + tmp235_1 + tmp237_1 + tmp238_1 + tmp264_1 + tmp265_1 + tmp266_1 + tmp267_1 + tmp268_1 + tmp41_1 + tmp42_1 + tmp47_1;  
                                 EM_S[INDEX2(2,2,8)]+=tmp109_1 + tmp116_1 + tmp283_1 + tmp287_1 + tmp295_1 + tmp338_1 + tmp340_1 + tmp345_1 + tmp353_1 + tmp366_1 + tmp367_1 + tmp368_1 + tmp369_1 + tmp370_1 + tmp371_1 + tmp372_1 + tmp373_1 + tmp374_1 + tmp375_1 + tmp376_1 + tmp377_1 + tmp378_1 + tmp379_1 + tmp380_1;  
                                 EM_S[INDEX2(3,2,8)]+=tmp132_1 + tmp137_1 + tmp16_1 + tmp177_1 + tmp178_1 + tmp17_1 + tmp185_1 + tmp24_1 + tmp278_1 + tmp27_1 + tmp281_1 + tmp28_1 + tmp308_1 + tmp312_1 + tmp314_1 + tmp3_1 + tmp441_1 + tmp442_1 + tmp443_1 + tmp444_1 + tmp445_1 + tmp446_1 + tmp52_1 + tmp53_1 + tmp57_1 + tmp60_1 + tmp63_1 + tmp70_1 + tmp76_1 + tmp8_1;  
                                 EM_S[INDEX2(4,2,8)]+=tmp163_1 + tmp166_1 + tmp169_1 + tmp172_1 + tmp234_1 + tmp236_1 + tmp343_1 + tmp347_1 + tmp349_1 + tmp351_1 + tmp407_1 + tmp450_1 + tmp451_1 + tmp464_1 + tmp465_1 + tmp484_1 + tmp485_1 + tmp487_1 + tmp490_1 + tmp503_1 + tmp504_1 + tmp505_1;  
                                 EM_S[INDEX2(5,2,8)]+=tmp155_1 + tmp159_1 + tmp161_1 + tmp189_1 + tmp18_1 + tmp190_1 + tmp224_1 + tmp519_1 + tmp523_1 + tmp526_1 + tmp527_1 + tmp74_1;  
                                 EM_S[INDEX2(6,2,8)]+=tmp145_1 + tmp158_1 + tmp173_1 + tmp175_1 + tmp179_1 + tmp180_1 + tmp181_1 + tmp183_1 + tmp184_1 + tmp19_1 + tmp213_1 + tmp217_1 + tmp219_1 + tmp221_1 + tmp2_1 + tmp303_1 + tmp309_1 + tmp311_1 + tmp315_1 + tmp318_1 + tmp319_1 + tmp321_1 + tmp323_1 + tmp325_1 + tmp326_1 + tmp358_1 + tmp493_1 + tmp494_1 + tmp524_1 + tmp525_1;  
                                 EM_S[INDEX2(7,2,8)]+=tmp112_1 + tmp113_1 + tmp240_1 + tmp241_1 + tmp242_1 + tmp243_1 + tmp244_1 + tmp245_1 + tmp246_1 + tmp247_1 + tmp248_1 + tmp249_1 + tmp250_1 + tmp251_1 + tmp252_1 + tmp253_1 + tmp254_1 + tmp255_1 + tmp35_1 + tmp46_1 + tmp49_1 + tmp50_1;  
                                 EM_S[INDEX2(0,3,8)]+=tmp107_1 + tmp109_1 + tmp110_1 + tmp115_1 + tmp116_1 + tmp117_1 + tmp166_1 + tmp169_1 + tmp227_1 + tmp228_1 + tmp229_1 + tmp230_1 + tmp231_1 + tmp232_1 + tmp233_1 + tmp234_1 + tmp235_1 + tmp236_1 + tmp237_1 + tmp238_1 + tmp239_1 + tmp41_1;  
                                 EM_S[INDEX2(1,3,8)]+=tmp52_1 + tmp53_1 + tmp54_1 + tmp55_1 + tmp56_1 + tmp57_1 + tmp58_1 + tmp59_1 + tmp60_1 + tmp61_1 + tmp62_1 + tmp63_1 + tmp64_1 + tmp65_1 + tmp66_1 + tmp67_1 + tmp68_1 + tmp69_1 + tmp70_1 + tmp71_1 + tmp72_1 + tmp73_1 + tmp74_1 + tmp75_1 + tmp76_1 + tmp77_1 + tmp78_1 + tmp79_1 + tmp80_1 + tmp81_1;  
                                 EM_S[INDEX2(2,3,8)]+=tmp132_1 + tmp136_1 + tmp137_1 + tmp139_1 + tmp141_1 + tmp145_1 + tmp210_1 + tmp213_1 + tmp217_1 + tmp219_1 + tmp220_1 + tmp221_1 + tmp278_1 + tmp281_1 + tmp441_1 + tmp442_1 + tmp443_1 + tmp444_1 + tmp445_1 + tmp446_1 + tmp491_1 + tmp492_1 + tmp493_1 + tmp494_1 + tmp495_1 + tmp496_1 + tmp497_1 + tmp498_1 + tmp499_1 + tmp500_1;  
                                 EM_S[INDEX2(3,3,8)]+=tmp249_1 + tmp255_1 + tmp264_1 + tmp268_1 + tmp282_1 + tmp283_1 + tmp284_1 + tmp285_1 + tmp286_1 + tmp287_1 + tmp288_1 + tmp289_1 + tmp290_1 + tmp291_1 + tmp292_1 + tmp293_1 + tmp294_1 + tmp295_1 + tmp296_1 + tmp297_1 + tmp298_1 + tmp299_1 + tmp300_1 + tmp301_1;  
                                 EM_S[INDEX2(4,3,8)]+=tmp152_1 + tmp154_1 + tmp155_1 + tmp158_1 + tmp159_1 + tmp161_1 + tmp193_1 + tmp224_1 + tmp526_1 + tmp527_1 + tmp528_1 + tmp529_1;  
                                 EM_S[INDEX2(5,3,8)]+=tmp108_1 + tmp121_1 + tmp245_1 + tmp248_1 + tmp250_1 + tmp251_1 + tmp387_1 + tmp388_1 + tmp403_1 + tmp404_1 + tmp405_1 + tmp406_1 + tmp407_1 + tmp408_1 + tmp409_1 + tmp40_1 + tmp410_1 + tmp411_1 + tmp412_1 + tmp42_1 + tmp47_1 + tmp48_1;  
                                 EM_S[INDEX2(6,3,8)]+=tmp112_1 + tmp113_1 + tmp241_1 + tmp242_1 + tmp246_1 + tmp247_1 + tmp252_1 + tmp343_1 + tmp344_1 + tmp345_1 + tmp346_1 + tmp347_1 + tmp348_1 + tmp349_1 + tmp350_1 + tmp351_1 + tmp352_1 + tmp353_1 + tmp35_1 + tmp46_1 + tmp49_1 + tmp50_1;  
                                 EM_S[INDEX2(7,3,8)]+=tmp0_1 + tmp10_1 + tmp11_1 + tmp12_1 + tmp13_1 + tmp14_1 + tmp15_1 + tmp16_1 + tmp17_1 + tmp18_1 + tmp19_1 + tmp1_1 + tmp20_1 + tmp21_1 + tmp22_1 + tmp23_1 + tmp24_1 + tmp25_1 + tmp26_1 + tmp27_1 + tmp28_1 + tmp29_1 + tmp2_1 + tmp3_1 + tmp4_1 + tmp5_1 + tmp6_1 + tmp7_1 + tmp8_1 + tmp9_1;  
                                 EM_S[INDEX2(0,4,8)]+=tmp11_1 + tmp175_1 + tmp17_1 + tmp181_1 + tmp18_1 + tmp195_1 + tmp200_1 + tmp203_1 + tmp204_1 + tmp206_1 + tmp208_1 + tmp20_1 + tmp22_1 + tmp256_1 + tmp257_1 + tmp262_1 + tmp263_1 + tmp26_1 + tmp305_1 + tmp306_1 + tmp309_1 + tmp311_1 + tmp315_1 + tmp318_1 + tmp470_1 + tmp471_1 + tmp472_1 + tmp473_1 + tmp474_1 + tmp475_1;  
                                 EM_S[INDEX2(1,4,8)]+=tmp118_1 + tmp120_1 + tmp242_1 + tmp347_1 + tmp348_1 + tmp349_1 + tmp35_1 + tmp37_1 + tmp39_1 + tmp414_1 + tmp415_1 + tmp417_1 + tmp418_1 + tmp422_1 + tmp424_1 + tmp461_1 + tmp464_1 + tmp465_1 + tmp466_1 + tmp482_1 + tmp483_1 + tmp50_1;  
                                 EM_S[INDEX2(2,4,8)]+=tmp114_1 + tmp119_1 + tmp240_1 + tmp248_1 + tmp250_1 + tmp254_1 + tmp32_1 + tmp407_1 + tmp411_1 + tmp416_1 + tmp421_1 + tmp42_1 + tmp450_1 + tmp451_1 + tmp47_1 + tmp484_1 + tmp485_1 + tmp487_1 + tmp490_1 + tmp51_1 + tmp538_1 + tmp539_1;  
                                 EM_S[INDEX2(3,4,8)]+=tmp155_1 + tmp158_1 + tmp159_1 + tmp161_1 + tmp191_1 + tmp192_1 + tmp193_1 + tmp224_1 + tmp225_1 + tmp226_1 + tmp518_1 + tmp520_1;  
                                 EM_S[INDEX2(4,4,8)]+=tmp162_1 + tmp170_1 + tmp284_1 + tmp287_1 + tmp290_1 + tmp292_1 + tmp293_1 + tmp298_1 + tmp327_1 + tmp328_1 + tmp329_1 + tmp330_1 + tmp331_1 + tmp332_1 + tmp333_1 + tmp334_1 + tmp335_1 + tmp336_1 + tmp337_1 + tmp338_1 + tmp339_1 + tmp340_1 + tmp341_1 + tmp342_1;  
                                 EM_S[INDEX2(5,4,8)]+=tmp122_1 + tmp123_1 + tmp124_1 + tmp125_1 + tmp126_1 + tmp127_1 + tmp128_1 + tmp129_1 + tmp130_1 + tmp131_1 + tmp132_1 + tmp133_1 + tmp134_1 + tmp135_1 + tmp136_1 + tmp137_1 + tmp138_1 + tmp139_1 + tmp140_1 + tmp141_1 + tmp142_1 + tmp143_1 + tmp144_1 + tmp145_1 + tmp146_1 + tmp147_1 + tmp148_1 + tmp149_1 + tmp150_1 + tmp151_1;  
                                 EM_S[INDEX2(6,4,8)]+=tmp100_1 + tmp101_1 + tmp102_1 + tmp103_1 + tmp104_1 + tmp105_1 + tmp59_1 + tmp63_1 + tmp67_1 + tmp74_1 + tmp75_1 + tmp80_1 + tmp82_1 + tmp83_1 + tmp84_1 + tmp85_1 + tmp86_1 + tmp87_1 + tmp88_1 + tmp89_1 + tmp90_1 + tmp91_1 + tmp92_1 + tmp93_1 + tmp94_1 + tmp95_1 + tmp96_1 + tmp97_1 + tmp98_1 + tmp99_1;  
                                 EM_S[INDEX2(7,4,8)]+=tmp163_1 + tmp165_1 + tmp166_1 + tmp169_1 + tmp171_1 + tmp172_1 + tmp229_1 + tmp232_1 + tmp238_1 + tmp31_1 + tmp33_1 + tmp34_1 + tmp363_1 + tmp364_1 + tmp419_1 + tmp41_1 + tmp420_1 + tmp43_1 + tmp44_1 + tmp45_1 + tmp530_1 + tmp531_1;  
                                 EM_S[INDEX2(0,5,8)]+=tmp118_1 + tmp120_1 + tmp242_1 + tmp248_1 + tmp250_1 + tmp253_1 + tmp334_1 + tmp339_1 + tmp35_1 + tmp37_1 + tmp39_1 + tmp403_1 + tmp410_1 + tmp414_1 + tmp416_1 + tmp417_1 + tmp418_1 + tmp421_1 + tmp422_1 + tmp50_1 + tmp536_1 + tmp537_1;  
                                 EM_S[INDEX2(1,5,8)]+=tmp127_1 + tmp128_1 + tmp130_1 + tmp138_1 + tmp13_1 + tmp145_1 + tmp148_1 + tmp14_1 + tmp151_1 + tmp158_1 + tmp15_1 + tmp184_1 + tmp194_1 + tmp195_1 + tmp201_1 + tmp202_1 + tmp204_1 + tmp205_1 + tmp21_1 + tmp25_1 + tmp319_1 + tmp325_1 + tmp354_1 + tmp355_1 + tmp356_1 + tmp357_1 + tmp358_1 + tmp359_1 + tmp360_1 + tmp4_1;  
                                 EM_S[INDEX2(2,5,8)]+=tmp153_1 + tmp155_1 + tmp159_1 + tmp160_1 + tmp161_1 + tmp18_1 + tmp222_1 + tmp223_1 + tmp224_1 + tmp225_1 + tmp226_1 + tmp74_1;  
                                 EM_S[INDEX2(3,5,8)]+=tmp165_1 + tmp166_1 + tmp169_1 + tmp171_1 + tmp228_1 + tmp239_1 + tmp346_1 + tmp347_1 + tmp349_1 + tmp350_1 + tmp387_1 + tmp388_1 + tmp404_1 + tmp405_1 + tmp407_1 + tmp408_1 + tmp409_1 + tmp461_1 + tmp466_1 + tmp504_1 + tmp516_1 + tmp517_1;  
                                 EM_S[INDEX2(4,5,8)]+=tmp101_1 + tmp125_1 + tmp126_1 + tmp129_1 + tmp132_1 + tmp134_1 + tmp137_1 + tmp140_1 + tmp144_1 + tmp147_1 + tmp149_1 + tmp17_1 + tmp185_1 + tmp198_1 + tmp199_1 + tmp200_1 + tmp203_1 + tmp206_1 + tmp208_1 + tmp312_1 + tmp398_1 + tmp400_1 + tmp470_1 + tmp471_1 + tmp63_1 + tmp82_1 + tmp83_1 + tmp87_1 + tmp89_1 + tmp97_1;  
                                 EM_S[INDEX2(5,5,8)]+=tmp287_1 + tmp297_1 + tmp299_1 + tmp328_1 + tmp336_1 + tmp33_1 + tmp369_1 + tmp372_1 + tmp374_1 + tmp375_1 + tmp376_1 + tmp385_1 + tmp391_1 + tmp415_1 + tmp424_1 + tmp425_1 + tmp436_1 + tmp44_1 + tmp476_1 + tmp477_1 + tmp478_1 + tmp479_1 + tmp480_1 + tmp481_1;  
                                 EM_S[INDEX2(6,5,8)]+=tmp162_1 + tmp170_1 + tmp229_1 + tmp238_1 + tmp266_1 + tmp31_1 + tmp32_1 + tmp34_1 + tmp363_1 + tmp364_1 + tmp40_1 + tmp419_1 + tmp41_1 + tmp420_1 + tmp42_1 + tmp43_1 + tmp45_1 + tmp47_1 + tmp48_1 + tmp514_1 + tmp515_1 + tmp51_1;  
                                 EM_S[INDEX2(7,5,8)]+=tmp122_1 + tmp131_1 + tmp135_1 + tmp141_1 + tmp142_1 + tmp143_1 + tmp146_1 + tmp186_1 + tmp193_1 + tmp197_1 + tmp209_1 + tmp214_1 + tmp215_1 + tmp216_1 + tmp269_1 + tmp272_1 + tmp275_1 + tmp317_1 + tmp397_1 + tmp399_1 + tmp401_1 + tmp402_1 + tmp62_1 + tmp64_1 + tmp66_1 + tmp72_1 + tmp77_1 + tmp79_1 + tmp84_1 + tmp95_1;  
                                 EM_S[INDEX2(0,6,8)]+=tmp114_1 + tmp119_1 + tmp32_1 + tmp338_1 + tmp340_1 + tmp343_1 + tmp347_1 + tmp349_1 + tmp351_1 + tmp407_1 + tmp42_1 + tmp464_1 + tmp465_1 + tmp469_1 + tmp47_1 + tmp484_1 + tmp485_1 + tmp487_1 + tmp490_1 + tmp51_1 + tmp532_1 + tmp533_1;  
                                 EM_S[INDEX2(1,6,8)]+=tmp132_1 + tmp155_1 + tmp156_1 + tmp157_1 + tmp159_1 + tmp161_1 + tmp189_1 + tmp18_1 + tmp190_1 + tmp191_1 + tmp192_1 + tmp193_1;  
                                 EM_S[INDEX2(2,6,8)]+=tmp104_1 + tmp158_1 + tmp16_1 + tmp173_1 + tmp174_1 + tmp175_1 + tmp176_1 + tmp177_1 + tmp178_1 + tmp179_1 + tmp180_1 + tmp181_1 + tmp182_1 + tmp183_1 + tmp184_1 + tmp185_1 + tmp186_1 + tmp187_1 + tmp188_1 + tmp19_1 + tmp24_1 + tmp28_1 + tmp2_1 + tmp59_1 + tmp86_1 + tmp88_1 + tmp8_1 + tmp91_1 + tmp92_1 + tmp99_1;  
                                 EM_S[INDEX2(3,6,8)]+=tmp229_1 + tmp231_1 + tmp233_1 + tmp238_1 + tmp240_1 + tmp241_1 + tmp242_1 + tmp245_1 + tmp246_1 + tmp247_1 + tmp248_1 + tmp250_1 + tmp251_1 + tmp252_1 + tmp254_1 + tmp345_1 + tmp353_1 + tmp361_1 + tmp362_1 + tmp363_1 + tmp364_1 + tmp365_1;  
                                 EM_S[INDEX2(4,6,8)]+=tmp100_1 + tmp102_1 + tmp103_1 + tmp122_1 + tmp123_1 + tmp131_1 + tmp133_1 + tmp136_1 + tmp142_1 + tmp146_1 + tmp26_1 + tmp273_1 + tmp279_1 + tmp280_1 + tmp309_1 + tmp311_1 + tmp315_1 + tmp318_1 + tmp358_1 + tmp472_1 + tmp475_1 + tmp524_1 + tmp525_1 + tmp74_1 + tmp75_1 + tmp84_1 + tmp93_1 + tmp94_1 + tmp95_1 + tmp96_1;  
                                 EM_S[INDEX2(5,6,8)]+=tmp162_1 + tmp163_1 + tmp164_1 + tmp165_1 + tmp166_1 + tmp167_1 + tmp168_1 + tmp169_1 + tmp170_1 + tmp171_1 + tmp172_1 + tmp31_1 + tmp34_1 + tmp35_1 + tmp37_1 + tmp39_1 + tmp41_1 + tmp43_1 + tmp45_1 + tmp46_1 + tmp49_1 + tmp50_1;  
                                 EM_S[INDEX2(6,6,8)]+=tmp249_1 + tmp255_1 + tmp284_1 + tmp335_1 + tmp33_1 + tmp341_1 + tmp366_1 + tmp375_1 + tmp378_1 + tmp381_1 + tmp384_1 + tmp392_1 + tmp431_1 + tmp433_1 + tmp435_1 + tmp44_1 + tmp450_1 + tmp451_1 + tmp455_1 + tmp456_1 + tmp457_1 + tmp458_1 + tmp459_1 + tmp460_1;  
                                 EM_S[INDEX2(7,6,8)]+=tmp101_1 + tmp125_1 + tmp134_1 + tmp211_1 + tmp212_1 + tmp213_1 + tmp217_1 + tmp218_1 + tmp219_1 + tmp221_1 + tmp224_1 + tmp270_1 + tmp271_1 + tmp274_1 + tmp276_1 + tmp277_1 + tmp278_1 + tmp281_1 + tmp310_1 + tmp322_1 + tmp323_1 + tmp324_1 + tmp325_1 + tmp326_1 + tmp67_1 + tmp82_1 + tmp87_1 + tmp90_1 + tmp97_1 + tmp98_1;  
                                 EM_S[INDEX2(0,7,8)]+=tmp132_1 + tmp152_1 + tmp153_1 + tmp154_1 + tmp155_1 + tmp156_1 + tmp157_1 + tmp158_1 + tmp159_1 + tmp160_1 + tmp161_1 + tmp74_1;  
                                 EM_S[INDEX2(1,7,8)]+=tmp165_1 + tmp166_1 + tmp169_1 + tmp171_1 + tmp228_1 + tmp239_1 + tmp245_1 + tmp248_1 + tmp250_1 + tmp251_1 + tmp297_1 + tmp299_1 + tmp403_1 + tmp404_1 + tmp405_1 + tmp407_1 + tmp408_1 + tmp409_1 + tmp410_1 + tmp489_1 + tmp534_1 + tmp535_1;  
                                 EM_S[INDEX2(2,7,8)]+=tmp229_1 + tmp231_1 + tmp233_1 + tmp238_1 + tmp241_1 + tmp242_1 + tmp246_1 + tmp247_1 + tmp249_1 + tmp252_1 + tmp255_1 + tmp343_1 + tmp346_1 + tmp347_1 + tmp349_1 + tmp350_1 + tmp351_1 + tmp363_1 + tmp364_1 + tmp438_1 + tmp439_1 + tmp440_1;  
                                 EM_S[INDEX2(3,7,8)]+=tmp0_1 + tmp12_1 + tmp139_1 + tmp13_1 + tmp18_1 + tmp19_1 + tmp1_1 + tmp20_1 + tmp210_1 + tmp211_1 + tmp212_1 + tmp213_1 + tmp214_1 + tmp215_1 + tmp216_1 + tmp217_1 + tmp218_1 + tmp219_1 + tmp220_1 + tmp221_1 + tmp23_1 + tmp2_1 + tmp4_1 + tmp55_1 + tmp62_1 + tmp64_1 + tmp72_1 + tmp79_1 + tmp80_1 + tmp81_1;  
                                 EM_S[INDEX2(4,7,8)]+=tmp30_1 + tmp31_1 + tmp32_1 + tmp33_1 + tmp34_1 + tmp35_1 + tmp36_1 + tmp37_1 + tmp38_1 + tmp39_1 + tmp40_1 + tmp41_1 + tmp42_1 + tmp43_1 + tmp44_1 + tmp45_1 + tmp46_1 + tmp47_1 + tmp48_1 + tmp49_1 + tmp50_1 + tmp51_1;  
                                 EM_S[INDEX2(5,7,8)]+=tmp101_1 + tmp10_1 + tmp11_1 + tmp14_1 + tmp15_1 + tmp193_1 + tmp21_1 + tmp25_1 + tmp310_1 + tmp312_1 + tmp317_1 + tmp319_1 + tmp322_1 + tmp324_1 + tmp355_1 + tmp360_1 + tmp397_1 + tmp398_1 + tmp399_1 + tmp400_1 + tmp401_1 + tmp402_1 + tmp66_1 + tmp77_1 + tmp82_1 + tmp84_1 + tmp87_1 + tmp95_1 + tmp97_1 + tmp9_1;  
                                 EM_S[INDEX2(6,7,8)]+=tmp122_1 + tmp125_1 + tmp131_1 + tmp134_1 + tmp142_1 + tmp146_1 + tmp16_1 + tmp174_1 + tmp182_1 + tmp187_1 + tmp224_1 + tmp22_1 + tmp24_1 + tmp269_1 + tmp270_1 + tmp271_1 + tmp272_1 + tmp273_1 + tmp274_1 + tmp275_1 + tmp276_1 + tmp277_1 + tmp278_1 + tmp279_1 + tmp280_1 + tmp281_1 + tmp28_1 + tmp6_1 + tmp7_1 + tmp8_1;  
                                 EM_S[INDEX2(7,7,8)]+=tmp162_1 + tmp170_1 + tmp282_1 + tmp292_1 + tmp301_1 + tmp345_1 + tmp353_1 + tmp369_1 + tmp381_1 + tmp382_1 + tmp383_1 + tmp384_1 + tmp385_1 + tmp386_1 + tmp387_1 + tmp388_1 + tmp389_1 + tmp390_1 + tmp391_1 + tmp392_1 + tmp393_1 + tmp394_1 + tmp395_1 + tmp396_1;  
                             } else { // constant data  
                                 const double A_00 = A_p[INDEX2(0,0,3)];  
                                 const double A_01 = A_p[INDEX2(0,1,3)];  
                                 const double A_02 = A_p[INDEX2(0,2,3)];  
                                 const double A_10 = A_p[INDEX2(1,0,3)];  
                                 const double A_11 = A_p[INDEX2(1,1,3)];  
                                 const double A_12 = A_p[INDEX2(1,2,3)];  
                                 const double A_20 = A_p[INDEX2(2,0,3)];  
                                 const double A_21 = A_p[INDEX2(2,1,3)];  
                                 const double A_22 = A_p[INDEX2(2,2,3)];  
                                 const double tmp0_0 = A_01 + A_10;  
                                 const double tmp1_0 = A_02 + A_20;  
                                 const double tmp2_0 = A_12 + A_21;  
                                 const double tmp25_1 = A_01*w69;  
                                 const double tmp2_1 = tmp0_0*w61;  
                                 const double tmp33_1 = A_20*w70;  
                                 const double tmp23_1 = A_02*w65;  
                                 const double tmp41_1 = A_01*w61;  
                                 const double tmp34_1 = A_02*w73;  
                                 const double tmp8_1 = A_11*w71;  
                                 const double tmp50_1 = A_10*w61;  
                                 const double tmp15_1 = A_22*w75;  
                                 const double tmp9_1 = A_21*w74;  
                                 const double tmp19_1 = A_10*w69;  
                                 const double tmp11_1 = A_00*w68;  
                                 const double tmp52_1 = tmp2_0*w66;  
                                 const double tmp37_1 = tmp2_0*w74;  
                                 const double tmp0_1 = A_00*w60;  
                                 const double tmp17_1 = A_21*w64;  
                                 const double tmp26_1 = A_00*w79;  
                                 const double tmp5_1 = A_21*w66;  
                                 const double tmp29_1 = A_00*w80;  
                                 const double tmp7_1 = A_22*w67;  
                                 const double tmp48_1 = A_11*w87;  
                                 const double tmp44_1 = A_11*w84;  
                                 const double tmp27_1 = tmp2_0*w72;  
                                 const double tmp42_1 = A_22*w85;  
                                 const double tmp18_1 = A_11*w77;  
                                 const double tmp35_1 = tmp0_0*w76;  
                                 const double tmp46_1 = A_00*w86;  
                                 const double tmp32_1 = A_22*w83;  
                                 const double tmp22_1 = A_01*w76;  
                                 const double tmp4_1 = A_02*w62;  
                                 const double tmp10_1 = A_02*w70;  
                                 const double tmp3_1 = A_20*w65;  
                                 const double tmp39_1 = A_21*w72;  
                                 const double tmp51_1 = tmp1_0*w65;  
                                 const double tmp12_1 = A_20*w73;  
                                 const double tmp40_1 = A_10*w81;  
                                 const double tmp43_1 = tmp1_0*w62;  
                                 const double tmp28_1 = A_10*w76;  
                                 const double tmp45_1 = tmp2_0*w64;  
                                 const double tmp49_1 = A_01*w81;  
                                 const double tmp36_1 = tmp1_0*w73;  
                                 const double tmp53_1 = A_00*w89;  
                                 const double tmp6_1 = A_11*w63;  
                                 const double tmp31_1 = A_11*w82;  
                                 const double tmp21_1 = A_22*w78;  
                                 const double tmp16_1 = tmp1_0*w70;  
                                 const double tmp14_1 = A_12*w72;  
                                 const double tmp38_1 = A_12*w74;  
                                 const double tmp30_1 = tmp0_0*w81;  
                                 const double tmp47_1 = A_22*w88;  
                                 const double tmp13_1 = tmp0_0*w69;  
                                 const double tmp20_1 = A_12*w66;  
                                 const double tmp1_1 = A_12*w64;  
                                 const double tmp24_1 = A_20*w62;  
                                 EM_S[INDEX2(0,0,8)]+=tmp35_1 + tmp46_1 + tmp47_1 + tmp48_1 + tmp51_1 + tmp52_1;  
                                 EM_S[INDEX2(1,0,8)]+=tmp21_1 + tmp25_1 + tmp26_1 + tmp28_1 + tmp37_1 + tmp3_1 + tmp4_1 + tmp6_1;  
                                 EM_S[INDEX2(2,0,8)]+=tmp0_1 + tmp18_1 + tmp19_1 + tmp1_1 + tmp21_1 + tmp22_1 + tmp36_1 + tmp5_1;  
                                 EM_S[INDEX2(3,0,8)]+=tmp10_1 + tmp11_1 + tmp12_1 + tmp13_1 + tmp14_1 + tmp15_1 + tmp8_1 + tmp9_1;  
                                 EM_S[INDEX2(4,0,8)]+=tmp0_1 + tmp17_1 + tmp20_1 + tmp23_1 + tmp24_1 + tmp2_1 + tmp6_1 + tmp7_1;  
                                 EM_S[INDEX2(5,0,8)]+=tmp11_1 + tmp38_1 + tmp39_1 + tmp42_1 + tmp43_1 + tmp44_1 + tmp49_1 + tmp50_1;  
                                 EM_S[INDEX2(6,0,8)]+=tmp33_1 + tmp34_1 + tmp40_1 + tmp41_1 + tmp42_1 + tmp45_1 + tmp53_1 + tmp8_1;  
                                 EM_S[INDEX2(7,0,8)]+=tmp16_1 + tmp27_1 + tmp29_1 + tmp30_1 + tmp31_1 + tmp32_1;  
                                 EM_S[INDEX2(0,1,8)]+=tmp19_1 + tmp21_1 + tmp22_1 + tmp23_1 + tmp24_1 + tmp26_1 + tmp37_1 + tmp6_1;  
                                 EM_S[INDEX2(1,1,8)]+=tmp13_1 + tmp43_1 + tmp46_1 + tmp47_1 + tmp48_1 + tmp52_1;  
                                 EM_S[INDEX2(2,1,8)]+=tmp11_1 + tmp14_1 + tmp15_1 + tmp33_1 + tmp34_1 + tmp35_1 + tmp8_1 + tmp9_1;  
                                 EM_S[INDEX2(3,1,8)]+=tmp0_1 + tmp16_1 + tmp18_1 + tmp1_1 + tmp21_1 + tmp25_1 + tmp28_1 + tmp5_1;  
                                 EM_S[INDEX2(4,1,8)]+=tmp11_1 + tmp38_1 + tmp39_1 + tmp40_1 + tmp41_1 + tmp42_1 + tmp44_1 + tmp51_1;  
                                 EM_S[INDEX2(5,1,8)]+=tmp0_1 + tmp17_1 + tmp20_1 + tmp30_1 + tmp3_1 + tmp4_1 + tmp6_1 + tmp7_1;  
                                 EM_S[INDEX2(6,1,8)]+=tmp27_1 + tmp29_1 + tmp2_1 + tmp31_1 + tmp32_1 + tmp36_1;  
                                 EM_S[INDEX2(7,1,8)]+=tmp10_1 + tmp12_1 + tmp42_1 + tmp45_1 + tmp49_1 + tmp50_1 + tmp53_1 + tmp8_1;  
                                 EM_S[INDEX2(0,2,8)]+=tmp0_1 + tmp17_1 + tmp18_1 + tmp20_1 + tmp21_1 + tmp25_1 + tmp28_1 + tmp36_1;  
                                 EM_S[INDEX2(1,2,8)]+=tmp10_1 + tmp11_1 + tmp12_1 + tmp15_1 + tmp35_1 + tmp38_1 + tmp39_1 + tmp8_1;  
                                 EM_S[INDEX2(2,2,8)]+=tmp13_1 + tmp45_1 + tmp46_1 + tmp47_1 + tmp48_1 + tmp51_1;  
                                 EM_S[INDEX2(3,2,8)]+=tmp19_1 + tmp21_1 + tmp22_1 + tmp26_1 + tmp27_1 + tmp3_1 + tmp4_1 + tmp6_1;  
                                 EM_S[INDEX2(4,2,8)]+=tmp33_1 + tmp34_1 + tmp42_1 + tmp49_1 + tmp50_1 + tmp52_1 + tmp53_1 + tmp8_1;  
                                 EM_S[INDEX2(5,2,8)]+=tmp16_1 + tmp29_1 + tmp2_1 + tmp31_1 + tmp32_1 + tmp37_1;  
                                 EM_S[INDEX2(6,2,8)]+=tmp0_1 + tmp1_1 + tmp23_1 + tmp24_1 + tmp30_1 + tmp5_1 + tmp6_1 + tmp7_1;  
                                 EM_S[INDEX2(7,2,8)]+=tmp11_1 + tmp14_1 + tmp40_1 + tmp41_1 + tmp42_1 + tmp43_1 + tmp44_1 + tmp9_1;  
                                 EM_S[INDEX2(0,3,8)]+=tmp11_1 + tmp13_1 + tmp15_1 + tmp33_1 + tmp34_1 + tmp38_1 + tmp39_1 + tmp8_1;  
                                 EM_S[INDEX2(1,3,8)]+=tmp0_1 + tmp16_1 + tmp17_1 + tmp18_1 + tmp19_1 + tmp20_1 + tmp21_1 + tmp22_1;  
                                 EM_S[INDEX2(2,3,8)]+=tmp21_1 + tmp23_1 + tmp24_1 + tmp25_1 + tmp26_1 + tmp27_1 + tmp28_1 + tmp6_1;  
                                 EM_S[INDEX2(3,3,8)]+=tmp35_1 + tmp43_1 + tmp45_1 + tmp46_1 + tmp47_1 + tmp48_1;  
                                 EM_S[INDEX2(4,3,8)]+=tmp29_1 + tmp30_1 + tmp31_1 + tmp32_1 + tmp36_1 + tmp37_1;  
                                 EM_S[INDEX2(5,3,8)]+=tmp10_1 + tmp12_1 + tmp40_1 + tmp41_1 + tmp42_1 + tmp52_1 + tmp53_1 + tmp8_1;  
                                 EM_S[INDEX2(6,3,8)]+=tmp11_1 + tmp14_1 + tmp42_1 + tmp44_1 + tmp49_1 + tmp50_1 + tmp51_1 + tmp9_1;  
                                 EM_S[INDEX2(7,3,8)]+=tmp0_1 + tmp1_1 + tmp2_1 + tmp3_1 + tmp4_1 + tmp5_1 + tmp6_1 + tmp7_1;  
                                 EM_S[INDEX2(0,4,8)]+=tmp0_1 + tmp1_1 + tmp2_1 + tmp3_1 + tmp4_1 + tmp5_1 + tmp6_1 + tmp7_1;  
                                 EM_S[INDEX2(1,4,8)]+=tmp11_1 + tmp14_1 + tmp42_1 + tmp44_1 + tmp49_1 + tmp50_1 + tmp51_1 + tmp9_1;  
                                 EM_S[INDEX2(2,4,8)]+=tmp10_1 + tmp12_1 + tmp40_1 + tmp41_1 + tmp42_1 + tmp52_1 + tmp53_1 + tmp8_1;  
                                 EM_S[INDEX2(3,4,8)]+=tmp29_1 + tmp30_1 + tmp31_1 + tmp32_1 + tmp36_1 + tmp37_1;  
                                 EM_S[INDEX2(4,4,8)]+=tmp35_1 + tmp43_1 + tmp45_1 + tmp46_1 + tmp47_1 + tmp48_1;  
                                 EM_S[INDEX2(5,4,8)]+=tmp21_1 + tmp23_1 + tmp24_1 + tmp25_1 + tmp26_1 + tmp27_1 + tmp28_1 + tmp6_1;  
                                 EM_S[INDEX2(6,4,8)]+=tmp0_1 + tmp16_1 + tmp17_1 + tmp18_1 + tmp19_1 + tmp20_1 + tmp21_1 + tmp22_1;  
                                 EM_S[INDEX2(7,4,8)]+=tmp11_1 + tmp13_1 + tmp15_1 + tmp33_1 + tmp34_1 + tmp38_1 + tmp39_1 + tmp8_1;  
                                 EM_S[INDEX2(0,5,8)]+=tmp11_1 + tmp14_1 + tmp40_1 + tmp41_1 + tmp42_1 + tmp43_1 + tmp44_1 + tmp9_1;  
                                 EM_S[INDEX2(1,5,8)]+=tmp0_1 + tmp1_1 + tmp23_1 + tmp24_1 + tmp30_1 + tmp5_1 + tmp6_1 + tmp7_1;  
                                 EM_S[INDEX2(2,5,8)]+=tmp16_1 + tmp29_1 + tmp2_1 + tmp31_1 + tmp32_1 + tmp37_1;  
                                 EM_S[INDEX2(3,5,8)]+=tmp33_1 + tmp34_1 + tmp42_1 + tmp49_1 + tmp50_1 + tmp52_1 + tmp53_1 + tmp8_1;  
                                 EM_S[INDEX2(4,5,8)]+=tmp19_1 + tmp21_1 + tmp22_1 + tmp26_1 + tmp27_1 + tmp3_1 + tmp4_1 + tmp6_1;  
                                 EM_S[INDEX2(5,5,8)]+=tmp13_1 + tmp45_1 + tmp46_1 + tmp47_1 + tmp48_1 + tmp51_1;  
                                 EM_S[INDEX2(6,5,8)]+=tmp10_1 + tmp11_1 + tmp12_1 + tmp15_1 + tmp35_1 + tmp38_1 + tmp39_1 + tmp8_1;  
                                 EM_S[INDEX2(7,5,8)]+=tmp0_1 + tmp17_1 + tmp18_1 + tmp20_1 + tmp21_1 + tmp25_1 + tmp28_1 + tmp36_1;  
                                 EM_S[INDEX2(0,6,8)]+=tmp10_1 + tmp12_1 + tmp42_1 + tmp45_1 + tmp49_1 + tmp50_1 + tmp53_1 + tmp8_1;  
                                 EM_S[INDEX2(1,6,8)]+=tmp27_1 + tmp29_1 + tmp2_1 + tmp31_1 + tmp32_1 + tmp36_1;  
                                 EM_S[INDEX2(2,6,8)]+=tmp0_1 + tmp17_1 + tmp20_1 + tmp30_1 + tmp3_1 + tmp4_1 + tmp6_1 + tmp7_1;  
                                 EM_S[INDEX2(3,6,8)]+=tmp11_1 + tmp38_1 + tmp39_1 + tmp40_1 + tmp41_1 + tmp42_1 + tmp44_1 + tmp51_1;  
                                 EM_S[INDEX2(4,6,8)]+=tmp0_1 + tmp16_1 + tmp18_1 + tmp1_1 + tmp21_1 + tmp25_1 + tmp28_1 + tmp5_1;  
                                 EM_S[INDEX2(5,6,8)]+=tmp11_1 + tmp14_1 + tmp15_1 + tmp33_1 + tmp34_1 + tmp35_1 + tmp8_1 + tmp9_1;  
                                 EM_S[INDEX2(6,6,8)]+=tmp13_1 + tmp43_1 + tmp46_1 + tmp47_1 + tmp48_1 + tmp52_1;  
                                 EM_S[INDEX2(7,6,8)]+=tmp19_1 + tmp21_1 + tmp22_1 + tmp23_1 + tmp24_1 + tmp26_1 + tmp37_1 + tmp6_1;  
                                 EM_S[INDEX2(0,7,8)]+=tmp16_1 + tmp27_1 + tmp29_1 + tmp30_1 + tmp31_1 + tmp32_1;  
                                 EM_S[INDEX2(1,7,8)]+=tmp33_1 + tmp34_1 + tmp40_1 + tmp41_1 + tmp42_1 + tmp45_1 + tmp53_1 + tmp8_1;  
                                 EM_S[INDEX2(2,7,8)]+=tmp11_1 + tmp38_1 + tmp39_1 + tmp42_1 + tmp43_1 + tmp44_1 + tmp49_1 + tmp50_1;  
                                 EM_S[INDEX2(3,7,8)]+=tmp0_1 + tmp17_1 + tmp20_1 + tmp23_1 + tmp24_1 + tmp2_1 + tmp6_1 + tmp7_1;  
                                 EM_S[INDEX2(4,7,8)]+=tmp10_1 + tmp11_1 + tmp12_1 + tmp13_1 + tmp14_1 + tmp15_1 + tmp8_1 + tmp9_1;  
                                 EM_S[INDEX2(5,7,8)]+=tmp0_1 + tmp18_1 + tmp19_1 + tmp1_1 + tmp21_1 + tmp22_1 + tmp36_1 + tmp5_1;  
                                 EM_S[INDEX2(6,7,8)]+=tmp21_1 + tmp25_1 + tmp26_1 + tmp28_1 + tmp37_1 + tmp3_1 + tmp4_1 + tmp6_1;  
                                 EM_S[INDEX2(7,7,8)]+=tmp35_1 + tmp46_1 + tmp47_1 + tmp48_1 + tmp51_1 + tmp52_1;  
                             }  
                         }  
                         ///////////////  
                         // process B //  
                         ///////////////  
                         if (!B.isEmpty()) {  
                             add_EM_S=true;  
                             const double* B_p=const_cast<escript::Data*>(&B)->getSampleDataRO(e);  
                             if (B.actsExpanded()) {  
                                 const double B_0_0 = B_p[INDEX2(0,0,3)];  
                                 const double B_1_0 = B_p[INDEX2(1,0,3)];  
                                 const double B_2_0 = B_p[INDEX2(2,0,3)];  
                                 const double B_0_1 = B_p[INDEX2(0,1,3)];  
                                 const double B_1_1 = B_p[INDEX2(1,1,3)];  
                                 const double B_2_1 = B_p[INDEX2(2,1,3)];  
                                 const double B_0_2 = B_p[INDEX2(0,2,3)];  
                                 const double B_1_2 = B_p[INDEX2(1,2,3)];  
                                 const double B_2_2 = B_p[INDEX2(2,2,3)];  
                                 const double B_0_3 = B_p[INDEX2(0,3,3)];  
                                 const double B_1_3 = B_p[INDEX2(1,3,3)];  
                                 const double B_2_3 = B_p[INDEX2(2,3,3)];  
                                 const double B_0_4 = B_p[INDEX2(0,4,3)];  
                                 const double B_1_4 = B_p[INDEX2(1,4,3)];  
                                 const double B_2_4 = B_p[INDEX2(2,4,3)];  
                                 const double B_0_5 = B_p[INDEX2(0,5,3)];  
                                 const double B_1_5 = B_p[INDEX2(1,5,3)];  
                                 const double B_2_5 = B_p[INDEX2(2,5,3)];  
                                 const double B_0_6 = B_p[INDEX2(0,6,3)];  
                                 const double B_1_6 = B_p[INDEX2(1,6,3)];  
                                 const double B_2_6 = B_p[INDEX2(2,6,3)];  
                                 const double B_0_7 = B_p[INDEX2(0,7,3)];  
                                 const double B_1_7 = B_p[INDEX2(1,7,3)];  
                                 const double B_2_7 = B_p[INDEX2(2,7,3)];  
                                 const double tmp24_0 = B_2_0 + B_2_2;  
                                 const double tmp19_0 = B_2_0 + B_2_1 + B_2_2 + B_2_3;  
                                 const double tmp20_0 = B_1_0 + B_1_5;  
                                 const double tmp22_0 = B_2_1 + B_2_3;  
                                 const double tmp29_0 = B_2_2 + B_2_3;  
                                 const double tmp34_0 = B_1_0 + B_1_1 + B_1_4 + B_1_5;  
                                 const double tmp15_0 = B_2_4 + B_2_5 + B_2_6 + B_2_7;  
                                 const double tmp7_0 = B_0_0 + B_0_4;  
                                 const double tmp40_0 = B_1_1 + B_1_4;  
                                 const double tmp14_0 = B_1_4 + B_1_5;  
                                 const double tmp35_0 = B_1_2 + B_1_3 + B_1_6 + B_1_7;  
                                 const double tmp17_0 = B_1_6 + B_1_7;  
                                 const double tmp8_0 = B_1_2 + B_1_6;  
                                 const double tmp28_0 = B_2_4 + B_2_5;  
                                 const double tmp10_0 = B_0_1 + B_0_3;  
                                 const double tmp9_0 = B_2_5 + B_2_6;  
                                 const double tmp30_0 = B_2_0 + B_2_1;  
                                 const double tmp27_0 = B_0_0 + B_0_6;  
                                 const double tmp32_0 = B_0_0 + B_0_2 + B_0_4 + B_0_6;  
                                 const double tmp16_0 = B_0_0 + B_0_2;  
                                 const double tmp2_0 = B_1_3 + B_1_7;  
                                 const double tmp3_0 = B_2_1 + B_2_2;  
                                 const double tmp33_0 = B_0_1 + B_0_3 + B_0_5 + B_0_7;  
                                 const double tmp23_0 = B_2_5 + B_2_7;  
                                 const double tmp36_0 = B_2_4 + B_2_7;  
                                 const double tmp39_0 = B_0_3 + B_0_5;  
                                 const double tmp41_0 = B_1_3 + B_1_6;  
                                 const double tmp5_0 = B_1_0 + B_1_4;  
                                 const double tmp18_0 = B_1_0 + B_1_1;  
                                 const double tmp0_0 = B_0_1 + B_0_5;  
                                 const double tmp37_0 = B_2_0 + B_2_3;  
                                 const double tmp25_0 = B_2_4 + B_2_6;  
                                 const double tmp38_0 = B_0_2 + B_0_4;  
                                 const double tmp31_0 = B_2_6 + B_2_7;  
                                 const double tmp1_0 = B_0_2 + B_0_6;  
                                 const double tmp11_0 = B_0_4 + B_0_6;  
                                 const double tmp21_0 = B_1_2 + B_1_7;  
                                 const double tmp6_0 = B_1_1 + B_1_5;  
                                 const double tmp13_0 = B_1_2 + B_1_3;  
                                 const double tmp12_0 = B_0_5 + B_0_7;  
                                 const double tmp26_0 = B_0_1 + B_0_7;  
                                 const double tmp4_0 = B_0_3 + B_0_7;  
                                 const double tmp324_1 = B_0_6*w104;  
                                 const double tmp209_1 = B_1_4*w114;  
                                 const double tmp255_1 = B_2_3*w103;  
                                 const double tmp37_1 = B_1_1*w111;  
                                 const double tmp326_1 = tmp38_0*w108;  
                                 const double tmp179_1 = tmp21_0*w94;  
                                 const double tmp102_1 = tmp4_0*w93;  
                                 const double tmp251_1 = B_0_2*w125;  
                                 const double tmp321_1 = B_0_4*w90;  
                                 const double tmp198_1 = tmp41_0*w97;  
                                 const double tmp15_1 = tmp11_0*w108;  
                                 const double tmp158_1 = tmp17_0*w99;  
                                 const double tmp138_1 = tmp35_0*w94;  
                                 const double tmp5_1 = B_2_3*w100;  
                                 const double tmp51_1 = tmp25_0*w103;  
                                 const double tmp258_1 = B_2_7*w100;  
                                 const double tmp221_1 = B_0_4*w125;  
                                 const double tmp70_1 = B_0_5*w98;  
                                 const double tmp202_1 = tmp38_0*w96;  
                                 const double tmp247_1 = tmp41_0*w94;  
                                 const double tmp122_1 = tmp34_0*w94;  
                                 const double tmp349_1 = B_2_1*w101;  
                                 const double tmp167_1 = tmp31_0*w103;  
                                 const double tmp408_1 = tmp8_0*w111;  
                                 const double tmp20_1 = tmp16_0*w104;  
                                 const double tmp2_1 = B_2_7*w103;  
                                 const double tmp398_1 = B_1_7*w99;  
                                 const double tmp262_1 = B_1_7*w119;  
                                 const double tmp97_1 = tmp5_0*w94;  
                                 const double tmp157_1 = tmp30_0*w92;  
                                 const double tmp67_1 = tmp18_0*w107;  
                                 const double tmp144_1 = tmp7_0*w110;  
                                 const double tmp264_1 = B_0_0*w120;  
                                 const double tmp396_1 = tmp6_0*w97;  
                                 const double tmp218_1 = B_1_6*w111;  
                                 const double tmp147_1 = tmp8_0*w109;  
                                 const double tmp39_1 = tmp12_0*w108;  
                                 const double tmp58_1 = tmp15_0*w112;  
                                 const double tmp214_1 = B_1_3*w115;  
                                 const double tmp69_1 = tmp30_0*w95;  
                                 const double tmp54_1 = tmp18_0*w99;  
                                 const double tmp261_1 = B_2_0*w101;  
                                 const double tmp390_1 = tmp24_0*w103;  
                                 const double tmp374_1 = B_2_1*w103;  
                                 const double tmp151_1 = tmp2_0*w105;  
                                 const double tmp274_1 = tmp22_0*w95;  
                                 const double tmp126_1 = tmp16_0*w108;  
                                 const double tmp302_1 = B_2_6*w122;  
                                 const double tmp14_1 = tmp10_0*w106;  
                                 const double tmp190_1 = B_1_2*w99;  
                                 const double tmp9_1 = B_2_4*w101;  
                                 const double tmp150_1 = B_2_7*w101;  
                                 const double tmp66_1 = tmp29_0*w92;  
                                 const double tmp334_1 = B_0_7*w124;  
                                 const double tmp252_1 = tmp38_0*w93;  
                                 const double tmp392_1 = tmp5_0*w99;  
                                 const double tmp4_1 = tmp2_0*w99;  
                                 const double tmp63_1 = B_0_4*w121;  
                                 const double tmp152_1 = tmp5_0*w111;  
                                 const double tmp133_1 = tmp4_0*w96;  
                                 const double tmp195_1 = tmp40_0*w94;  
                                 const double tmp145_1 = B_2_3*w92;  
                                 const double tmp35_1 = tmp25_0*w116;  
                                 const double tmp316_1 = B_0_3*w98;  
                                 const double tmp208_1 = B_2_0*w103;  
                                 const double tmp373_1 = B_1_2*w115;  
                                 const double tmp62_1 = tmp26_0*w93;  
                                 const double tmp85_1 = tmp10_0*w90;  
                                 const double tmp187_1 = tmp11_0*w106;  
                                 const double tmp342_1 = B_2_5*w92;  
                                 const double tmp77_1 = tmp33_0*w108;  
                                 const double tmp121_1 = B_2_4*w116;  
                                 const double tmp379_1 = B_2_2*w101;  
                                 const double tmp391_1 = tmp23_0*w92;  
                                 const double tmp451_1 = tmp22_0*w116;  
                                 const double tmp73_1 = B_0_2*w90;  
                                 const double tmp436_1 = B_1_6*w114;  
                                 const double tmp233_1 = tmp29_0*w117;  
                                 const double tmp426_1 = tmp23_0*w113;  
                                 const double tmp124_1 = tmp11_0*w104;  
                                 const double tmp148_1 = B_2_0*w100;  
                                 const double tmp314_1 = tmp29_0*w113;  
                                 const double tmp163_1 = B_0_0*w124;  
                                 const double tmp301_1 = B_1_6*w115;  
                                 const double tmp171_1 = B_2_4*w122;  
                                 const double tmp7_1 = tmp4_0*w98;  
                                 const double tmp11_1 = tmp7_0*w90;  
                                 const double tmp308_1 = B_2_2*w116;  
                                 const double tmp117_1 = B_2_3*w113;  
                                 const double tmp403_1 = B_0_5*w104;  
                                 const double tmp178_1 = tmp9_0*w112;  
                                 const double tmp128_1 = tmp17_0*w107;  
                                 const double tmp89_1 = tmp1_0*w110;  
                                 const double tmp434_1 = tmp19_0*w95;  
                                 const double tmp270_1 = B_1_7*w114;  
                                 const double tmp358_1 = tmp6_0*w99;  
                                 const double tmp411_1 = tmp14_0*w107;  
                                 const double tmp433_1 = B_0_1*w125;  
                                 const double tmp376_1 = B_2_6*w92;  
                                 const double tmp42_1 = B_1_6*w99;  
                                 const double tmp72_1 = tmp13_0*w105;  
                                 const double tmp287_1 = tmp2_0*w111;  
                                 const double tmp191_1 = tmp24_0*w113;  
                                 const double tmp6_1 = tmp3_0*w95;  
                                 const double tmp309_1 = B_1_4*w105;  
                                 const double tmp367_1 = B_0_5*w125;  
                                 const double tmp234_1 = tmp28_0*w112;  
                                 const double tmp339_1 = B_1_2*w111;  
                                 const double tmp335_1 = tmp41_0*w107;  
                                 const double tmp173_1 = B_2_7*w113;  
                                 const double tmp384_1 = tmp28_0*w113;  
                                 const double tmp81_1 = tmp19_0*w112;  
                                 const double tmp328_1 = B_2_7*w122;  
                                 const double tmp413_1 = tmp30_0*w113;  
                                 const double tmp111_1 = B_2_6*w101;  
                                 const double tmp378_1 = B_0_4*w98;  
                                 const double tmp211_1 = tmp21_0*w107;  
                                 const double tmp79_1 = tmp35_0*w109;  
                                 const double tmp354_1 = tmp1_0*w93;  
                                 const double tmp333_1 = B_2_0*w123;  
                                 const double tmp169_1 = B_0_3*w121;  
                                 const double tmp300_1 = B_0_1*w121;  
                                 const double tmp118_1 = B_2_7*w123;  
                                 const double tmp372_1 = B_0_5*w121;  
                                 const double tmp104_1 = B_2_5*w103;  
                                 const double tmp304_1 = B_2_5*w113;  
                                 const double tmp397_1 = tmp22_0*w102;  
                                 const double tmp61_1 = tmp14_0*w97;  
                                 const double tmp290_1 = tmp4_0*w106;  
                                 const double tmp269_1 = tmp23_0*w103;  
                                 const double tmp361_1 = tmp5_0*w97;  
                                 const double tmp189_1 = tmp16_0*w110;  
                                 const double tmp116_1 = B_2_0*w122;  
                                 const double tmp449_1 = tmp24_0*w117;  
                                 const double tmp268_1 = tmp11_0*w96;  
                                 const double tmp325_1 = tmp39_0*w106;  
                                 const double tmp27_1 = tmp20_0*w107;  
                                 const double tmp174_1 = B_2_3*w123;  
                                 const double tmp422_1 = tmp14_0*w99;  
                                 const double tmp146_1 = tmp6_0*w107;  
                                 const double tmp277_1 = B_1_2*w105;  
                                 const double tmp443_1 = B_1_6*w118;  
                                 const double tmp446_1 = B_1_7*w105;  
                                 const double tmp91_1 = tmp8_0*w99;  
                                 const double tmp405_1 = B_0_3*w125;  
                                 const double tmp57_1 = tmp17_0*w91;  
                                 const double tmp455_1 = B_2_6*w103;  
                                 const double tmp110_1 = tmp0_0*w98;  
                                 const double tmp341_1 = B_1_6*w119;  
                                 const double tmp203_1 = B_0_7*w98;  
                                 const double tmp371_1 = B_2_7*w116;  
                                 const double tmp382_1 = B_0_3*w90;  
                                 const double tmp320_1 = tmp28_0*w116;  
                                 const double tmp107_1 = tmp2_0*w109;  
                                 const double tmp149_1 = tmp4_0*w104;  
                                 const double tmp159_1 = tmp29_0*w95;  
                                 const double tmp253_1 = B_0_7*w121;  
                                 const double tmp90_1 = B_2_1*w122;  
                                 const double tmp360_1 = tmp2_0*w94;  
                                 const double tmp414_1 = tmp28_0*w117;  
                                 const double tmp26_1 = tmp16_0*w96;  
                                 const double tmp84_1 = tmp11_0*w98;  
                                 const double tmp225_1 = tmp1_0*w108;  
                                 const double tmp1_1 = tmp1_0*w96;  
                                 const double tmp344_1 = B_2_6*w100;  
                                 const double tmp400_1 = B_1_5*w119;  
                                 const double tmp345_1 = tmp36_0*w95;  
                                 const double tmp407_1 = tmp5_0*w109;  
                                 const double tmp228_1 = B_2_2*w122;  
                                 const double tmp113_1 = tmp8_0*w105;  
                                 const double tmp347_1 = B_0_0*w104;  
                                 const double tmp286_1 = tmp23_0*w95;  
                                 const double tmp395_1 = tmp8_0*w94;  
                                 const double tmp401_1 = B_1_2*w118;  
                                 const double tmp380_1 = B_1_7*w111;  
                                 const double tmp327_1 = B_0_1*w110;  
                                 const double tmp55_1 = tmp19_0*w117;  
                                 const double tmp291_1 = tmp7_0*w108;  
                                 const double tmp31_1 = tmp10_0*w98;  
                                 const double tmp125_1 = tmp12_0*w106;  
                                 const double tmp330_1 = tmp40_0*w109;  
                                 const double tmp323_1 = tmp17_0*w97;  
                                 const double tmp136_1 = tmp31_0*w95;  
                                 const double tmp16_1 = tmp12_0*w110;  
                                 const double tmp418_1 = B_0_6*w90;  
                                 const double tmp428_1 = tmp25_0*w112;  
                                 const double tmp385_1 = tmp30_0*w117;  
                                 const double tmp351_1 = B_1_1*w118;  
                                 const double tmp165_1 = B_0_7*w125;  
                                 const double tmp298_1 = tmp29_0*w102;  
                                 const double tmp295_1 = tmp34_0*w109;  
                                 const double tmp296_1 = tmp28_0*w95;  
                                 const double tmp283_1 = tmp25_0*w92;  
                                 const double tmp230_1 = B_2_5*w123;  
                                 const double tmp350_1 = B_0_1*w124;  
                                 const double tmp293_1 = tmp31_0*w92;  
                                 const double tmp8_1 = tmp5_0*w91;  
                                 const double tmp215_1 = tmp9_0*w95;  
                                 const double tmp329_1 = B_1_0*w114;  
                                 const double tmp115_1 = tmp6_0*w111;  
                                 const double tmp387_1 = tmp29_0*w116;  
                                 const double tmp442_1 = B_1_1*w119;  
                                 const double tmp281_1 = tmp33_0*w96;  
                                 const double tmp415_1 = B_0_1*w98;  
                                 const double tmp311_1 = B_1_3*w111;  
                                 const double tmp50_1 = tmp23_0*w102;  
                                 const double tmp294_1 = tmp35_0*w107;  
                                 const double tmp362_1 = tmp27_0*w106;  
                                 const double tmp340_1 = B_2_2*w103;  
                                 const double tmp282_1 = tmp22_0*w103;  
                                 const double tmp254_1 = tmp39_0*w96;  
                                 const double tmp186_1 = tmp12_0*w104;  
                                 const double tmp106_1 = tmp5_0*w107;  
                                 const double tmp170_1 = tmp26_0*w96;  
                                 const double tmp427_1 = tmp22_0*w117;  
                                 const double tmp452_1 = B_2_1*w92;  
                                 const double tmp437_1 = B_1_1*w115;  
                                 const double tmp431_1 = B_0_0*w110;  
                                 const double tmp201_1 = B_0_6*w121;  
                                 const double tmp310_1 = B_0_6*w120;  
                                 const double tmp331_1 = B_2_4*w113;  
                                 const double tmp212_1 = tmp20_0*w109;  
                                 const double tmp47_1 = B_1_4*w119;  
                                 const double tmp420_1 = B_0_7*w120;  
                                 const double tmp38_1 = tmp16_0*w106;  
                                 const double tmp184_1 = tmp20_0*w97;  
                                 const double tmp280_1 = tmp32_0*w93;  
                                 const double tmp123_1 = tmp35_0*w97;  
                                 const double tmp359_1 = tmp8_0*w91;  
                                 const double tmp95_1 = tmp6_0*w91;  
                                 const double tmp246_1 = tmp36_0*w112;  
                                 const double tmp241_1 = B_2_6*w113;  
                                 const double tmp3_1 = B_2_0*w92;  
                                 const double tmp162_1 = tmp14_0*w94;  
                                 const double tmp406_1 = tmp2_0*w107;  
                                 const double tmp175_1 = tmp3_0*w117;  
                                 const double tmp205_1 = B_0_1*w120;  
                                 const double tmp416_1 = tmp29_0*w112;  
                                 const double tmp48_1 = tmp21_0*w97;  
                                 const double tmp101_1 = tmp32_0*w96;  
                                 const double tmp231_1 = B_2_6*w116;  
                                 const double tmp366_1 = B_0_2*w124;  
                                 const double tmp34_1 = tmp11_0*w90;  
                                 const double tmp200_1 = tmp39_0*w93;  
                                 const double tmp44_1 = tmp10_0*w104;  
                                 const double tmp346_1 = B_0_6*w125;  
                                 const double tmp65_1 = tmp28_0*w103;  
                                 const double tmp248_1 = B_1_2*w119;  
                                 const double tmp288_1 = tmp5_0*w105;  
                                 const double tmp227_1 = tmp4_0*w110;  
                                 const double tmp343_1 = B_1_4*w99;  
                                 const double tmp139_1 = tmp0_0*w90;  
                                 const double tmp41_1 = tmp22_0*w92;  
                                 const double tmp305_1 = B_2_1*w123;  
                                 const double tmp307_1 = B_0_7*w90;  
                                 const double tmp217_1 = B_2_3*w101;  
                                 const double tmp219_1 = B_0_3*w124;  
                                 const double tmp105_1 = B_2_2*w92;  
                                 const double tmp423_1 = tmp13_0*w91;  
                                 const double tmp381_1 = B_1_0*w105;  
                                 const double tmp166_1 = tmp28_0*w102;  
                                 const double tmp259_1 = B_0_6*w98;  
                                 const double tmp402_1 = B_0_2*w110;  
                                 const double tmp263_1 = B_0_1*w90;  
                                 const double tmp276_1 = B_1_5*w111;  
                                 const double tmp243_1 = B_2_2*w123;  
                                 const double tmp131_1 = tmp13_0*w111;  
                                 const double tmp265_1 = B_1_0*w118;  
                                 const double tmp337_1 = B_1_5*w105;  
                                 const double tmp172_1 = B_1_1*w99;  
                                 const double tmp161_1 = tmp18_0*w91;  
                                 const double tmp88_1 = tmp4_0*w108;  
                                 const double tmp236_1 = B_1_5*w118;  
                                 const double tmp273_1 = tmp41_0*w109;  
                                 const double tmp154_1 = tmp38_0*w106;  
                                 const double tmp440_1 = B_1_3*w99;  
                                 const double tmp33_1 = B_1_3*w114;  
                                 const double tmp141_1 = tmp30_0*w102;  
                                 const double tmp393_1 = tmp25_0*w95;  
                                 const double tmp289_1 = tmp24_0*w102;  
                                 const double tmp180_1 = B_1_3*w119;  
                                 const double tmp86_1 = tmp36_0*w117;  
                                 const double tmp444_1 = B_1_5*w115;  
                                 const double tmp447_1 = B_1_0*w111;  
                                 const double tmp315_1 = tmp31_0*w117;  
                                 const double tmp120_1 = tmp3_0*w112;  
                                 const double tmp355_1 = tmp0_0*w96;  
                                 const double tmp223_1 = B_0_5*w110;  
                                 const double tmp60_1 = tmp12_0*w90;  
                                 const double tmp239_1 = B_2_5*w122;  
                                 const double tmp194_1 = tmp22_0*w112;  
                                 const double tmp28_1 = tmp21_0*w109;  
                                 const double tmp24_1 = tmp12_0*w93;  
                                 const double tmp424_1 = tmp17_0*w94;  
                                 const double tmp237_1 = B_0_4*w104;  
                                 const double tmp322_1 = B_0_5*w120;  
                                 const double tmp453_1 = B_2_2*w100;  
                                 const double tmp238_1 = B_0_3*w110;  
                                 const double tmp370_1 = B_2_4*w123;  
                                 const double tmp155_1 = tmp39_0*w108;  
                                 const double tmp23_1 = tmp19_0*w102;  
                                 const double tmp181_1 = B_2_0*w116;  
                                 const double tmp164_1 = tmp13_0*w97;  
                                 const double tmp168_1 = tmp27_0*w93;  
                                 const double tmp285_1 = tmp6_0*w109;  
                                 const double tmp32_1 = tmp24_0*w112;  
                                 const double tmp210_1 = B_2_7*w92;  
                                 const double tmp399_1 = B_1_0*w91;  
                                 const double tmp183_1 = B_0_4*w120;  
                                 const double tmp185_1 = B_1_4*w118;  
                                 const double tmp40_1 = tmp11_0*w110;  
                                 const double tmp59_1 = tmp13_0*w94;  
                                 const double tmp279_1 = tmp25_0*w102;  
                                 const double tmp242_1 = B_1_7*w91;  
                                 const double tmp454_1 = B_2_5*w101;  
                                 const double tmp114_1 = tmp1_0*w90;  
                                 const double tmp319_1 = tmp18_0*w94;  
                                 const double tmp394_1 = tmp2_0*w91;  
                                 const double tmp229_1 = B_2_1*w113;  
                                 const double tmp93_1 = B_2_6*w123;  
                                 const double tmp278_1 = tmp16_0*w90;  
                                 const double tmp46_1 = tmp20_0*w94;  
                                 const double tmp87_1 = tmp7_0*w106;  
                                 const double tmp421_1 = tmp18_0*w111;  
                                 const double tmp313_1 = tmp13_0*w99;  
                                 const double tmp364_1 = B_0_4*w110;  
                                 const double tmp412_1 = tmp13_0*w109;  
                                 const double tmp30_1 = tmp23_0*w117;  
                                 const double tmp365_1 = B_0_3*w104;  
                                 const double tmp425_1 = tmp18_0*w97;  
                                 const double tmp134_1 = tmp29_0*w103;  
                                 const double tmp143_1 = tmp0_0*w108;  
                                 const double tmp213_1 = B_2_4*w100;  
                                 const double tmp435_1 = tmp15_0*w102;  
                                 const double tmp78_1 = tmp34_0*w107;  
                                 const double tmp76_1 = tmp32_0*w106;  
                                 const double tmp132_1 = tmp7_0*w93;  
                                 const double tmp348_1 = B_1_3*w91;  
                                 const double tmp68_1 = tmp17_0*w109;  
                                 const double tmp130_1 = tmp14_0*w105;  
                                 const double tmp142_1 = tmp1_0*w106;  
                                 const double tmp153_1 = B_2_4*w103;  
                                 const double tmp432_1 = B_0_6*w124;  
                                 const double tmp256_1 = B_2_4*w92;  
                                 const double tmp204_1 = B_0_0*w90;  
                                 const double tmp82_1 = tmp16_0*w93;  
                                 const double tmp222_1 = tmp3_0*w102;  
                                 const double tmp272_1 = tmp40_0*w107;  
                                 const double tmp19_1 = tmp15_0*w95;  
                                 const double tmp226_1 = tmp7_0*w104;  
                                 const double tmp25_1 = B_1_4*w115;  
                                 const double tmp199_1 = B_1_7*w118;  
                                 const double tmp303_1 = B_1_1*w114;  
                                 const double tmp318_1 = tmp30_0*w112;  
                                 const double tmp100_1 = tmp33_0*w93;  
                                 const double tmp439_1 = B_1_4*w111;  
                                 const double tmp17_1 = tmp13_0*w107;  
                                 const double tmp83_1 = tmp12_0*w96;  
                                 const double tmp45_1 = B_1_1*w91;  
                                 const double tmp75_1 = tmp14_0*w111;  
                                 const double tmp368_1 = B_2_3*w122;  
                                 const double tmp216_1 = B_0_2*w104;  
                                 const double tmp429_1 = tmp24_0*w116;  
                                 const double tmp388_1 = tmp33_0*w106;  
                                 const double tmp13_1 = tmp9_0*w102;  
                                 const double tmp18_1 = tmp14_0*w109;  
                                 const double tmp112_1 = tmp36_0*w102;  
                                 const double tmp140_1 = tmp34_0*w97;  
                                 const double tmp383_1 = B_0_2*w120;  
                                 const double tmp119_1 = tmp9_0*w117;  
                                 const double tmp36_1 = B_1_6*w105;  
                                 const double tmp266_1 = tmp10_0*w93;  
                                 const double tmp336_1 = B_2_3*w116;  
                                 const double tmp419_1 = tmp31_0*w116;  
                                 const double tmp363_1 = tmp26_0*w108;  
                                 const double tmp196_1 = B_1_0*w119;  
                                 const double tmp182_1 = B_0_5*w90;  
                                 const double tmp0_1 = tmp0_0*w93;  
                                 const double tmp297_1 = tmp1_0*w104;  
                                 const double tmp12_1 = tmp8_0*w97;  
                                 const double tmp244_1 = tmp37_0*w117;  
                                 const double tmp332_1 = B_1_7*w115;  
                                 const double tmp156_1 = B_0_6*w110;  
                                 const double tmp127_1 = tmp10_0*w110;  
                                 const double tmp257_1 = B_1_5*w99;  
                                 const double tmp64_1 = tmp27_0*w96;  
                                 const double tmp389_1 = tmp32_0*w108;  
                                 const double tmp10_1 = tmp6_0*w94;  
                                 const double tmp317_1 = tmp14_0*w91;  
                                 const double tmp275_1 = tmp12_0*w98;  
                                 const double tmp99_1 = tmp2_0*w97;  
                                 const double tmp192_1 = tmp25_0*w117;  
                                 const double tmp224_1 = tmp0_0*w106;  
                                 const double tmp410_1 = B_0_0*w121;  
                                 const double tmp409_1 = tmp6_0*w105;  
                                 const double tmp441_1 = B_1_4*w91;  
                                 const double tmp206_1 = tmp26_0*w106;  
                                 const double tmp232_1 = tmp31_0*w113;  
                                 const double tmp108_1 = B_2_1*w100;  
                                 const double tmp21_1 = tmp17_0*w111;  
                                 const double tmp52_1 = tmp11_0*w93;  
                                 const double tmp103_1 = tmp7_0*w96;  
                                 const double tmp197_1 = tmp23_0*w116;  
                                 const double tmp438_1 = B_1_3*w105;  
                                 const double tmp235_1 = tmp30_0*w116;  
                                 const double tmp29_1 = tmp22_0*w113;  
                                 const double tmp98_1 = B_2_5*w116;  
                                 const double tmp369_1 = B_2_0*w113;  
                                 const double tmp74_1 = B_0_3*w120;  
                                 const double tmp137_1 = tmp1_0*w98;  
                                 const double tmp284_1 = tmp8_0*w107;  
                                 const double tmp109_1 = tmp37_0*w95;  
                                 const double tmp448_1 = tmp25_0*w113;  
                                 const double tmp56_1 = tmp16_0*w98;  
                                 const double tmp375_1 = B_1_5*w114;  
                                 const double tmp188_1 = tmp10_0*w108;  
                                 const double tmp94_1 = tmp0_0*w104;  
                                 const double tmp260_1 = B_1_2*w91;  
                                 const double tmp49_1 = B_1_3*w118;  
                                 const double tmp404_1 = B_0_4*w124;  
                                 const double tmp430_1 = B_0_7*w104;  
                                 const double tmp299_1 = tmp0_0*w110;  
                                 const double tmp417_1 = tmp17_0*w105;  
                                 const double tmp445_1 = B_1_2*w114;  
                                 const double tmp353_1 = B_0_7*w110;  
                                 const double tmp135_1 = tmp28_0*w92;  
                                 const double tmp357_1 = tmp4_0*w90;  
                                 const double tmp356_1 = tmp7_0*w98;  
                                 const double tmp267_1 = B_1_0*w115;  
                                 const double tmp220_1 = B_1_1*w105;  
                                 const double tmp338_1 = B_0_0*w125;  
                                 const double tmp292_1 = tmp30_0*w103;  
                                 const double tmp53_1 = tmp10_0*w96;  
                                 const double tmp43_1 = tmp24_0*w95;  
                                 const double tmp386_1 = tmp31_0*w112;  
                                 const double tmp92_1 = B_2_2*w113;  
                                 const double tmp245_1 = B_0_5*w124;  
                                 const double tmp306_1 = B_0_0*w98;  
                                 const double tmp96_1 = tmp37_0*w112;  
                                 const double tmp177_1 = B_1_6*w91;  
                                 const double tmp176_1 = B_0_2*w98;  
                                 const double tmp71_1 = tmp31_0*w102;  
                                 const double tmp129_1 = tmp18_0*w109;  
                                 const double tmp352_1 = tmp37_0*w102;  
                                 const double tmp312_1 = B_0_2*w121;  
                                 const double tmp80_1 = tmp15_0*w117;  
                                 const double tmp450_1 = tmp23_0*w112;  
                                 const double tmp271_1 = tmp24_0*w92;  
                                 const double tmp22_1 = tmp18_0*w105;  
                                 const double tmp250_1 = tmp40_0*w97;  
                                 const double tmp249_1 = B_2_1*w116;  
                                 const double tmp207_1 = tmp27_0*w108;  
                                 const double tmp193_1 = B_1_5*w91;  
                                 const double tmp240_1 = B_1_0*w99;  
                                 const double tmp160_1 = B_0_1*w104;  
                                 const double tmp377_1 = B_2_5*w100;  
                                 EM_S[INDEX2(0,0,8)]+=tmp175_1 + tmp178_1 + tmp324_1 + tmp325_1 + tmp326_1 + tmp327_1 + tmp328_1 + tmp329_1 + tmp330_1 + tmp331_1 + tmp332_1 + tmp333_1 + tmp334_1 + tmp335_1 + tmp336_1 + tmp337_1 + tmp338_1 + tmp339_1;  
                                 EM_S[INDEX2(1,0,8)]+=tmp200_1 + tmp202_1 + tmp410_1 + tmp411_1 + tmp412_1 + tmp413_1 + tmp414_1 + tmp415_1 + tmp416_1 + tmp417_1 + tmp418_1 + tmp419_1 + tmp420_1 + tmp421_1;  
                                 EM_S[INDEX2(2,0,8)]+=tmp186_1 + tmp187_1 + tmp188_1 + tmp189_1 + tmp190_1 + tmp191_1 + tmp192_1 + tmp193_1 + tmp194_1 + tmp195_1 + tmp196_1 + tmp197_1 + tmp198_1 + tmp199_1;  
                                 EM_S[INDEX2(3,0,8)]+=tmp52_1 + tmp53_1 + tmp54_1 + tmp55_1 + tmp56_1 + tmp57_1 + tmp58_1 + tmp59_1 + tmp60_1 + tmp61_1;  
                                 EM_S[INDEX2(4,0,8)]+=tmp13_1 + tmp142_1 + tmp143_1 + tmp144_1 + tmp145_1 + tmp146_1 + tmp147_1 + tmp148_1 + tmp149_1 + tmp150_1 + tmp151_1 + tmp152_1 + tmp153_1 + tmp6_1;  
                                 EM_S[INDEX2(5,0,8)]+=tmp292_1 + tmp293_1 + tmp294_1 + tmp295_1 + tmp296_1 + tmp298_1 + tmp354_1 + tmp355_1 + tmp356_1 + tmp357_1;  
                                 EM_S[INDEX2(6,0,8)]+=tmp388_1 + tmp389_1 + tmp390_1 + tmp391_1 + tmp392_1 + tmp393_1 + tmp394_1 + tmp395_1 + tmp396_1 + tmp397_1;  
                                 EM_S[INDEX2(7,0,8)]+=tmp100_1 + tmp101_1 + tmp122_1 + tmp123_1 + tmp434_1 + tmp435_1;  
                                 EM_S[INDEX2(0,1,8)]+=tmp154_1 + tmp155_1 + tmp411_1 + tmp412_1 + tmp413_1 + tmp414_1 + tmp416_1 + tmp417_1 + tmp419_1 + tmp421_1 + tmp430_1 + tmp431_1 + tmp432_1 + tmp433_1;  
                                 EM_S[INDEX2(1,1,8)]+=tmp211_1 + tmp212_1 + tmp244_1 + tmp246_1 + tmp252_1 + tmp254_1 + tmp300_1 + tmp301_1 + tmp302_1 + tmp303_1 + tmp304_1 + tmp305_1 + tmp306_1 + tmp307_1 + tmp308_1 + tmp309_1 + tmp310_1 + tmp311_1;  
                                 EM_S[INDEX2(2,1,8)]+=tmp124_1 + tmp125_1 + tmp126_1 + tmp127_1 + tmp54_1 + tmp55_1 + tmp57_1 + tmp58_1 + tmp59_1 + tmp61_1;  
                                 EM_S[INDEX2(3,1,8)]+=tmp24_1 + tmp26_1 + tmp29_1 + tmp30_1 + tmp31_1 + tmp32_1 + tmp34_1 + tmp35_1 + tmp440_1 + tmp441_1 + tmp442_1 + tmp443_1 + tmp46_1 + tmp48_1;  
                                 EM_S[INDEX2(4,1,8)]+=tmp290_1 + tmp291_1 + tmp292_1 + tmp293_1 + tmp294_1 + tmp295_1 + tmp296_1 + tmp297_1 + tmp298_1 + tmp299_1;  
                                 EM_S[INDEX2(5,1,8)]+=tmp102_1 + tmp103_1 + tmp104_1 + tmp105_1 + tmp106_1 + tmp107_1 + tmp108_1 + tmp109_1 + tmp110_1 + tmp111_1 + tmp112_1 + tmp113_1 + tmp114_1 + tmp115_1;  
                                 EM_S[INDEX2(6,1,8)]+=tmp122_1 + tmp123_1 + tmp434_1 + tmp435_1 + tmp76_1 + tmp77_1;  
                                 EM_S[INDEX2(7,1,8)]+=tmp280_1 + tmp281_1 + tmp282_1 + tmp283_1 + tmp286_1 + tmp289_1 + tmp358_1 + tmp359_1 + tmp360_1 + tmp361_1;  
                                 EM_S[INDEX2(0,2,8)]+=tmp186_1 + tmp187_1 + tmp188_1 + tmp189_1 + tmp191_1 + tmp192_1 + tmp194_1 + tmp197_1 + tmp272_1 + tmp273_1 + tmp444_1 + tmp445_1 + tmp446_1 + tmp447_1;  
                                 EM_S[INDEX2(1,2,8)]+=tmp128_1 + tmp129_1 + tmp130_1 + tmp131_1 + tmp52_1 + tmp53_1 + tmp55_1 + tmp56_1 + tmp58_1 + tmp60_1;  
                                 EM_S[INDEX2(2,2,8)]+=tmp206_1 + tmp207_1 + tmp236_1 + tmp237_1 + tmp238_1 + tmp239_1 + tmp240_1 + tmp241_1 + tmp242_1 + tmp243_1 + tmp244_1 + tmp245_1 + tmp246_1 + tmp247_1 + tmp248_1 + tmp249_1 + tmp250_1 + tmp251_1;  
                                 EM_S[INDEX2(3,2,8)]+=tmp312_1 + tmp313_1 + tmp314_1 + tmp315_1 + tmp316_1 + tmp317_1 + tmp318_1 + tmp319_1 + tmp320_1 + tmp321_1 + tmp322_1 + tmp323_1 + tmp62_1 + tmp64_1;  
                                 EM_S[INDEX2(4,2,8)]+=tmp388_1 + tmp389_1 + tmp390_1 + tmp391_1 + tmp393_1 + tmp397_1 + tmp406_1 + tmp407_1 + tmp408_1 + tmp409_1;  
                                 EM_S[INDEX2(5,2,8)]+=tmp100_1 + tmp101_1 + tmp434_1 + tmp435_1 + tmp78_1 + tmp79_1;  
                                 EM_S[INDEX2(6,2,8)]+=tmp109_1 + tmp112_1 + tmp452_1 + tmp453_1 + tmp454_1 + tmp455_1 + tmp87_1 + tmp88_1 + tmp89_1 + tmp91_1 + tmp94_1 + tmp95_1 + tmp97_1 + tmp99_1;  
                                 EM_S[INDEX2(7,2,8)]+=tmp132_1 + tmp133_1 + tmp134_1 + tmp135_1 + tmp136_1 + tmp137_1 + tmp138_1 + tmp139_1 + tmp140_1 + tmp141_1;  
                                 EM_S[INDEX2(0,3,8)]+=tmp124_1 + tmp125_1 + tmp126_1 + tmp127_1 + tmp128_1 + tmp129_1 + tmp130_1 + tmp131_1 + tmp55_1 + tmp58_1;  
                                 EM_S[INDEX2(1,3,8)]+=tmp24_1 + tmp25_1 + tmp26_1 + tmp27_1 + tmp28_1 + tmp29_1 + tmp30_1 + tmp31_1 + tmp32_1 + tmp33_1 + tmp34_1 + tmp35_1 + tmp36_1 + tmp37_1;  
                                 EM_S[INDEX2(2,3,8)]+=tmp313_1 + tmp314_1 + tmp315_1 + tmp317_1 + tmp318_1 + tmp319_1 + tmp320_1 + tmp323_1 + tmp362_1 + tmp363_1 + tmp402_1 + tmp403_1 + tmp404_1 + tmp405_1;  
                                 EM_S[INDEX2(3,3,8)]+=tmp168_1 + tmp169_1 + tmp170_1 + tmp171_1 + tmp172_1 + tmp173_1 + tmp174_1 + tmp175_1 + tmp176_1 + tmp177_1 + tmp178_1 + tmp179_1 + tmp180_1 + tmp181_1 + tmp182_1 + tmp183_1 + tmp184_1 + tmp185_1;  
                                 EM_S[INDEX2(4,3,8)]+=tmp434_1 + tmp435_1 + tmp76_1 + tmp77_1 + tmp78_1 + tmp79_1;  
                                 EM_S[INDEX2(5,3,8)]+=tmp280_1 + tmp281_1 + tmp282_1 + tmp283_1 + tmp284_1 + tmp285_1 + tmp286_1 + tmp287_1 + tmp288_1 + tmp289_1;  
                                 EM_S[INDEX2(6,3,8)]+=tmp134_1 + tmp135_1 + tmp136_1 + tmp138_1 + tmp140_1 + tmp141_1 + tmp224_1 + tmp225_1 + tmp226_1 + tmp227_1;  
                                 EM_S[INDEX2(7,3,8)]+=tmp0_1 + tmp10_1 + tmp11_1 + tmp12_1 + tmp13_1 + tmp1_1 + tmp2_1 + tmp3_1 + tmp4_1 + tmp5_1 + tmp6_1 + tmp7_1 + tmp8_1 + tmp9_1;  
                                 EM_S[INDEX2(0,4,8)]+=tmp119_1 + tmp120_1 + tmp142_1 + tmp143_1 + tmp144_1 + tmp146_1 + tmp147_1 + tmp149_1 + tmp151_1 + tmp152_1 + tmp368_1 + tmp369_1 + tmp370_1 + tmp371_1;  
                                 EM_S[INDEX2(1,4,8)]+=tmp294_1 + tmp295_1 + tmp354_1 + tmp355_1 + tmp356_1 + tmp357_1 + tmp384_1 + tmp385_1 + tmp386_1 + tmp387_1;  
                                 EM_S[INDEX2(2,4,8)]+=tmp388_1 + tmp389_1 + tmp392_1 + tmp394_1 + tmp395_1 + tmp396_1 + tmp448_1 + tmp449_1 + tmp450_1 + tmp451_1;  
                                 EM_S[INDEX2(3,4,8)]+=tmp100_1 + tmp101_1 + tmp122_1 + tmp123_1 + tmp80_1 + tmp81_1;  
                                 EM_S[INDEX2(4,4,8)]+=tmp206_1 + tmp207_1 + tmp208_1 + tmp209_1 + tmp210_1 + tmp211_1 + tmp212_1 + tmp213_1 + tmp214_1 + tmp215_1 + tmp216_1 + tmp217_1 + tmp218_1 + tmp219_1 + tmp220_1 + tmp221_1 + tmp222_1 + tmp223_1;  
                                 EM_S[INDEX2(5,4,8)]+=tmp62_1 + tmp63_1 + tmp64_1 + tmp65_1 + tmp66_1 + tmp67_1 + tmp68_1 + tmp69_1 + tmp70_1 + tmp71_1 + tmp72_1 + tmp73_1 + tmp74_1 + tmp75_1;  
                                 EM_S[INDEX2(6,4,8)]+=tmp38_1 + tmp39_1 + tmp40_1 + tmp41_1 + tmp42_1 + tmp43_1 + tmp44_1 + tmp45_1 + tmp46_1 + tmp47_1 + tmp48_1 + tmp49_1 + tmp50_1 + tmp51_1;  
                                 EM_S[INDEX2(7,4,8)]+=tmp19_1 + tmp23_1 + tmp422_1 + tmp423_1 + tmp424_1 + tmp425_1 + tmp82_1 + tmp83_1 + tmp84_1 + tmp85_1;  
                                 EM_S[INDEX2(0,5,8)]+=tmp290_1 + tmp291_1 + tmp294_1 + tmp295_1 + tmp297_1 + tmp299_1 + tmp384_1 + tmp385_1 + tmp386_1 + tmp387_1;  
                                 EM_S[INDEX2(1,5,8)]+=tmp102_1 + tmp103_1 + tmp106_1 + tmp107_1 + tmp110_1 + tmp113_1 + tmp114_1 + tmp115_1 + tmp228_1 + tmp229_1 + tmp230_1 + tmp231_1 + tmp86_1 + tmp96_1;  
                                 EM_S[INDEX2(2,5,8)]+=tmp122_1 + tmp123_1 + tmp76_1 + tmp77_1 + tmp80_1 + tmp81_1;  
                                 EM_S[INDEX2(3,5,8)]+=tmp280_1 + tmp281_1 + tmp358_1 + tmp359_1 + tmp360_1 + tmp361_1 + tmp426_1 + tmp427_1 + tmp428_1 + tmp429_1;  
                                 EM_S[INDEX2(4,5,8)]+=tmp362_1 + tmp363_1 + tmp364_1 + tmp365_1 + tmp366_1 + tmp367_1 + tmp65_1 + tmp66_1 + tmp67_1 + tmp68_1 + tmp69_1 + tmp71_1 + tmp72_1 + tmp75_1;  
                                 EM_S[INDEX2(5,5,8)]+=tmp168_1 + tmp170_1 + tmp330_1 + tmp335_1 + tmp345_1 + tmp352_1 + tmp372_1 + tmp373_1 + tmp374_1 + tmp375_1 + tmp376_1 + tmp377_1 + tmp378_1 + tmp379_1 + tmp380_1 + tmp381_1 + tmp382_1 + tmp383_1;  
                                 EM_S[INDEX2(6,5,8)]+=tmp14_1 + tmp15_1 + tmp16_1 + tmp19_1 + tmp20_1 + tmp23_1 + tmp422_1 + tmp423_1 + tmp424_1 + tmp425_1;  
                                 EM_S[INDEX2(7,5,8)]+=tmp195_1 + tmp198_1 + tmp266_1 + tmp268_1 + tmp269_1 + tmp271_1 + tmp274_1 + tmp275_1 + tmp278_1 + tmp279_1 + tmp398_1 + tmp399_1 + tmp400_1 + tmp401_1;  
                                 EM_S[INDEX2(0,6,8)]+=tmp388_1 + tmp389_1 + tmp406_1 + tmp407_1 + tmp408_1 + tmp409_1 + tmp448_1 + tmp449_1 + tmp450_1 + tmp451_1;  
                                 EM_S[INDEX2(1,6,8)]+=tmp100_1 + tmp101_1 + tmp78_1 + tmp79_1 + tmp80_1 + tmp81_1;  
                                 EM_S[INDEX2(2,6,8)]+=tmp86_1 + tmp87_1 + tmp88_1 + tmp89_1 + tmp90_1 + tmp91_1 + tmp92_1 + tmp93_1 + tmp94_1 + tmp95_1 + tmp96_1 + tmp97_1 + tmp98_1 + tmp99_1;  
                                 EM_S[INDEX2(3,6,8)]+=tmp132_1 + tmp133_1 + tmp137_1 + tmp138_1 + tmp139_1 + tmp140_1 + tmp232_1 + tmp233_1 + tmp234_1 + tmp235_1;  
                                 EM_S[INDEX2(4,6,8)]+=tmp27_1 + tmp28_1 + tmp38_1 + tmp39_1 + tmp40_1 + tmp41_1 + tmp436_1 + tmp437_1 + tmp438_1 + tmp439_1 + tmp43_1 + tmp44_1 + tmp50_1 + tmp51_1;  
                                 EM_S[INDEX2(5,6,8)]+=tmp17_1 + tmp18_1 + tmp19_1 + tmp21_1 + tmp22_1 + tmp23_1 + tmp82_1 + tmp83_1 + tmp84_1 + tmp85_1;  
                                 EM_S[INDEX2(6,6,8)]+=tmp179_1 + tmp184_1 + tmp325_1 + tmp326_1 + tmp340_1 + tmp341_1 + tmp342_1 + tmp343_1 + tmp344_1 + tmp345_1 + tmp346_1 + tmp347_1 + tmp348_1 + tmp349_1 + tmp350_1 + tmp351_1 + tmp352_1 + tmp353_1;  
                                 EM_S[INDEX2(7,6,8)]+=tmp157_1 + tmp158_1 + tmp159_1 + tmp161_1 + tmp162_1 + tmp164_1 + tmp166_1 + tmp167_1 + tmp200_1 + tmp201_1 + tmp202_1 + tmp203_1 + tmp204_1 + tmp205_1;  
                                 EM_S[INDEX2(0,7,8)]+=tmp76_1 + tmp77_1 + tmp78_1 + tmp79_1 + tmp80_1 + tmp81_1;  
                                 EM_S[INDEX2(1,7,8)]+=tmp280_1 + tmp281_1 + tmp284_1 + tmp285_1 + tmp287_1 + tmp288_1 + tmp426_1 + tmp427_1 + tmp428_1 + tmp429_1;  
                                 EM_S[INDEX2(2,7,8)]+=tmp138_1 + tmp140_1 + tmp224_1 + tmp225_1 + tmp226_1 + tmp227_1 + tmp232_1 + tmp233_1 + tmp234_1 + tmp235_1;  
                                 EM_S[INDEX2(3,7,8)]+=tmp0_1 + tmp10_1 + tmp116_1 + tmp117_1 + tmp118_1 + tmp119_1 + tmp11_1 + tmp120_1 + tmp121_1 + tmp12_1 + tmp1_1 + tmp4_1 + tmp7_1 + tmp8_1;  
                                 EM_S[INDEX2(4,7,8)]+=tmp14_1 + tmp15_1 + tmp16_1 + tmp17_1 + tmp18_1 + tmp19_1 + tmp20_1 + tmp21_1 + tmp22_1 + tmp23_1;  
                                 EM_S[INDEX2(5,7,8)]+=tmp266_1 + tmp267_1 + tmp268_1 + tmp269_1 + tmp270_1 + tmp271_1 + tmp272_1 + tmp273_1 + tmp274_1 + tmp275_1 + tmp276_1 + tmp277_1 + tmp278_1 + tmp279_1;  
                                 EM_S[INDEX2(6,7,8)]+=tmp154_1 + tmp155_1 + tmp156_1 + tmp157_1 + tmp158_1 + tmp159_1 + tmp160_1 + tmp161_1 + tmp162_1 + tmp163_1 + tmp164_1 + tmp165_1 + tmp166_1 + tmp167_1;  
                                 EM_S[INDEX2(7,7,8)]+=tmp215_1 + tmp222_1 + tmp247_1 + tmp250_1 + tmp252_1 + tmp253_1 + tmp254_1 + tmp255_1 + tmp256_1 + tmp257_1 + tmp258_1 + tmp259_1 + tmp260_1 + tmp261_1 + tmp262_1 + tmp263_1 + tmp264_1 + tmp265_1;  
                             } else { // constant data  
                                 const double B_0 = B_p[0];  
                                 const double B_1 = B_p[1];  
                                 const double B_2 = B_p[2];  
                                 const double tmp7_1 = B_2*w133;  
                                 const double tmp17_1 = B_0*w143;  
                                 const double tmp1_1 = B_1*w127;  
                                 const double tmp8_1 = B_2*w135;  
                                 const double tmp15_1 = B_0*w141;  
                                 const double tmp3_1 = B_0*w129;  
                                 const double tmp13_1 = B_1*w139;  
                                 const double tmp2_1 = B_0*w126;  
                                 const double tmp12_1 = B_0*w138;  
                                 const double tmp5_1 = B_2*w131;  
                                 const double tmp10_1 = B_2*w136;  
                                 const double tmp4_1 = B_1*w130;  
                                 const double tmp6_1 = B_1*w132;  
                                 const double tmp9_1 = B_1*w134;  
                                 const double tmp14_1 = B_2*w140;  
                                 const double tmp0_1 = B_2*w128;  
                                 const double tmp16_1 = B_1*w142;  
                                 const double tmp11_1 = B_0*w137;  
                                 EM_S[INDEX2(0,0,8)]+=tmp14_1 + tmp17_1 + tmp6_1;  
                                 EM_S[INDEX2(1,0,8)]+=tmp11_1 + tmp4_1 + tmp7_1;  
                                 EM_S[INDEX2(2,0,8)]+=tmp3_1 + tmp7_1 + tmp9_1;  
                                 EM_S[INDEX2(3,0,8)]+=tmp10_1 + tmp1_1 + tmp2_1;  
                                 EM_S[INDEX2(4,0,8)]+=tmp0_1 + tmp3_1 + tmp4_1;  
                                 EM_S[INDEX2(5,0,8)]+=tmp13_1 + tmp2_1 + tmp8_1;  
                                 EM_S[INDEX2(6,0,8)]+=tmp12_1 + tmp1_1 + tmp8_1;  
                                 EM_S[INDEX2(7,0,8)]+=tmp15_1 + tmp16_1 + tmp5_1;  
                                 EM_S[INDEX2(0,1,8)]+=tmp17_1 + tmp4_1 + tmp7_1;  
                                 EM_S[INDEX2(1,1,8)]+=tmp11_1 + tmp14_1 + tmp6_1;  
                                 EM_S[INDEX2(2,1,8)]+=tmp10_1 + tmp1_1 + tmp3_1;  
                                 EM_S[INDEX2(3,1,8)]+=tmp2_1 + tmp7_1 + tmp9_1;  
                                 EM_S[INDEX2(4,1,8)]+=tmp13_1 + tmp3_1 + tmp8_1;  
                                 EM_S[INDEX2(5,1,8)]+=tmp0_1 + tmp2_1 + tmp4_1;  
                                 EM_S[INDEX2(6,1,8)]+=tmp12_1 + tmp16_1 + tmp5_1;  
                                 EM_S[INDEX2(7,1,8)]+=tmp15_1 + tmp1_1 + tmp8_1;  
                                 EM_S[INDEX2(0,2,8)]+=tmp3_1 + tmp6_1 + tmp7_1;  
                                 EM_S[INDEX2(1,2,8)]+=tmp10_1 + tmp2_1 + tmp4_1;  
                                 EM_S[INDEX2(2,2,8)]+=tmp14_1 + tmp17_1 + tmp9_1;  
                                 EM_S[INDEX2(3,2,8)]+=tmp11_1 + tmp1_1 + tmp7_1;  
                                 EM_S[INDEX2(4,2,8)]+=tmp12_1 + tmp4_1 + tmp8_1;  
                                 EM_S[INDEX2(5,2,8)]+=tmp13_1 + tmp15_1 + tmp5_1;  
                                 EM_S[INDEX2(6,2,8)]+=tmp0_1 + tmp1_1 + tmp3_1;  
                                 EM_S[INDEX2(7,2,8)]+=tmp16_1 + tmp2_1 + tmp8_1;  
                                 EM_S[INDEX2(0,3,8)]+=tmp10_1 + tmp3_1 + tmp4_1;