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

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

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

branches/ripleygmg_from_3668/ripley/src/Brick.cpp revision 3702 by caltinay, Fri Dec 2 06:12:32 2011 UTC trunk/ripley/src/Brick.cpp revision 3913 by caltinay, Tue Jun 19 06:21:58 2012 UTC
# Line 1  Line 1 
1    
2  /*******************************************************  /*******************************************************
3  *  *
4  * Copyright (c) 2003-2011 by University of Queensland  * Copyright (c) 2003-2012 by University of Queensland
5  * Earth Systems Science Computational Center (ESSCC)  * Earth Systems Science Computational Center (ESSCC)
6  * http://www.uq.edu.au/esscc  * http://www.uq.edu.au/esscc
7  *  *
# Line 13  Line 13 
13    
14  #include <ripley/Brick.h>  #include <ripley/Brick.h>
15  extern "C" {  extern "C" {
16  #include "paso/SystemMatrixPattern.h"  #include <paso/SystemMatrix.h>
17  }  }
18    
19  #if USE_SILO  #if USE_SILO
# Line 29  using namespace std; Line 29  using namespace std;
29    
30  namespace ripley {  namespace ripley {
31    
32  Brick::Brick(int n0, int n1, int n2, double l0, double l1, double l2, int d0,  Brick::Brick(int n0, int n1, int n2, double x0, double y0, double z0,
33               int d1, int d2) :               double x1, double y1, double z1, int d0, int d1, int d2) :
34      RipleyDomain(3),      RipleyDomain(3),
35      m_gNE0(n0),      m_gNE0(n0),
36      m_gNE1(n1),      m_gNE1(n1),
37      m_gNE2(n2),      m_gNE2(n2),
38      m_l0(l0),      m_x0(x0),
39      m_l1(l1),      m_y0(y0),
40      m_l2(l2),      m_z0(z0),
41        m_l0(x1-x0),
42        m_l1(y1-y0),
43        m_l2(z1-z0),
44      m_NX(d0),      m_NX(d0),
45      m_NY(d1),      m_NY(d1),
46      m_NZ(d2)      m_NZ(d2)
# Line 47  Brick::Brick(int n0, int n1, int n2, dou Line 50  Brick::Brick(int n0, int n1, int n2, dou
50      if (m_NX*m_NY*m_NZ != m_mpiInfo->size)      if (m_NX*m_NY*m_NZ != m_mpiInfo->size)
51          throw RipleyException("Invalid number of spatial subdivisions");          throw RipleyException("Invalid number of spatial subdivisions");
52    
53      if (n0%m_NX > 0 || n1%m_NY > 0 || n2%m_NZ > 0)      if ((n0+1)%m_NX > 0 || (n1+1)%m_NY > 0 || (n2+1)%m_NZ > 0)
54          throw RipleyException("Number of elements must be separable into number of ranks in each dimension");          throw RipleyException("Number of elements+1 must be separable into number of ranks in each dimension");
55    
56      // local number of elements      if ((m_NX > 1 && (n0+1)/m_NX<2) || (m_NY > 1 && (n1+1)/m_NY<2) || (m_NZ > 1 && (n2+1)/m_NZ<2))
57      m_NE0 = n0/m_NX;          throw RipleyException("Too few elements for the number of ranks");
58      m_NE1 = n1/m_NY;  
59      m_NE2 = n2/m_NZ;      // local number of elements (including overlap)
60      // local number of nodes (not necessarily owned)      m_NE0 = m_ownNE0 = (m_NX>1 ? (n0+1)/m_NX : n0);
61        if (m_mpiInfo->rank%m_NX>0 && m_mpiInfo->rank%m_NX<m_NX-1)
62            m_NE0++;
63        else if (m_NX>1 && m_mpiInfo->rank%m_NX==m_NX-1)
64            m_ownNE0--;
65    
66        m_NE1 = m_ownNE1 = (m_NY>1 ? (n1+1)/m_NY : n1);
67        if (m_mpiInfo->rank%(m_NX*m_NY)/m_NX>0 && m_mpiInfo->rank%(m_NX*m_NY)/m_NX<m_NY-1)
68            m_NE1++;
69        else if (m_NY>1 && m_mpiInfo->rank%(m_NX*m_NY)/m_NX==m_NY-1)
70            m_ownNE1--;
71    
72        m_NE2 = m_ownNE2 = (m_NZ>1 ? (n2+1)/m_NZ : n2);
73        if (m_mpiInfo->rank/(m_NX*m_NY)>0 && m_mpiInfo->rank/(m_NX*m_NY)<m_NZ-1)
74            m_NE2++;
75        else if (m_NZ>1 && m_mpiInfo->rank/(m_NX*m_NY)==m_NZ-1)
76            m_ownNE2--;
77    
78        // local number of nodes
79      m_N0 = m_NE0+1;      m_N0 = m_NE0+1;
80      m_N1 = m_NE1+1;      m_N1 = m_NE1+1;
81      m_N2 = m_NE2+1;      m_N2 = m_NE2+1;
82    
83      // bottom-left-front node is at (offset0,offset1,offset2) in global mesh      // bottom-left-front node is at (offset0,offset1,offset2) in global mesh
84      m_offset0 = m_NE0*(m_mpiInfo->rank%m_NX);      m_offset0 = (n0+1)/m_NX*(m_mpiInfo->rank%m_NX);
85      m_offset1 = m_NE1*(m_mpiInfo->rank%(m_NX*m_NY)/m_NX);      if (m_offset0 > 0)
86      m_offset2 = m_NE2*(m_mpiInfo->rank/(m_NX*m_NY));          m_offset0--;
87        m_offset1 = (n1+1)/m_NY*(m_mpiInfo->rank%(m_NX*m_NY)/m_NX);
88        if (m_offset1 > 0)
89            m_offset1--;
90        m_offset2 = (n2+1)/m_NZ*(m_mpiInfo->rank/(m_NX*m_NY));
91        if (m_offset2 > 0)
92            m_offset2--;
93    
94      populateSampleIds();      populateSampleIds();
95        createPattern();
96  }  }
97    
98    
99  Brick::~Brick()  Brick::~Brick()
100  {  {
101        Paso_SystemMatrixPattern_free(m_pattern);
102        Paso_Connector_free(m_connector);
103  }  }
104    
105  string Brick::getDescription() const  string Brick::getDescription() const
# Line 77  string Brick::getDescription() const Line 109  string Brick::getDescription() const
109    
110  bool Brick::operator==(const AbstractDomain& other) const  bool Brick::operator==(const AbstractDomain& other) const
111  {  {
112      if (dynamic_cast<const Brick*>(&other))      const Brick* o=dynamic_cast<const Brick*>(&other);
113          return this==&other;      if (o) {
114            return (RipleyDomain::operator==(other) &&
115                    m_gNE0==o->m_gNE0 && m_gNE1==o->m_gNE1 && m_gNE2==o->m_gNE2
116                    && m_x0==o->m_x0 && m_y0==o->m_y0 && m_z0==o->m_z0
117                    && m_l0==o->m_l0 && m_l1==o->m_l1 && m_l2==o->m_l2
118                    && m_NX==o->m_NX && m_NY==o->m_NY && m_NZ==o->m_NZ);
119        }
120    
121      return false;      return false;
122  }  }
# Line 91  void Brick::dump(const string& fileName) Line 129  void Brick::dump(const string& fileName)
129          fn+=".silo";          fn+=".silo";
130      }      }
131    
     const int NUM_SILO_FILES = 1;  
     const char* blockDirFmt = "/block%04d";  
132      int driver=DB_HDF5;          int driver=DB_HDF5;    
133      string siloPath;      string siloPath;
134      DBfile* dbfile = NULL;      DBfile* dbfile = NULL;
135    
136  #ifdef ESYS_MPI  #ifdef ESYS_MPI
137      PMPIO_baton_t* baton = NULL;      PMPIO_baton_t* baton = NULL;
138        const int NUM_SILO_FILES = 1;
139        const char* blockDirFmt = "/block%04d";
140  #endif  #endif
141    
142      if (m_mpiInfo->size > 1) {      if (m_mpiInfo->size > 1) {
# Line 224  void Brick::dump(const string& fileName) Line 262  void Brick::dump(const string& fileName)
262      }      }
263    
264  #else // USE_SILO  #else // USE_SILO
265      throw RipleyException("dump(): no Silo support");      throw RipleyException("dump: no Silo support");
266  #endif  #endif
267  }  }
268    
# Line 232  const int* Brick::borrowSampleReferenceI Line 270  const int* Brick::borrowSampleReferenceI
270  {  {
271      switch (fsType) {      switch (fsType) {
272          case Nodes:          case Nodes:
273            case ReducedNodes: //FIXME: reduced
274              return &m_nodeId[0];              return &m_nodeId[0];
275            case DegreesOfFreedom:
276            case ReducedDegreesOfFreedom: //FIXME: reduced
277                return &m_dofId[0];
278          case Elements:          case Elements:
279            case ReducedElements:
280              return &m_elementId[0];              return &m_elementId[0];
281          case FaceElements:          case FaceElements:
282            case ReducedFaceElements:
283              return &m_faceId[0];              return &m_faceId[0];
284          default:          default:
285              break;              break;
286      }      }
287    
288      stringstream msg;      stringstream msg;
289      msg << "borrowSampleReferenceIDs() not implemented for function space type "      msg << "borrowSampleReferenceIDs: invalid function space type "<<fsType;
         << fsType;  
290      throw RipleyException(msg.str());      throw RipleyException(msg.str());
291  }  }
292    
293  bool Brick::ownSample(int fsCode, index_t id) const  bool Brick::ownSample(int fsType, index_t id) const
294  {  {
295  #ifdef ESYS_MPI      if (getMPISize()==1)
296      if (fsCode == Nodes) {          return true;
297          const index_t myFirst=m_nodeDistribution[m_mpiInfo->rank];  
298          const index_t myLast=m_nodeDistribution[m_mpiInfo->rank+1]-1;      switch (fsType) {
299          return (m_nodeId[id]>=myFirst && m_nodeId[id]<=myLast);          case Nodes:
300      } else          case ReducedNodes: //FIXME: reduced
301          throw RipleyException("ownSample() only implemented for Nodes");              return (m_dofMap[id] < getNumDOF());
302  #else          case DegreesOfFreedom:
303      return true;          case ReducedDegreesOfFreedom:
304  #endif              return true;
305            case Elements:
306            case ReducedElements:
307                {
308                    // check ownership of element's _last_ node
309                    const index_t x=id%m_NE0 + 1;
310                    const index_t y=id%(m_NE0*m_NE1)/m_NE0 + 1;
311                    const index_t z=id/(m_NE0*m_NE1) + 1;
312                    return (m_dofMap[x + m_N0*y +m_N0*m_N1*z] < getNumDOF());
313                }
314            case FaceElements:
315            case ReducedFaceElements:
316                {
317                    // check ownership of face element's last node
318                    const IndexVector faces = getNumFacesPerBoundary();
319                    dim_t n=0;
320                    for (size_t i=0; i<faces.size(); i++) {
321                        n+=faces[i];
322                        if (id<n) {
323                            const index_t j=id-n+faces[i];
324                            if (i>=4) { // front or back
325                                const index_t first=(i==4 ? 0 : m_N0*m_N1*(m_N2-1));
326                                return (m_dofMap[first+j%m_NE0+1+(j/m_NE0+1)*m_N0] < getNumDOF());
327                            } else if (i>=2) { // bottom or top
328                                const index_t first=(i==2 ? 0 : m_N0*(m_N1-1));
329                                return (m_dofMap[first+j%m_NE0+1+(j/m_NE0+1)*m_N0*m_N1] < getNumDOF());
330                            } else { // left or right
331                                const index_t first=(i==0 ? 0 : m_N0-1);
332                                return (m_dofMap[first+(j%m_NE1+1)*m_N0+(j/m_NE1+1)*m_N0*m_N1] < getNumDOF());
333                            }
334                        }
335                    }
336                    return false;
337                }
338            default:
339                break;
340        }
341    
342        stringstream msg;
343        msg << "ownSample: invalid function space type " << fsType;
344        throw RipleyException(msg.str());
345    }
346    
347    void Brick::setToNormal(escript::Data& out) const
348    {
349        if (out.getFunctionSpace().getTypeCode() == FaceElements) {
350            out.requireWrite();
351    #pragma omp parallel
352            {
353                if (m_faceOffset[0] > -1) {
354    #pragma omp for nowait
355                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
356                        for (index_t k1 = 0; k1 < m_NE1; ++k1) {
357                            double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));
358                            // set vector at four quadrature points
359                            *o++ = -1.; *o++ = 0.; *o++ = 0.;
360                            *o++ = -1.; *o++ = 0.; *o++ = 0.;
361                            *o++ = -1.; *o++ = 0.; *o++ = 0.;
362                            *o++ = -1.; *o++ = 0.; *o = 0.;
363                        }
364                    }
365                }
366    
367                if (m_faceOffset[1] > -1) {
368    #pragma omp for nowait
369                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
370                        for (index_t k1 = 0; k1 < m_NE1; ++k1) {
371                            double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));
372                            // set vector at four quadrature points
373                            *o++ = 1.; *o++ = 0.; *o++ = 0.;
374                            *o++ = 1.; *o++ = 0.; *o++ = 0.;
375                            *o++ = 1.; *o++ = 0.; *o++ = 0.;
376                            *o++ = 1.; *o++ = 0.; *o = 0.;
377                        }
378                    }
379                }
380    
381                if (m_faceOffset[2] > -1) {
382    #pragma omp for nowait
383                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
384                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
385                            double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));
386                            // set vector at four quadrature points
387                            *o++ = 0.; *o++ = -1.; *o++ = 0.;
388                            *o++ = 0.; *o++ = -1.; *o++ = 0.;
389                            *o++ = 0.; *o++ = -1.; *o++ = 0.;
390                            *o++ = 0.; *o++ = -1.; *o = 0.;
391                        }
392                    }
393                }
394    
395                if (m_faceOffset[3] > -1) {
396    #pragma omp for nowait
397                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
398                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
399                            double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));
400                            // set vector at four quadrature points
401                            *o++ = 0.; *o++ = 1.; *o++ = 0.;
402                            *o++ = 0.; *o++ = 1.; *o++ = 0.;
403                            *o++ = 0.; *o++ = 1.; *o++ = 0.;
404                            *o++ = 0.; *o++ = 1.; *o = 0.;
405                        }
406                    }
407                }
408    
409                if (m_faceOffset[4] > -1) {
410    #pragma omp for nowait
411                    for (index_t k1 = 0; k1 < m_NE1; ++k1) {
412                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
413                            double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));
414                            // set vector at four quadrature points
415                            *o++ = 0.; *o++ = 0.; *o++ = -1.;
416                            *o++ = 0.; *o++ = 0.; *o++ = -1.;
417                            *o++ = 0.; *o++ = 0.; *o++ = -1.;
418                            *o++ = 0.; *o++ = 0.; *o = -1.;
419                        }
420                    }
421                }
422    
423                if (m_faceOffset[5] > -1) {
424    #pragma omp for nowait
425                    for (index_t k1 = 0; k1 < m_NE1; ++k1) {
426                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
427                            double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));
428                            // set vector at four quadrature points
429                            *o++ = 0.; *o++ = 0.; *o++ = 1.;
430                            *o++ = 0.; *o++ = 0.; *o++ = 1.;
431                            *o++ = 0.; *o++ = 0.; *o++ = 1.;
432                            *o++ = 0.; *o++ = 0.; *o = 1.;
433                        }
434                    }
435                }
436            } // end of parallel section
437        } else if (out.getFunctionSpace().getTypeCode() == ReducedFaceElements) {
438            out.requireWrite();
439    #pragma omp parallel
440            {
441                if (m_faceOffset[0] > -1) {
442    #pragma omp for nowait
443                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
444                        for (index_t k1 = 0; k1 < m_NE1; ++k1) {
445                            double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));
446                            *o++ = -1.;
447                            *o++ = 0.;
448                            *o = 0.;
449                        }
450                    }
451                }
452    
453                if (m_faceOffset[1] > -1) {
454    #pragma omp for nowait
455                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
456                        for (index_t k1 = 0; k1 < m_NE1; ++k1) {
457                            double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));
458                            *o++ = 1.;
459                            *o++ = 0.;
460                            *o = 0.;
461                        }
462                    }
463                }
464    
465                if (m_faceOffset[2] > -1) {
466    #pragma omp for nowait
467                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
468                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
469                            double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));
470                            *o++ = 0.;
471                            *o++ = -1.;
472                            *o = 0.;
473                        }
474                    }
475                }
476    
477                if (m_faceOffset[3] > -1) {
478    #pragma omp for nowait
479                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
480                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
481                            double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));
482                            *o++ = 0.;
483                            *o++ = 1.;
484                            *o = 0.;
485                        }
486                    }
487                }
488    
489                if (m_faceOffset[4] > -1) {
490    #pragma omp for nowait
491                    for (index_t k1 = 0; k1 < m_NE1; ++k1) {
492                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
493                            double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));
494                            *o++ = 0.;
495                            *o++ = 0.;
496                            *o = -1.;
497                        }
498                    }
499                }
500    
501                if (m_faceOffset[5] > -1) {
502    #pragma omp for nowait
503                    for (index_t k1 = 0; k1 < m_NE1; ++k1) {
504                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
505                            double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));
506                            *o++ = 0.;
507                            *o++ = 0.;
508                            *o = 1.;
509                        }
510                    }
511                }
512            } // end of parallel section
513    
514        } else {
515            stringstream msg;
516            msg << "setToNormal: invalid function space type "
517                << out.getFunctionSpace().getTypeCode();
518            throw RipleyException(msg.str());
519        }
520    }
521    
522    void Brick::setToSize(escript::Data& out) const
523    {
524        if (out.getFunctionSpace().getTypeCode() == Elements
525                || out.getFunctionSpace().getTypeCode() == ReducedElements) {
526            out.requireWrite();
527            const dim_t numQuad=out.getNumDataPointsPerSample();
528            const double xSize=getFirstCoordAndSpacing(0).second;
529            const double ySize=getFirstCoordAndSpacing(1).second;
530            const double zSize=getFirstCoordAndSpacing(2).second;
531            const double size=sqrt(xSize*xSize+ySize*ySize+zSize*zSize);
532    #pragma omp parallel for
533            for (index_t k = 0; k < getNumElements(); ++k) {
534                double* o = out.getSampleDataRW(k);
535                fill(o, o+numQuad, size);
536            }
537        } else if (out.getFunctionSpace().getTypeCode() == FaceElements
538                || out.getFunctionSpace().getTypeCode() == ReducedFaceElements) {
539            out.requireWrite();
540            const dim_t numQuad=out.getNumDataPointsPerSample();
541            const double xSize=getFirstCoordAndSpacing(0).second;
542            const double ySize=getFirstCoordAndSpacing(1).second;
543            const double zSize=getFirstCoordAndSpacing(2).second;
544    #pragma omp parallel
545            {
546                if (m_faceOffset[0] > -1) {
547                    const double size=min(ySize,zSize);
548    #pragma omp for nowait
549                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
550                        for (index_t k1 = 0; k1 < m_NE1; ++k1) {
551                            double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));
552                            fill(o, o+numQuad, size);
553                        }
554                    }
555                }
556    
557                if (m_faceOffset[1] > -1) {
558                    const double size=min(ySize,zSize);
559    #pragma omp for nowait
560                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
561                        for (index_t k1 = 0; k1 < m_NE1; ++k1) {
562                            double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));
563                            fill(o, o+numQuad, size);
564                        }
565                    }
566                }
567    
568                if (m_faceOffset[2] > -1) {
569                    const double size=min(xSize,zSize);
570    #pragma omp for nowait
571                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
572                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
573                            double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));
574                            fill(o, o+numQuad, size);
575                        }
576                    }
577                }
578    
579                if (m_faceOffset[3] > -1) {
580                    const double size=min(xSize,zSize);
581    #pragma omp for nowait
582                    for (index_t k2 = 0; k2 < m_NE2; ++k2) {
583                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
584                            double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));
585                            fill(o, o+numQuad, size);
586                        }
587                    }
588                }
589    
590                if (m_faceOffset[4] > -1) {
591                    const double size=min(xSize,ySize);
592    #pragma omp for nowait
593                    for (index_t k1 = 0; k1 < m_NE1; ++k1) {
594                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
595                            double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));
596                            fill(o, o+numQuad, size);
597                        }
598                    }
599                }
600    
601                if (m_faceOffset[5] > -1) {
602                    const double size=min(xSize,ySize);
603    #pragma omp for nowait
604                    for (index_t k1 = 0; k1 < m_NE1; ++k1) {
605                        for (index_t k0 = 0; k0 < m_NE0; ++k0) {
606                            double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));
607                            fill(o, o+numQuad, size);
608                        }
609                    }
610                }
611            } // end of parallel section
612    
613        } else {
614            stringstream msg;
615            msg << "setToSize: invalid function space type "
616                << out.getFunctionSpace().getTypeCode();
617            throw RipleyException(msg.str());
618        }
619  }  }
620    
621  Paso_SystemMatrixPattern* Brick::getPattern(bool reducedRowOrder,  Paso_SystemMatrixPattern* Brick::getPattern(bool reducedRowOrder,
622                                              bool reducedColOrder) const                                              bool reducedColOrder) const
623  {  {
624        /* FIXME: reduced
625      if (reducedRowOrder || reducedColOrder)      if (reducedRowOrder || reducedColOrder)
626          throw RipleyException("getPattern() not implemented for reduced order");          throw RipleyException("getPattern() not implemented for reduced order");
627        */
628      throw RipleyException("getPattern() not implemented");      return m_pattern;
629  }  }
630    
631  void Brick::Print_Mesh_Info(const bool full) const  void Brick::Print_Mesh_Info(const bool full) const
# Line 331  IndexVector Brick::getNumFacesPerBoundar Line 689  IndexVector Brick::getNumFacesPerBoundar
689      return ret;      return ret;
690  }  }
691    
692    IndexVector Brick::getNumSubdivisionsPerDim() const
693    {
694        IndexVector ret;
695        ret.push_back(m_NX);
696        ret.push_back(m_NY);
697        ret.push_back(m_NZ);
698        return ret;
699    }
700    
701  pair<double,double> Brick::getFirstCoordAndSpacing(dim_t dim) const  pair<double,double> Brick::getFirstCoordAndSpacing(dim_t dim) const
702  {  {
703      if (dim==0)      if (dim==0)
704          return pair<double,double>((m_l0*m_offset0)/m_gNE0, m_l0/m_gNE0);          return pair<double,double>(m_x0+(m_l0*m_offset0)/m_gNE0, m_l0/m_gNE0);
705      else if (dim==1)      else if (dim==1)
706          return pair<double,double>((m_l1*m_offset1)/m_gNE1, m_l1/m_gNE1);          return pair<double,double>(m_y0+(m_l1*m_offset1)/m_gNE1, m_l1/m_gNE1);
707      else if (dim==2)      else if (dim==2)
708          return pair<double,double>((m_l2*m_offset2)/m_gNE2, m_l2/m_gNE2);          return pair<double,double>(m_z0+(m_l2*m_offset2)/m_gNE2, m_l2/m_gNE2);
709    
710      throw RipleyException("getFirstCoordAndSpacing(): invalid argument");      throw RipleyException("getFirstCoordAndSpacing: invalid argument");
711  }  }
712    
713    //protected
714    dim_t Brick::getNumDOF() const
715    {
716        return (m_gNE0+1)/m_NX*(m_gNE1+1)/m_NY*(m_gNE2+1)/m_NZ;
717    }
718    
719  //protected  //protected
720  dim_t Brick::getNumFaceElements() const  dim_t Brick::getNumFaceElements() const
721  {  {
722        const IndexVector faces = getNumFacesPerBoundary();
723      dim_t n=0;      dim_t n=0;
724      //left      for (size_t i=0; i<faces.size(); i++)
725      if (m_offset0==0)          n+=faces[i];
         n+=m_NE1*m_NE2;  
     //right  
     if (m_mpiInfo->rank%m_NX==m_NX-1)  
         n+=m_NE1*m_NE2;  
     //bottom  
     if (m_offset1==0)  
         n+=m_NE0*m_NE2;  
     //top  
     if (m_mpiInfo->rank%(m_NX*m_NY)/m_NX==m_NY-1)  
         n+=m_NE0*m_NE2;  
     //front  
     if (m_offset2==0)  
         n+=m_NE0*m_NE1;  
     //back  
     if (m_mpiInfo->rank/(m_NX*m_NY)==m_NZ-1)  
         n+=m_NE0*m_NE1;  
   
726      return n;      return n;
727  }  }
728    
# Line 397  void Brick::assembleCoordinates(escript: Line 753  void Brick::assembleCoordinates(escript:
753      }      }
754  }  }
755    
756    //protected
757    void Brick::assembleGradient(escript::Data& out, escript::Data& in) const
758    {
759        const dim_t numComp = in.getDataPointSize();
760        const double h0 = m_l0/m_gNE0;
761        const double h1 = m_l1/m_gNE1;
762        const double h2 = m_l2/m_gNE2;
763        const double C0 = .044658198738520451079;
764        const double C1 = .16666666666666666667;
765        const double C2 = .21132486540518711775;
766        const double C3 = .25;
767        const double C4 = .5;
768        const double C5 = .62200846792814621559;
769        const double C6 = .78867513459481288225;
770    
771        if (out.getFunctionSpace().getTypeCode() == Elements) {
772            out.requireWrite();
773    #pragma omp parallel
774            {
775                vector<double> f_000(numComp);
776                vector<double> f_001(numComp);
777                vector<double> f_010(numComp);
778                vector<double> f_011(numComp);
779                vector<double> f_100(numComp);
780                vector<double> f_101(numComp);
781                vector<double> f_110(numComp);
782                vector<double> f_111(numComp);
783    #pragma omp for
784                for (index_t k2=0; k2 < m_NE2; ++k2) {
785                    for (index_t k1=0; k1 < m_NE1; ++k1) {
786                        for (index_t k0=0; k0 < m_NE0; ++k0) {
787                            memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
788                            memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
789                            memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
790                            memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
791                            memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
792                            memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
793                            memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
794                            memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
795                            double* o = out.getSampleDataRW(INDEX3(k0,k1,k2,m_NE0,m_NE1));
796                            for (index_t i=0; i < numComp; ++i) {
797                                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;
798                                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;
799                                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;
800                                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;
801                                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;
802                                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;
803                                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;
804                                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;
805                                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;
806                                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;
807                                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;
808                                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;
809                                o[INDEX3(i,0,0,numComp,3)] = V0;
810                                o[INDEX3(i,1,0,numComp,3)] = V4;
811                                o[INDEX3(i,2,0,numComp,3)] = V8;
812                                o[INDEX3(i,0,1,numComp,3)] = V0;
813                                o[INDEX3(i,1,1,numComp,3)] = V5;
814                                o[INDEX3(i,2,1,numComp,3)] = V9;
815                                o[INDEX3(i,0,2,numComp,3)] = V1;
816                                o[INDEX3(i,1,2,numComp,3)] = V4;
817                                o[INDEX3(i,2,2,numComp,3)] = V10;
818                                o[INDEX3(i,0,3,numComp,3)] = V1;
819                                o[INDEX3(i,1,3,numComp,3)] = V5;
820                                o[INDEX3(i,2,3,numComp,3)] = V11;
821                                o[INDEX3(i,0,4,numComp,3)] = V2;
822                                o[INDEX3(i,1,4,numComp,3)] = V6;
823                                o[INDEX3(i,2,4,numComp,3)] = V8;
824                                o[INDEX3(i,0,5,numComp,3)] = V2;
825                                o[INDEX3(i,1,5,numComp,3)] = V7;
826                                o[INDEX3(i,2,5,numComp,3)] = V9;
827                                o[INDEX3(i,0,6,numComp,3)] = V3;
828                                o[INDEX3(i,1,6,numComp,3)] = V6;
829                                o[INDEX3(i,2,6,numComp,3)] = V10;
830                                o[INDEX3(i,0,7,numComp,3)] = V3;
831                                o[INDEX3(i,1,7,numComp,3)] = V7;
832                                o[INDEX3(i,2,7,numComp,3)] = V11;
833                            } // end of component loop i
834                        } // end of k0 loop
835                    } // end of k1 loop
836                } // end of k2 loop
837            } // end of parallel section
838        } else if (out.getFunctionSpace().getTypeCode() == ReducedElements) {
839            out.requireWrite();
840    #pragma omp parallel
841            {
842                vector<double> f_000(numComp);
843                vector<double> f_001(numComp);
844                vector<double> f_010(numComp);
845                vector<double> f_011(numComp);
846                vector<double> f_100(numComp);
847                vector<double> f_101(numComp);
848                vector<double> f_110(numComp);
849                vector<double> f_111(numComp);
850    #pragma omp for
851                for (index_t k2=0; k2 < m_NE2; ++k2) {
852                    for (index_t k1=0; k1 < m_NE1; ++k1) {
853                        for (index_t k0=0; k0 < m_NE0; ++k0) {
854                            memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
855                            memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
856                            memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
857                            memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
858                            memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
859                            memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
860                            memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
861                            memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
862                            double* o = out.getSampleDataRW(INDEX3(k0,k1,k2,m_NE0,m_NE1));
863                            for (index_t i=0; i < numComp; ++i) {
864                                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;
865                                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;
866                                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;
867                            } // end of component loop i
868                        } // end of k0 loop
869                    } // end of k1 loop
870                } // end of k2 loop
871            } // end of parallel section
872        } else if (out.getFunctionSpace().getTypeCode() == FaceElements) {
873            out.requireWrite();
874    #pragma omp parallel
875            {
876                vector<double> f_000(numComp);
877                vector<double> f_001(numComp);
878                vector<double> f_010(numComp);
879                vector<double> f_011(numComp);
880                vector<double> f_100(numComp);
881                vector<double> f_101(numComp);
882                vector<double> f_110(numComp);
883                vector<double> f_111(numComp);
884                if (m_faceOffset[0] > -1) {
885    #pragma omp for nowait
886                    for (index_t k2=0; k2 < m_NE2; ++k2) {
887                        for (index_t k1=0; k1 < m_NE1; ++k1) {
888                            memcpy(&f_000[0], in.getSampleDataRO(INDEX3(0,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
889                            memcpy(&f_001[0], in.getSampleDataRO(INDEX3(0,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
890                            memcpy(&f_010[0], in.getSampleDataRO(INDEX3(0,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
891                            memcpy(&f_011[0], in.getSampleDataRO(INDEX3(0,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
892                            memcpy(&f_100[0], in.getSampleDataRO(INDEX3(1,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
893                            memcpy(&f_101[0], in.getSampleDataRO(INDEX3(1,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
894                            memcpy(&f_110[0], in.getSampleDataRO(INDEX3(1,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
895                            memcpy(&f_111[0], in.getSampleDataRO(INDEX3(1,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
896                            double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));
897                            for (index_t i=0; i < numComp; ++i) {
898                                const double V0=((f_010[i]-f_000[i])*C6 + (f_011[i]-f_001[i])*C2) / h1;
899                                const double V1=((f_010[i]-f_000[i])*C2 + (f_011[i]-f_001[i])*C6) / h1;
900                                const double V2=((f_001[i]-f_000[i])*C6 + (f_010[i]-f_011[i])*C2) / h2;
901                                const double V3=((f_001[i]-f_000[i])*C2 + (f_011[i]-f_010[i])*C6) / h2;
902                                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;
903                                o[INDEX3(i,1,0,numComp,3)] = V0;
904                                o[INDEX3(i,2,0,numComp,3)] = V2;
905                                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;
906                                o[INDEX3(i,1,1,numComp,3)] = V0;
907                                o[INDEX3(i,2,1,numComp,3)] = V3;
908                                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;
909                                o[INDEX3(i,1,2,numComp,3)] = V1;
910                                o[INDEX3(i,2,2,numComp,3)] = V2;
911                                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;
912                                o[INDEX3(i,1,3,numComp,3)] = V1;
913                                o[INDEX3(i,2,3,numComp,3)] = V3;
914                            } // end of component loop i
915                        } // end of k1 loop
916                    } // end of k2 loop
917                } // end of face 0
918                if (m_faceOffset[1] > -1) {
919    #pragma omp for nowait
920                    for (index_t k2=0; k2 < m_NE2; ++k2) {
921                        for (index_t k1=0; k1 < m_NE1; ++k1) {
922                            memcpy(&f_000[0], in.getSampleDataRO(INDEX3(m_N0-2,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
923                            memcpy(&f_001[0], in.getSampleDataRO(INDEX3(m_N0-2,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
924                            memcpy(&f_010[0], in.getSampleDataRO(INDEX3(m_N0-2,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
925                            memcpy(&f_011[0], in.getSampleDataRO(INDEX3(m_N0-2,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
926                            memcpy(&f_100[0], in.getSampleDataRO(INDEX3(m_N0-1,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
927                            memcpy(&f_101[0], in.getSampleDataRO(INDEX3(m_N0-1,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
928                            memcpy(&f_110[0], in.getSampleDataRO(INDEX3(m_N0-1,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
929                            memcpy(&f_111[0], in.getSampleDataRO(INDEX3(m_N0-1,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
930                            double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));
931                            for (index_t i=0; i < numComp; ++i) {
932                                const double V0=((f_110[i]-f_100[i])*C6 + (f_111[i]-f_101[i])*C2) / h1;
933                                const double V1=((f_110[i]-f_100[i])*C2 + (f_111[i]-f_101[i])*C6) / h1;
934                                const double V2=((f_101[i]-f_100[i])*C6 + (f_111[i]-f_110[i])*C2) / h2;
935                                const double V3=((f_101[i]-f_100[i])*C2 + (f_111[i]-f_110[i])*C6) / h2;
936                                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;
937                                o[INDEX3(i,1,0,numComp,3)] = V0;
938                                o[INDEX3(i,2,0,numComp,3)] = V2;
939                                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;
940                                o[INDEX3(i,1,1,numComp,3)] = V0;
941                                o[INDEX3(i,2,1,numComp,3)] = V3;
942                                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;
943                                o[INDEX3(i,1,2,numComp,3)] = V1;
944                                o[INDEX3(i,2,2,numComp,3)] = V2;
945                                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;
946                                o[INDEX3(i,1,3,numComp,3)] = V1;
947                                o[INDEX3(i,2,3,numComp,3)] = V3;
948                            } // end of component loop i
949                        } // end of k1 loop
950                    } // end of k2 loop
951                } // end of face 1
952                if (m_faceOffset[2] > -1) {
953    #pragma omp for nowait
954                    for (index_t k2=0; k2 < m_NE2; ++k2) {
955                        for (index_t k0=0; k0 < m_NE0; ++k0) {
956                            memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,0,k2, m_N0,m_N1)), numComp*sizeof(double));
957                            memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,0,k2+1, m_N0,m_N1)), numComp*sizeof(double));
958                            memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,1,k2, m_N0,m_N1)), numComp*sizeof(double));
959                            memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
960                            memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,0,k2, m_N0,m_N1)), numComp*sizeof(double));
961                            memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,0,k2+1, m_N0,m_N1)), numComp*sizeof(double));
962                            memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,1,k2, m_N0,m_N1)), numComp*sizeof(double));
963                            memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
964                            double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));
965                            for (index_t i=0; i < numComp; ++i) {
966                                const double V0=((f_100[i]-f_000[i])*C6 + (f_101[i]-f_001[i])*C2) / h0;
967                                const double V1=((f_001[i]-f_000[i])*C6 + (f_101[i]-f_100[i])*C2) / h2;
968                                const double V2=((f_001[i]-f_000[i])*C2 + (f_101[i]-f_100[i])*C6) / h2;
969                                o[INDEX3(i,0,0,numComp,3)] = V0;
970                                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;
971                                o[INDEX3(i,2,0,numComp,3)] = V1;
972                                o[INDEX3(i,0,1,numComp,3)] = V0;
973                                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;
974                                o[INDEX3(i,2,1,numComp,3)] = V2;
975                                o[INDEX3(i,0,2,numComp,3)] = V0;
976                                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;
977                                o[INDEX3(i,2,2,numComp,3)] = V1;
978                                o[INDEX3(i,0,3,numComp,3)] = V0;
979                                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;
980                                o[INDEX3(i,2,3,numComp,3)] = V2;
981                            } // end of component loop i
982                        } // end of k0 loop
983                    } // end of k2 loop
984                } // end of face 2
985                if (m_faceOffset[3] > -1) {
986    #pragma omp for nowait
987                    for (index_t k2=0; k2 < m_NE2; ++k2) {
988                        for (index_t k0=0; k0 < m_NE0; ++k0) {
989                            memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,m_N1-2,k2, m_N0,m_N1)), numComp*sizeof(double));
990                            memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,m_N1-2,k2+1, m_N0,m_N1)), numComp*sizeof(double));
991                            memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,m_N1-1,k2, m_N0,m_N1)), numComp*sizeof(double));
992                            memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,m_N1-1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
993                            memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-2,k2, m_N0,m_N1)), numComp*sizeof(double));
994                            memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-2,k2+1, m_N0,m_N1)), numComp*sizeof(double));
995                            memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-1,k2, m_N0,m_N1)), numComp*sizeof(double));
996                            memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
997                            double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));
998                            for (index_t i=0; i < numComp; ++i) {
999                                const double V0=((f_110[i]-f_010[i])*C6 + (f_111[i]-f_011[i])*C2) / h0;
1000                                const double V1=((f_110[i]-f_010[i])*C2 + (f_111[i]-f_011[i])*C6) / h0;
1001                                const double V2=((f_011[i]-f_010[i])*C6 + (f_111[i]-f_110[i])*C2) / h2;
1002                                const double V3=((f_011[i]-f_010[i])*C2 + (f_111[i]-f_110[i])*C6) / h2;
1003                                o[INDEX3(i,0,0,numComp,3)] = V0;
1004                                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;
1005                                o[INDEX3(i,2,0,numComp,3)] = V2;
1006                                o[INDEX3(i,0,1,numComp,3)] = V0;
1007                                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;
1008                                o[INDEX3(i,2,1,numComp,3)] = V3;
1009                                o[INDEX3(i,0,2,numComp,3)] = V1;
1010                                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;
1011                                o[INDEX3(i,2,2,numComp,3)] = V2;
1012                                o[INDEX3(i,0,3,numComp,3)] = V1;
1013                                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;
1014                                o[INDEX3(i,2,3,numComp,3)] = V3;
1015                            } // end of component loop i
1016                        } // end of k0 loop
1017                    } // end of k2 loop
1018                } // end of face 3
1019                if (m_faceOffset[4] > -1) {
1020    #pragma omp for nowait
1021                    for (index_t k1=0; k1 < m_NE1; ++k1) {
1022                        for (index_t k0=0; k0 < m_NE0; ++k0) {
1023                            memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,0, m_N0,m_N1)), numComp*sizeof(double));
1024                            memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,1, m_N0,m_N1)), numComp*sizeof(double));
1025                            memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,0, m_N0,m_N1)), numComp*sizeof(double));
1026                            memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,1, m_N0,m_N1)), numComp*sizeof(double));
1027                            memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,0, m_N0,m_N1)), numComp*sizeof(double));
1028                            memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,1, m_N0,m_N1)), numComp*sizeof(double));
1029                            memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,0, m_N0,m_N1)), numComp*sizeof(double));
1030                            memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,1, m_N0,m_N1)), numComp*sizeof(double));
1031                            double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));
1032                            for (index_t i=0; i < numComp; ++i) {
1033                                const double V0=((f_100[i]-f_000[i])*C6 + (f_110[i]-f_010[i])*C2) / h0;
1034                                const double V1=((f_100[i]-f_000[i])*C2 + (f_110[i]-f_010[i])*C6) / h0;
1035                                const double V2=((f_010[i]-f_000[i])*C6 + (f_110[i]-f_100[i])*C2) / h1;
1036                                const double V3=((f_010[i]-f_000[i])*C2 + (f_110[i]-f_100[i])*C6) / h1;
1037                                o[INDEX3(i,0,0,numComp,3)] = V0;
1038                                o[INDEX3(i,1,0,numComp,3)] = V2;
1039                                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;
1040                                o[INDEX3(i,0,1,numComp,3)] = V0;
1041                                o[INDEX3(i,1,1,numComp,3)] = V3;
1042                                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;
1043                                o[INDEX3(i,0,2,numComp,3)] = V1;
1044                                o[INDEX3(i,1,2,numComp,3)] = V2;
1045                                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;
1046                                o[INDEX3(i,0,3,numComp,3)] = V1;
1047                                o[INDEX3(i,1,3,numComp,3)] = V3;
1048                                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;
1049                            } // end of component loop i
1050                        } // end of k0 loop
1051                    } // end of k1 loop
1052                } // end of face 4
1053                if (m_faceOffset[5] > -1) {
1054    #pragma omp for nowait
1055                    for (index_t k1=0; k1 < m_NE1; ++k1) {
1056                        for (index_t k0=0; k0 < m_NE0; ++k0) {
1057                            memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,m_N2-2, m_N0,m_N1)), numComp*sizeof(double));
1058                            memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));
1059                            memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,m_N2-2, m_N0,m_N1)), numComp*sizeof(double));
1060                            memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));
1061                            memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,m_N2-2, m_N0,m_N1)), numComp*sizeof(double));
1062                            memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));
1063                            memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,m_N2-2, m_N0,m_N1)), numComp*sizeof(double));
1064                            memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));
1065                            double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));
1066                            for (index_t i=0; i < numComp; ++i) {
1067                                const double V0=((f_101[i]-f_001[i])*C6 + (f_111[i]-f_011[i])*C2) / h0;
1068                                const double V1=((f_101[i]-f_001[i])*C2 + (f_111[i]-f_011[i])*C6) / h0;
1069                                const double V2=((f_011[i]-f_001[i])*C6 + (f_111[i]-f_101[i])*C2) / h1;
1070                                const double V3=((f_011[i]-f_001[i])*C2 + (f_111[i]-f_101[i])*C6) / h1;
1071                                o[INDEX3(i,0,0,numComp,3)] = V0;
1072                                o[INDEX3(i,1,0,numComp,3)] = V2;
1073                                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;
1074                                o[INDEX3(i,0,1,numComp,3)] = V0;
1075                                o[INDEX3(i,1,1,numComp,3)] = V3;
1076                                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;
1077                                o[INDEX3(i,0,2,numComp,3)] = V1;
1078                                o[INDEX3(i,1,2,numComp,3)] = V2;
1079                                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;
1080                                o[INDEX3(i,0,3,numComp,3)] = V1;
1081                                o[INDEX3(i,1,3,numComp,3)] = V3;
1082                                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;
1083                            } // end of component loop i
1084                        } // end of k0 loop
1085                    } // end of k1 loop
1086                } // end of face 5
1087            } // end of parallel section
1088        } else if (out.getFunctionSpace().getTypeCode() == ReducedFaceElements) {
1089            out.requireWrite();
1090    #pragma omp parallel
1091            {
1092                vector<double> f_000(numComp);
1093                vector<double> f_001(numComp);
1094                vector<double> f_010(numComp);
1095                vector<double> f_011(numComp);
1096                vector<double> f_100(numComp);
1097                vector<double> f_101(numComp);
1098                vector<double> f_110(numComp);
1099                vector<double> f_111(numComp);
1100                if (m_faceOffset[0] > -1) {
1101    #pragma omp for nowait
1102                    for (index_t k2=0; k2 < m_NE2; ++k2) {
1103                        for (index_t k1=0; k1 < m_NE1; ++k1) {
1104                            memcpy(&f_000[0], in.getSampleDataRO(INDEX3(0,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
1105                            memcpy(&f_001[0], in.getSampleDataRO(INDEX3(0,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1106                            memcpy(&f_010[0], in.getSampleDataRO(INDEX3(0,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
1107                            memcpy(&f_011[0], in.getSampleDataRO(INDEX3(0,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1108                            memcpy(&f_100[0], in.getSampleDataRO(INDEX3(1,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
1109                            memcpy(&f_101[0], in.getSampleDataRO(INDEX3(1,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1110                            memcpy(&f_110[0], in.getSampleDataRO(INDEX3(1,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
1111                            memcpy(&f_111[0], in.getSampleDataRO(INDEX3(1,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1112                            double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));
1113                            for (index_t i=0; i < numComp; ++i) {
1114                                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;
1115                                o[INDEX3(i,1,0,numComp,3)] = (f_010[i]+f_011[i]-f_000[i]-f_001[i])*C4 / h1;
1116                                o[INDEX3(i,2,0,numComp,3)] = (f_001[i]+f_011[i]-f_000[i]-f_010[i])*C4 / h2;
1117                            } // end of component loop i
1118                        } // end of k1 loop
1119                    } // end of k2 loop
1120                } // end of face 0
1121                if (m_faceOffset[1] > -1) {
1122    #pragma omp for nowait
1123                    for (index_t k2=0; k2 < m_NE2; ++k2) {
1124                        for (index_t k1=0; k1 < m_NE1; ++k1) {
1125                            memcpy(&f_000[0], in.getSampleDataRO(INDEX3(m_N0-2,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
1126                            memcpy(&f_001[0], in.getSampleDataRO(INDEX3(m_N0-2,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1127                            memcpy(&f_010[0], in.getSampleDataRO(INDEX3(m_N0-2,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
1128                            memcpy(&f_011[0], in.getSampleDataRO(INDEX3(m_N0-2,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1129                            memcpy(&f_100[0], in.getSampleDataRO(INDEX3(m_N0-1,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
1130                            memcpy(&f_101[0], in.getSampleDataRO(INDEX3(m_N0-1,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1131                            memcpy(&f_110[0], in.getSampleDataRO(INDEX3(m_N0-1,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
1132                            memcpy(&f_111[0], in.getSampleDataRO(INDEX3(m_N0-1,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1133                            double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));
1134                            for (index_t i=0; i < numComp; ++i) {
1135                                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;
1136                                o[INDEX3(i,1,0,numComp,3)] = (f_110[i]+f_111[i]-f_100[i]-f_101[i])*C4 / h1;
1137                                o[INDEX3(i,2,0,numComp,3)] = (f_101[i]+f_111[i]-f_100[i]-f_110[i])*C4 / h2;
1138                            } // end of component loop i
1139                        } // end of k1 loop
1140                    } // end of k2 loop
1141                } // end of face 1
1142                if (m_faceOffset[2] > -1) {
1143    #pragma omp for nowait
1144                    for (index_t k2=0; k2 < m_NE2; ++k2) {
1145                        for (index_t k0=0; k0 < m_NE0; ++k0) {
1146                            memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,0,k2, m_N0,m_N1)), numComp*sizeof(double));
1147                            memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,0,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1148                            memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,1,k2, m_N0,m_N1)), numComp*sizeof(double));
1149                            memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1150                            memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,0,k2, m_N0,m_N1)), numComp*sizeof(double));
1151                            memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,0,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1152                            memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,1,k2, m_N0,m_N1)), numComp*sizeof(double));
1153                            memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1154                            double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));
1155                            for (index_t i=0; i < numComp; ++i) {
1156                                o[INDEX3(i,0,0,numComp,3)] = (f_100[i]+f_101[i]-f_000[i]-f_001[i])*C4 / h0;
1157                                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;
1158                                o[INDEX3(i,2,0,numComp,3)] = (f_001[i]+f_101[i]-f_000[i]-f_100[i])*C4 / h2;
1159                            } // end of component loop i
1160                        } // end of k0 loop
1161                    } // end of k2 loop
1162                } // end of face 2
1163                if (m_faceOffset[3] > -1) {
1164    #pragma omp for nowait
1165                    for (index_t k2=0; k2 < m_NE2; ++k2) {
1166                        for (index_t k0=0; k0 < m_NE0; ++k0) {
1167                            memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,m_N1-2,k2, m_N0,m_N1)), numComp*sizeof(double));
1168                            memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,m_N1-2,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1169                            memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,m_N1-1,k2, m_N0,m_N1)), numComp*sizeof(double));
1170                            memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,m_N1-1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1171                            memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-2,k2, m_N0,m_N1)), numComp*sizeof(double));
1172                            memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-2,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1173                            memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-1,k2, m_N0,m_N1)), numComp*sizeof(double));
1174                            memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
1175                            double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));
1176                            for (index_t i=0; i < numComp; ++i) {
1177                                o[INDEX3(i,0,0,numComp,3)] = (f_110[i]+f_111[i]-f_010[i]-f_011[i])*C4 / h0;
1178                                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;
1179                                o[INDEX3(i,2,0,numComp,3)] = (f_011[i]+f_111[i]-f_010[i]-f_110[i])*C4 / h2;
1180                            } // end of component loop i
1181                        } // end of k0 loop
1182                    } // end of k2 loop
1183                } // end of face 3
1184                if (m_faceOffset[4] > -1) {
1185    #pragma omp for nowait
1186                    for (index_t k1=0; k1 < m_NE1; ++k1) {
1187                        for (index_t k0=0; k0 < m_NE0; ++k0) {
1188                            memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,0, m_N0,m_N1)), numComp*sizeof(double));
1189                            memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,1, m_N0,m_N1)), numComp*sizeof(double));
1190                            memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,0, m_N0,m_N1)), numComp*sizeof(double));
1191                            memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,1, m_N0,m_N1)), numComp*sizeof(double));
1192                            memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,0, m_N0,m_N1)), numComp*sizeof(double));
1193                            memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,1, m_N0,m_N1)), numComp*sizeof(double));
1194                            memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,0, m_N0,m_N1)), numComp*sizeof(double));
1195                            memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,1, m_N0,m_N1)), numComp*sizeof(double));
1196                            double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));
1197                            for (index_t i=0; i < numComp; ++i) {
1198                                o[INDEX3(i,0,0,numComp,3)] = (f_100[i]+f_110[i]-f_000[i]-f_010[i])*C4 / h0;
1199                                o[INDEX3(i,1,0,numComp,3)] = (f_010[i]+f_110[i]-f_000[i]-f_100[i])*C4 / h1;
1200                                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;
1201                            } // end of component loop i
1202                        } // end of k0 loop
1203                    } // end of k1 loop
1204                } // end of face 4
1205                if (m_faceOffset[5] > -1) {
1206    #pragma omp for nowait
1207                    for (index_t k1=0; k1 < m_NE1; ++k1) {
1208                        for (index_t k0=0; k0 < m_NE0; ++k0) {
1209                            memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,m_N2-2, m_N0,m_N1)), numComp*sizeof(double));
1210                            memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));
1211                            memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,m_N2-2, m_N0,m_N1)), numComp*sizeof(double));
1212                            memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));
1213                            memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,m_N2-2, m_N0,m_N1)), numComp*sizeof(double));
1214                            memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));
1215                            memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,m_N2-2, m_N0,m_N1)), numComp*sizeof(double));
1216                            memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));
1217                            double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));
1218                            for (index_t i=0; i < numComp; ++i) {
1219                                o[INDEX3(i,0,0,numComp,3)] = (f_101[i]+f_111[i]-f_001[i]-f_011[i])*C4 / h0;
1220                                o[INDEX3(i,1,0,numComp,3)] = (f_011[i]+f_111[i]-f_001[i]-f_101[i])*C4 / h1;
1221                                o[INDEX3(i,2,0,numComp,3)] = (f_001[i]+f_011[i]+f_101[i]+f_111[i]-f_000[i]-f_010[i]-f_100[i]-f_110[i])*C3 / h2;
1222                            } // end of component loop i
1223                        } // end of k0 loop
1224                    } // end of k1 loop
1225                } // end of face 5
1226            } // end of parallel section
1227        }
1228    }
1229    
1230    //protected
1231    void Brick::assembleIntegrate(vector<double>& integrals, escript::Data& arg) const
1232    {
1233        const dim_t numComp = arg.getDataPointSize();
1234        const double h0 = m_l0/m_gNE0;
1235        const double h1 = m_l1/m_gNE1;
1236        const double h2 = m_l2/m_gNE2;
1237        const index_t left = (m_offset0==0 ? 0 : 1);
1238        const index_t bottom = (m_offset1==0 ? 0 : 1);
1239        const index_t front = (m_offset2==0 ? 0 : 1);
1240        const int fs = arg.getFunctionSpace().getTypeCode();
1241        if (fs == Elements && arg.actsExpanded()) {
1242            const double w_0 = h0*h1*h2/8.;
1243    #pragma omp parallel
1244            {
1245                vector<double> int_local(numComp, 0);
1246    #pragma omp for nowait
1247                for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {
1248                    for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {
1249                        for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {
1250                            const double* f = arg.getSampleDataRO(INDEX3(k0, k1, k2, m_NE0, m_NE1));
1251                            for (index_t i=0; i < numComp; ++i) {
1252                                const double f_0 = f[INDEX2(i,0,numComp)];
1253                                const double f_1 = f[INDEX2(i,1,numComp)];
1254                                const double f_2 = f[INDEX2(i,2,numComp)];
1255                                const double f_3 = f[INDEX2(i,3,numComp)];
1256                                const double f_4 = f[INDEX2(i,4,numComp)];
1257                                const double f_5 = f[INDEX2(i,5,numComp)];
1258                                const double f_6 = f[INDEX2(i,6,numComp)];
1259                                const double f_7 = f[INDEX2(i,7,numComp)];
1260                                int_local[i]+=(f_0+f_1+f_2+f_3+f_4+f_5+f_6+f_7)*w_0;
1261                            }  // end of component loop i
1262                        } // end of k0 loop
1263                    } // end of k1 loop
1264                } // end of k2 loop
1265    
1266    #pragma omp critical
1267                for (index_t i=0; i<numComp; i++)
1268                    integrals[i]+=int_local[i];
1269            } // end of parallel section
1270    
1271        } else if (fs==ReducedElements || (fs==Elements && !arg.actsExpanded())) {
1272            const double w_0 = h0*h1*h2;
1273    #pragma omp parallel
1274            {
1275                vector<double> int_local(numComp, 0);
1276    #pragma omp for nowait
1277                for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {
1278                    for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {
1279                        for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {
1280                            const double* f = arg.getSampleDataRO(INDEX3(k0, k1, k2, m_NE0, m_NE1));
1281                            for (index_t i=0; i < numComp; ++i) {
1282                                int_local[i]+=f[i]*w_0;
1283                            }  // end of component loop i
1284                        } // end of k0 loop
1285                    } // end of k1 loop
1286                } // end of k2 loop
1287    
1288    #pragma omp critical
1289                for (index_t i=0; i<numComp; i++)
1290                    integrals[i]+=int_local[i];
1291            } // end of parallel section
1292    
1293        } else if (fs == FaceElements && arg.actsExpanded()) {
1294            const double w_0 = h1*h2/4.;
1295            const double w_1 = h0*h2/4.;
1296            const double w_2 = h0*h1/4.;
1297    #pragma omp parallel
1298            {
1299                vector<double> int_local(numComp, 0);
1300                if (m_faceOffset[0] > -1) {
1301    #pragma omp for nowait
1302                    for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {
1303                        for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {
1304                            const double* f = arg.getSampleDataRO(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));
1305                            for (index_t i=0; i < numComp; ++i) {
1306                                const double f_0 = f[INDEX2(i,0,numComp)];
1307                                const double f_1 = f[INDEX2(i,1,numComp)];
1308                                const double f_2 = f[INDEX2(i,2,numComp)];
1309                                const double f_3 = f[INDEX2(i,3,numComp)];
1310                                int_local[i]+=(f_0+f_1+f_2+f_3)*w_0;
1311                            }  // end of component loop i
1312                        } // end of k1 loop
1313                    } // end of k2 loop
1314                }
1315    
1316                if (m_faceOffset[1] > -1) {
1317    #pragma omp for nowait
1318                    for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {
1319                        for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {
1320                            const double* f = arg.getSampleDataRO(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));
1321                            for (index_t i=0; i < numComp; ++i) {
1322                                const double f_0 = f[INDEX2(i,0,numComp)];
1323                                const double f_1 = f[INDEX2(i,1,numComp)];
1324                                const double f_2 = f[INDEX2(i,2,numComp)];
1325                                const double f_3 = f[INDEX2(i,3,numComp)];
1326                                int_local[i]+=(f_0+f_1+f_2+f_3)*w_0;
1327                            }  // end of component loop i
1328                        } // end of k1 loop
1329                    } // end of k2 loop
1330                }
1331    
1332                if (m_faceOffset[2] > -1) {
1333    #pragma omp for nowait
1334                    for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {
1335                        for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {
1336                            const double* f = arg.getSampleDataRO(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));
1337                            for (index_t i=0; i < numComp; ++i) {
1338                                const double f_0 = f[INDEX2(i,0,numComp)];
1339                                const double f_1 = f[INDEX2(i,1,numComp)];
1340                                const double f_2 = f[INDEX2(i,2,numComp)];
1341                                const double f_3 = f[INDEX2(i,3,numComp)];
1342                                int_local[i]+=(f_0+f_1+f_2+f_3)*w_1;
1343                            }  // end of component loop i
1344                        } // end of k1 loop
1345                    } // end of k2 loop
1346                }
1347    
1348                if (m_faceOffset[3] > -1) {
1349    #pragma omp for nowait
1350                    for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {
1351                        for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {
1352                            const double* f = arg.getSampleDataRO(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));
1353                            for (index_t i=0; i < numComp; ++i) {
1354                                const double f_0 = f[INDEX2(i,0,numComp)];
1355                                const double f_1 = f[INDEX2(i,1,numComp)];
1356                                const double f_2 = f[INDEX2(i,2,numComp)];
1357                                const double f_3 = f[INDEX2(i,3,numComp)];
1358                                int_local[i]+=(f_0+f_1+f_2+f_3)*w_1;
1359                            }  // end of component loop i
1360                        } // end of k1 loop
1361                    } // end of k2 loop
1362                }
1363    
1364                if (m_faceOffset[4] > -1) {
1365    #pragma omp for nowait
1366                    for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {
1367                        for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {
1368                            const double* f = arg.getSampleDataRO(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));
1369                            for (index_t i=0; i < numComp; ++i) {
1370                                const double f_0 = f[INDEX2(i,0,numComp)];
1371                                const double f_1 = f[INDEX2(i,1,numComp)];
1372                                const double f_2 = f[INDEX2(i,2,numComp)];
1373                                const double f_3 = f[INDEX2(i,3,numComp)];
1374                                int_local[i]+=(f_0+f_1+f_2+f_3)*w_2;
1375                            }  // end of component loop i
1376                        } // end of k1 loop
1377                    } // end of k2 loop
1378                }
1379    
1380                if (m_faceOffset[5] > -1) {
1381    #pragma omp for nowait
1382                    for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {
1383                        for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {
1384                            const double* f = arg.getSampleDataRO(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));
1385                            for (index_t i=0; i < numComp; ++i) {
1386                                const double f_0 = f[INDEX2(i,0,numComp)];
1387                                const double f_1 = f[INDEX2(i,1,numComp)];
1388                                const double f_2 = f[INDEX2(i,2,numComp)];
1389                                const double f_3 = f[INDEX2(i,3,numComp)];
1390                                int_local[i]+=(f_0+f_1+f_2+f_3)*w_2;
1391                            }  // end of component loop i
1392                        } // end of k1 loop
1393                    } // end of k2 loop
1394                }
1395    
1396    #pragma omp critical
1397                for (index_t i=0; i<numComp; i++)
1398                    integrals[i]+=int_local[i];
1399            } // end of parallel section
1400    
1401        } else if (fs==ReducedFaceElements || (fs==FaceElements && !arg.actsExpanded())) {
1402            const double w_0 = h1*h2;
1403            const double w_1 = h0*h2;
1404            const double w_2 = h0*h1;
1405    #pragma omp parallel
1406            {
1407                vector<double> int_local(numComp, 0);
1408                if (m_faceOffset[0] > -1) {
1409    #pragma omp for nowait
1410                    for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {
1411                        for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {
1412                            const double* f = arg.getSampleDataRO(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));
1413                            for (index_t i=0; i < numComp; ++i) {
1414                                int_local[i]+=f[i]*w_0;
1415                            }  // end of component loop i
1416                        } // end of k1 loop
1417                    } // end of k2 loop
1418                }
1419    
1420                if (m_faceOffset[1] > -1) {
1421    #pragma omp for nowait
1422                    for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {
1423                        for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {
1424                            const double* f = arg.getSampleDataRO(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));
1425                            for (index_t i=0; i < numComp; ++i) {
1426                                int_local[i]+=f[i]*w_0;
1427                            }  // end of component loop i
1428                        } // end of k1 loop
1429                    } // end of k2 loop
1430                }
1431    
1432                if (m_faceOffset[2] > -1) {
1433    #pragma omp for nowait
1434                    for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {
1435                        for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {
1436                            const double* f = arg.getSampleDataRO(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));
1437                            for (index_t i=0; i < numComp; ++i) {
1438                                int_local[i]+=f[i]*w_1;
1439                            }  // end of component loop i
1440                        } // end of k1 loop
1441                    } // end of k2 loop
1442                }
1443    
1444                if (m_faceOffset[3] > -1) {
1445    #pragma omp for nowait
1446                    for (index_t k2 = front; k2 < front+m_ownNE2; ++k2) {
1447                        for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {
1448                            const double* f = arg.getSampleDataRO(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));
1449                            for (index_t i=0; i < numComp; ++i) {
1450                                int_local[i]+=f[i]*w_1;
1451                            }  // end of component loop i
1452                        } // end of k1 loop
1453                    } // end of k2 loop
1454                }
1455    
1456                if (m_faceOffset[4] > -1) {
1457    #pragma omp for nowait
1458                    for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {
1459                        for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {
1460                            const double* f = arg.getSampleDataRO(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));
1461                            for (index_t i=0; i < numComp; ++i) {
1462                                int_local[i]+=f[i]*w_2;
1463                            }  // end of component loop i
1464                        } // end of k1 loop
1465                    } // end of k2 loop
1466                }
1467    
1468                if (m_faceOffset[5] > -1) {
1469    #pragma omp for nowait
1470                    for (index_t k1 = bottom; k1 < bottom+m_ownNE1; ++k1) {
1471                        for (index_t k0 = left; k0 < left+m_ownNE0; ++k0) {
1472                            const double* f = arg.getSampleDataRO(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));
1473                            for (index_t i=0; i < numComp; ++i) {
1474                                int_local[i]+=f[i]*w_2;
1475                            }  // end of component loop i
1476                        } // end of k1 loop
1477                    } // end of k2 loop
1478                }
1479    
1480    #pragma omp critical
1481                for (index_t i=0; i<numComp; i++)
1482                    integrals[i]+=int_local[i];
1483            } // end of parallel section
1484        } // function space selector
1485    }
1486    
1487    //protected
1488    dim_t Brick::insertNeighbourNodes(IndexVector& index, index_t node) const
1489    {
1490        const dim_t nDOF0 = (m_gNE0+1)/m_NX;
1491        const dim_t nDOF1 = (m_gNE1+1)/m_NY;
1492        const dim_t nDOF2 = (m_gNE2+1)/m_NZ;
1493        const int x=node%nDOF0;
1494        const int y=node%(nDOF0*nDOF1)/nDOF0;
1495        const int z=node/(nDOF0*nDOF1);
1496        int num=0;
1497        // loop through potential neighbours and add to index if positions are
1498        // within bounds
1499        for (int i2=-1; i2<2; i2++) {
1500            for (int i1=-1; i1<2; i1++) {
1501                for (int i0=-1; i0<2; i0++) {
1502                    // skip node itself
1503                    if (i0==0 && i1==0 && i2==0)
1504                        continue;
1505                    // location of neighbour node
1506                    const int nx=x+i0;
1507                    const int ny=y+i1;
1508                    const int nz=z+i2;
1509                    if (nx>=0 && ny>=0 && nz>=0
1510                            && nx<nDOF0 && ny<nDOF1 && nz<nDOF2) {
1511                        index.push_back(nz*nDOF0*nDOF1+ny*nDOF0+nx);
1512                        num++;
1513                    }
1514                }
1515            }
1516        }
1517    
1518        return num;
1519    }
1520    
1521    //protected
1522    void Brick::nodesToDOF(escript::Data& out, escript::Data& in) const
1523    {
1524        const dim_t numComp = in.getDataPointSize();
1525        out.requireWrite();
1526    
1527        const index_t left = (m_offset0==0 ? 0 : 1);
1528        const index_t bottom = (m_offset1==0 ? 0 : 1);
1529        const index_t front = (m_offset2==0 ? 0 : 1);
1530        const dim_t nDOF0 = (m_gNE0+1)/m_NX;
1531        const dim_t nDOF1 = (m_gNE1+1)/m_NY;
1532        const dim_t nDOF2 = (m_gNE2+1)/m_NZ;
1533    #pragma omp parallel for
1534        for (index_t i=0; i<nDOF2; i++) {
1535            for (index_t j=0; j<nDOF1; j++) {
1536                for (index_t k=0; k<nDOF0; k++) {
1537                    const index_t n=k+left+(j+bottom)*m_N0+(i+front)*m_N0*m_N1;
1538                    const double* src=in.getSampleDataRO(n);
1539                    copy(src, src+numComp, out.getSampleDataRW(k+j*nDOF0+i*nDOF0*nDOF1));
1540                }
1541            }
1542        }
1543    }
1544    
1545    //protected
1546    void Brick::dofToNodes(escript::Data& out, escript::Data& in) const
1547    {
1548        const dim_t numComp = in.getDataPointSize();
1549        Paso_Coupler* coupler = Paso_Coupler_alloc(m_connector, numComp);
1550        in.requireWrite();
1551        Paso_Coupler_startCollect(coupler, in.getSampleDataRW(0));
1552    
1553        const dim_t numDOF = getNumDOF();
1554        out.requireWrite();
1555        const double* buffer = Paso_Coupler_finishCollect(coupler);
1556    
1557    #pragma omp parallel for
1558        for (index_t i=0; i<getNumNodes(); i++) {
1559            const double* src=(m_dofMap[i]<numDOF ?
1560                    in.getSampleDataRO(m_dofMap[i])
1561                    : &buffer[(m_dofMap[i]-numDOF)*numComp]);
1562            copy(src, src+numComp, out.getSampleDataRW(i));
1563        }
1564    }
1565    
1566  //private  //private
1567  void Brick::populateSampleIds()  void Brick::populateSampleIds()
1568  {  {
1569      // identifiers are ordered from left to right, bottom to top, front to back      // identifiers are ordered from left to right, bottom to top, front to back
1570      // on each rank, except for the shared nodes which are owned by the rank      // globally
     // below / to the left / to the front of the current rank  
1571    
1572      // build node distribution vector first.      // build node distribution vector first.
1573      // m_nodeDistribution[i] is the first node id on rank i, that is      // rank i owns m_nodeDistribution[i+1]-nodeDistribution[i] nodes which is
1574      // rank i owns m_nodeDistribution[i+1]-nodeDistribution[i] nodes      // constant for all ranks in this implementation
1575      m_nodeDistribution.assign(m_mpiInfo->size+1, 0);      m_nodeDistribution.assign(m_mpiInfo->size+1, 0);
1576      m_nodeDistribution[1]=getNumNodes();      const dim_t numDOF=getNumDOF();
1577      for (dim_t k=1; k<m_mpiInfo->size-1; k++) {      for (dim_t k=1; k<m_mpiInfo->size; k++) {
1578          const index_t x = k%m_NX;          m_nodeDistribution[k]=k*numDOF;
         const index_t y = k%(m_NX*m_NY)/m_NX;  
         const index_t z = k/(m_NX*m_NY);  
         index_t numNodes=getNumNodes();  
         if (x>0)  
             numNodes-=m_N1*m_N2;  
         if (y>0)  
             numNodes-=m_N0*m_N2;  
         if (z>0)  
             numNodes-=m_N0*m_N1;  
         // if an edge was subtracted twice add it back  
         if (x>0 && y>0)  
             numNodes+=m_N2;  
         if (x>0 && z>0)  
             numNodes+=m_N1;  
         if (y>0 && z>0)  
             numNodes+=m_N0;  
         // the corner node was removed 3x and added back 3x, so subtract it  
         if (x>0 && y>0 && z>0)  
             numNodes--;  
         m_nodeDistribution[k+1]=m_nodeDistribution[k]+numNodes;  
1579      }      }
1580      m_nodeDistribution[m_mpiInfo->size]=getNumDataPointsGlobal();      m_nodeDistribution[m_mpiInfo->size]=getNumDataPointsGlobal();
   
1581      m_nodeId.resize(getNumNodes());      m_nodeId.resize(getNumNodes());
1582        m_dofId.resize(numDOF);
1583        m_elementId.resize(getNumElements());
1584        m_faceId.resize(getNumFaceElements());
1585    
1586    #pragma omp parallel
1587        {
1588    #pragma omp for nowait
1589            // nodes
1590            for (dim_t i2=0; i2<m_N2; i2++) {
1591                for (dim_t i1=0; i1<m_N1; i1++) {
1592                    for (dim_t i0=0; i0<m_N0; i0++) {
1593                        m_nodeId[i0+i1*m_N0+i2*m_N0*m_N1] =
1594                            (m_offset2+i2)*(m_gNE0+1)*(m_gNE1+1)
1595                            +(m_offset1+i1)*(m_gNE0+1)
1596                            +m_offset0+i0;
1597                    }
1598                }
1599            }
1600    
1601            // degrees of freedom
1602    #pragma omp for nowait
1603            for (dim_t k=0; k<numDOF; k++)
1604                m_dofId[k] = m_nodeDistribution[m_mpiInfo->rank]+k;
1605    
1606            // elements
1607    #pragma omp for nowait
1608            for (dim_t i2=0; i2<m_NE2; i2++) {
1609                for (dim_t i1=0; i1<m_NE1; i1++) {
1610                    for (dim_t i0=0; i0<m_NE0; i0++) {
1611                        m_elementId[i0+i1*m_NE0+i2*m_NE0*m_NE1] =
1612                            (m_offset2+i2)*m_gNE0*m_gNE1
1613                            +(m_offset1+i1)*m_gNE0
1614                            +m_offset0+i0;
1615                    }
1616                }
1617            }
1618    
1619            // face elements
1620    #pragma omp for
1621            for (dim_t k=0; k<getNumFaceElements(); k++)
1622                m_faceId[k]=k;
1623        } // end parallel section
1624    
1625        m_nodeTags.assign(getNumNodes(), 0);
1626        updateTagsInUse(Nodes);
1627    
1628        m_elementTags.assign(getNumElements(), 0);
1629        updateTagsInUse(Elements);
1630    
1631        // generate face offset vector and set face tags
1632        const IndexVector facesPerEdge = getNumFacesPerBoundary();
1633        const index_t LEFT=1, RIGHT=2, BOTTOM=10, TOP=20, FRONT=100, BACK=200;
1634        const index_t faceTag[] = { LEFT, RIGHT, BOTTOM, TOP, FRONT, BACK };
1635        m_faceOffset.assign(facesPerEdge.size(), -1);
1636        m_faceTags.clear();
1637        index_t offset=0;
1638        for (size_t i=0; i<facesPerEdge.size(); i++) {
1639            if (facesPerEdge[i]>0) {
1640                m_faceOffset[i]=offset;
1641                offset+=facesPerEdge[i];
1642                m_faceTags.insert(m_faceTags.end(), facesPerEdge[i], faceTag[i]);
1643            }
1644        }
1645        setTagMap("left", LEFT);
1646        setTagMap("right", RIGHT);
1647        setTagMap("bottom", BOTTOM);
1648        setTagMap("top", TOP);
1649        setTagMap("front", FRONT);
1650        setTagMap("back", BACK);
1651        updateTagsInUse(FaceElements);
1652    }
1653    
1654      // the bottom, left and front planes are not owned by this rank so the  //private
1655      // identifiers need to be computed accordingly  void Brick::createPattern()
1656    {
1657        const dim_t nDOF0 = (m_gNE0+1)/m_NX;
1658        const dim_t nDOF1 = (m_gNE1+1)/m_NY;
1659        const dim_t nDOF2 = (m_gNE2+1)/m_NZ;
1660      const index_t left = (m_offset0==0 ? 0 : 1);      const index_t left = (m_offset0==0 ? 0 : 1);
1661      const index_t bottom = (m_offset1==0 ? 0 : 1);      const index_t bottom = (m_offset1==0 ? 0 : 1);
1662      const index_t front = (m_offset2==0 ? 0 : 1);      const index_t front = (m_offset2==0 ? 0 : 1);
1663    
1664      // case 1: all nodes on left plane are owned by rank on the left      // populate node->DOF mapping with own degrees of freedom.
1665      if (left>0) {      // The rest is assigned in the loop further down
1666          const int neighbour=m_mpiInfo->rank-1;      m_dofMap.assign(getNumNodes(), 0);
         const index_t leftN0=(neighbour%m_NX == 0 ? m_N0 : m_N0-1);  
         const index_t leftN1=(neighbour%(m_NX*m_NY)/m_NX==0 ? m_N1 : m_N1-1);  
1667  #pragma omp parallel for  #pragma omp parallel for
1668          for (dim_t i2=front; i2<m_N2; i2++) {      for (index_t i=front; i<front+nDOF2; i++) {
1669              for (dim_t i1=bottom; i1<m_N1; i1++) {          for (index_t j=bottom; j<bottom+nDOF1; j++) {
1670                  m_nodeId[i1*m_N0+i2*m_N0*m_N1]=m_nodeDistribution[neighbour]              for (index_t k=left; k<left+nDOF0; k++) {
1671                      + (i1-bottom+1)*leftN0                  m_dofMap[i*m_N0*m_N1+j*m_N0+k]=(i-front)*nDOF0*nDOF1+(j-bottom)*nDOF0+k-left;
                     + (i2-front)*leftN0*leftN1 - 1;  
1672              }              }
1673          }          }
1674      }      }
1675      // case 2: all nodes on bottom plane are owned by rank below  
1676      if (bottom>0) {      // build list of shared components and neighbours by looping through
1677          const int neighbour=m_mpiInfo->rank-m_NX;      // all potential neighbouring ranks and checking if positions are
1678          const index_t bottomN0=(neighbour%m_NX == 0 ? m_N0 : m_N0-1);      // within bounds
1679          const index_t bottomN1=(neighbour%(m_NX*m_NY)/m_NX==0 ? m_N1 : m_N1-1);      const dim_t numDOF=nDOF0*nDOF1*nDOF2;
1680  #pragma omp parallel for      vector<IndexVector> colIndices(numDOF); // for the couple blocks
1681          for (dim_t i2=front; i2<m_N2; i2++) {      RankVector neighbour;
1682              for (dim_t i0=left; i0<m_N0; i0++) {      IndexVector offsetInShared(1,0);
1683                  m_nodeId[i0+i2*m_N0*m_N1]=m_nodeDistribution[neighbour]      IndexVector sendShared, recvShared;
1684                      + bottomN0*(bottomN1-1)      int numShared=0;
1685                      + (i2-front)*bottomN0*bottomN1 + i0-left;      const int x=m_mpiInfo->rank%m_NX;
1686        const int y=m_mpiInfo->rank%(m_NX*m_NY)/m_NX;
1687        const int z=m_mpiInfo->rank/(m_NX*m_NY);
1688        for (int i2=-1; i2<2; i2++) {
1689            for (int i1=-1; i1<2; i1++) {
1690                for (int i0=-1; i0<2; i0++) {
1691                    // skip this rank
1692                    if (i0==0 && i1==0 && i2==0)
1693                        continue;
1694                    // location of neighbour rank
1695                    const int nx=x+i0;
1696                    const int ny=y+i1;
1697                    const int nz=z+i2;
1698                    if (nx>=0 && ny>=0 && nz>=0 && nx<m_NX && ny<m_NY && nz<m_NZ) {
1699                        neighbour.push_back(nz*m_NX*m_NY+ny*m_NX+nx);
1700                        if (i0==0 && i1==0) {
1701                            // sharing front or back plane
1702                            offsetInShared.push_back(offsetInShared.back()+nDOF0*nDOF1);
1703                            for (dim_t i=0; i<nDOF1; i++) {
1704                                const int firstDOF=(i2==-1 ? i*nDOF0
1705                                        : i*nDOF0 + nDOF0*nDOF1*(nDOF2-1));
1706                                const int firstNode=(i2==-1 ? left+(i+bottom)*m_N0
1707                                        : left+(i+bottom)*m_N0+m_N0*m_N1*(m_N2-1));
1708                                for (dim_t j=0; j<nDOF0; j++, numShared++) {
1709                                    sendShared.push_back(firstDOF+j);
1710                                    recvShared.push_back(numDOF+numShared);
1711                                    if (j>0) {
1712                                        if (i>0)
1713                                            colIndices[firstDOF+j-1-nDOF0].push_back(numShared);
1714                                        colIndices[firstDOF+j-1].push_back(numShared);
1715                                        if (i<nDOF1-1)
1716                                            colIndices[firstDOF+j-1+nDOF0].push_back(numShared);
1717                                    }
1718                                    if (i>0)
1719                                        colIndices[firstDOF+j-nDOF0].push_back(numShared);
1720                                    colIndices[firstDOF+j].push_back(numShared);
1721                                    if (i<nDOF1-1)
1722                                        colIndices[firstDOF+j+nDOF0].push_back(numShared);
1723                                    if (j<nDOF0-1) {
1724                                        if (i>0)
1725                                            colIndices[firstDOF+j+1-nDOF0].push_back(numShared);
1726                                        colIndices[firstDOF+j+1].push_back(numShared);
1727                                        if (i<nDOF1-1)
1728                                            colIndices[firstDOF+j+1+nDOF0].push_back(numShared);
1729                                    }
1730                                    m_dofMap[firstNode+j]=numDOF+numShared;
1731                                }
1732                            }
1733                        } else if (i0==0 && i2==0) {
1734                            // sharing top or bottom plane
1735                            offsetInShared.push_back(offsetInShared.back()+nDOF0*nDOF2);
1736                            for (dim_t i=0; i<nDOF2; i++) {
1737                                const int firstDOF=(i1==-1 ? i*nDOF0*nDOF1
1738                                        : nDOF0*((i+1)*nDOF1-1));
1739                                const int firstNode=(i1==-1 ?
1740                                        left+(i+front)*m_N0*m_N1
1741                                        : left+m_N0*((i+1+front)*m_N1-1));
1742                                for (dim_t j=0; j<nDOF0; j++, numShared++) {
1743                                    sendShared.push_back(firstDOF+j);
1744                                    recvShared.push_back(numDOF+numShared);
1745                                    if (j>0) {
1746                                        if (i>0)
1747                                            colIndices[firstDOF+j-1-nDOF0*nDOF1].push_back(numShared);
1748                                        colIndices[firstDOF+j-1].push_back(numShared);
1749                                        if (i<nDOF2-1)
1750                                            colIndices[firstDOF+j-1+nDOF0*nDOF1].push_back(numShared);
1751                                    }
1752                                    if (i>0)
1753                                        colIndices[firstDOF+j-nDOF0*nDOF1].push_back(numShared);
1754                                    colIndices[firstDOF+j].push_back(numShared);
1755                                    if (i<nDOF2-1)
1756                                        colIndices[firstDOF+j+nDOF0*nDOF1].push_back(numShared);
1757                                    if (j<nDOF0-1) {
1758                                        if (i>0)
1759                                            colIndices[firstDOF+j+1-nDOF0*nDOF1].push_back(numShared);
1760                                        colIndices[firstDOF+j+1].push_back(numShared);
1761                                        if (i<nDOF2-1)
1762                                            colIndices[firstDOF+j+1+nDOF0*nDOF1].push_back(numShared);
1763                                    }
1764                                    m_dofMap[firstNode+j]=numDOF+numShared;
1765                                }
1766                            }
1767                        } else if (i1==0 && i2==0) {
1768                            // sharing left or right plane
1769                            offsetInShared.push_back(offsetInShared.back()+nDOF1*nDOF2);
1770                            for (dim_t i=0; i<nDOF2; i++) {
1771                                const int firstDOF=(i0==-1 ? i*nDOF0*nDOF1
1772                                        : nDOF0*(1+i*nDOF1)-1);
1773                                const int firstNode=(i0==-1 ?
1774                                        (bottom+(i+front)*m_N1)*m_N0
1775                                        : (bottom+1+(i+front)*m_N1)*m_N0-1);
1776                                for (dim_t j=0; j<nDOF1; j++, numShared++) {
1777                                    sendShared.push_back(firstDOF+j*nDOF0);
1778                                    recvShared.push_back(numDOF+numShared);
1779                                    if (j>0) {
1780                                        if (i>0)
1781                                            colIndices[firstDOF+(j-1)*nDOF0-nDOF0*nDOF1].push_back(numShared);
1782                                        colIndices[firstDOF+(j-1)*nDOF0].push_back(numShared);
1783                                        if (i<nDOF2-1)
1784                                            colIndices[firstDOF+(j-1)*nDOF0+nDOF0*nDOF1].push_back(numShared);
1785                                    }
1786                                    if (i>0)
1787                                        colIndices[firstDOF+j*nDOF0-nDOF0*nDOF1].push_back(numShared);
1788                                    colIndices[firstDOF+j*nDOF0].push_back(numShared);
1789                                    if (i<nDOF2-1)
1790                                        colIndices[firstDOF+j*nDOF0+nDOF0*nDOF1].push_back(numShared);
1791                                    if (j<nDOF1-1) {
1792                                        if (i>0)
1793                                            colIndices[firstDOF+(j+1)*nDOF0-nDOF0*nDOF1].push_back(numShared);
1794                                        colIndices[firstDOF+(j+1)*nDOF0].push_back(numShared);
1795                                        if (i<nDOF2-1)
1796                                            colIndices[firstDOF+(j+1)*nDOF0+nDOF0*nDOF1].push_back(numShared);
1797                                    }
1798                                    m_dofMap[firstNode+j*m_N0]=numDOF+numShared;
1799                                }
1800                            }
1801                        } else if (i0==0) {
1802                            // sharing an edge in x direction
1803                            offsetInShared.push_back(offsetInShared.back()+nDOF0);
1804                            const int firstDOF=(i1+1)/2*nDOF0*(nDOF1-1)
1805                                               +(i2+1)/2*nDOF0*nDOF1*(nDOF2-1);
1806                            const int firstNode=left+(i1+1)/2*m_N0*(m_N1-1)
1807                                                +(i2+1)/2*m_N0*m_N1*(m_N2-1);
1808                            for (dim_t i=0; i<nDOF0; i++, numShared++) {
1809                                sendShared.push_back(firstDOF+i);
1810                                recvShared.push_back(numDOF+numShared);
1811                                if (i>0)
1812                                    colIndices[firstDOF+i-1].push_back(numShared);
1813                                colIndices[firstDOF+i].push_back(numShared);
1814                                if (i<nDOF0-1)
1815                                    colIndices[firstDOF+i+1].push_back(numShared);
1816                                m_dofMap[firstNode+i]=numDOF+numShared;
1817                            }
1818                        } else if (i1==0) {
1819                            // sharing an edge in y direction
1820                            offsetInShared.push_back(offsetInShared.back()+nDOF1);
1821                            const int firstDOF=(i0+1)/2*(nDOF0-1)
1822                                               +(i2+1)/2*nDOF0*nDOF1*(nDOF2-1);
1823                            const int firstNode=bottom*m_N0
1824                                                +(i0+1)/2*(m_N0-1)
1825                                                +(i2+1)/2*m_N0*m_N1*(m_N2-1);
1826                            for (dim_t i=0; i<nDOF1; i++, numShared++) {
1827                                sendShared.push_back(firstDOF+i*nDOF0);
1828                                recvShared.push_back(numDOF+numShared);
1829                                if (i>0)
1830                                    colIndices[firstDOF+(i-1)*nDOF0].push_back(numShared);
1831                                colIndices[firstDOF+i*nDOF0].push_back(numShared);
1832                                if (i<nDOF1-1)
1833                                    colIndices[firstDOF+(i+1)*nDOF0].push_back(numShared);
1834                                m_dofMap[firstNode+i*m_N0]=numDOF+numShared;
1835                            }
1836                        } else if (i2==0) {
1837                            // sharing an edge in z direction
1838                            offsetInShared.push_back(offsetInShared.back()+nDOF2);
1839                            const int firstDOF=(i0+1)/2*(nDOF0-1)
1840                                               +(i1+1)/2*nDOF0*(nDOF1-1);
1841                            const int firstNode=front*m_N0*m_N1
1842                                                +(i0+1)/2*(m_N0-1)
1843                                                +(i1+1)/2*m_N0*(m_N1-1);
1844                            for (dim_t i=0; i<nDOF2; i++, numShared++) {
1845                                sendShared.push_back(firstDOF+i*nDOF0*nDOF1);
1846                                recvShared.push_back(numDOF+numShared);
1847                                if (i>0)
1848                                    colIndices[firstDOF+(i-1)*nDOF0*nDOF1].push_back(numShared);
1849                                colIndices[firstDOF+i*nDOF0*nDOF1].push_back(numShared);
1850                                if (i<nDOF2-1)
1851                                    colIndices[firstDOF+(i+1)*nDOF0*nDOF1].push_back(numShared);
1852                                m_dofMap[firstNode+i*m_N0*m_N1]=numDOF+numShared;
1853                            }
1854                        } else {
1855                            // sharing a node
1856                            const int dof=(i0+1)/2*(nDOF0-1)
1857                                          +(i1+1)/2*nDOF0*(nDOF1-1)
1858                                          +(i2+1)/2*nDOF0*nDOF1*(nDOF2-1);
1859                            const int node=(i0+1)/2*(m_N0-1)
1860                                           +(i1+1)/2*m_N0*(m_N1-1)
1861                                           +(i2+1)/2*m_N0*m_N1*(m_N2-1);
1862                            offsetInShared.push_back(offsetInShared.back()+1);
1863                            sendShared.push_back(dof);
1864                            recvShared.push_back(numDOF+numShared);
1865                            colIndices[dof].push_back(numShared);
1866                            m_dofMap[node]=numDOF+numShared;
1867                            ++numShared;
1868                        }
1869                    }
1870              }              }
1871          }          }
1872      }      }
1873      // case 3: all nodes on front plane are owned by rank in front  
1874      if (front>0) {      // create connector
1875          const int neighbour=m_mpiInfo->rank-m_NX*m_NY;      Paso_SharedComponents *snd_shcomp = Paso_SharedComponents_alloc(
1876          const index_t N0=(neighbour%m_NX == 0 ? m_N0 : m_N0-1);              numDOF, neighbour.size(), &neighbour[0], &sendShared[0],
1877          const index_t N1=(neighbour%(m_NX*m_NY)/m_NX==0 ? m_N1 : m_N1-1);              &offsetInShared[0], 1, 0, m_mpiInfo);
1878          const index_t N2=(neighbour/(m_NX*m_NY)==0 ? m_N2 : m_N2-1);      Paso_SharedComponents *rcv_shcomp = Paso_SharedComponents_alloc(
1879  #pragma omp parallel for              numDOF, neighbour.size(), &neighbour[0], &recvShared[0],
1880          for (dim_t i1=bottom; i1<m_N1; i1++) {              &offsetInShared[0], 1, 0, m_mpiInfo);
1881              for (dim_t i0=left; i0<m_N0; i0++) {      m_connector = Paso_Connector_alloc(snd_shcomp, rcv_shcomp);
1882                  m_nodeId[i0+i1*m_N0]=m_nodeDistribution[neighbour]      Paso_SharedComponents_free(snd_shcomp);
1883                      + N0*N1*(N2-1)+(i1-bottom)*N0 + i0-left;      Paso_SharedComponents_free(rcv_shcomp);
1884              }  
1885          }      // create main and couple blocks
1886        Paso_Pattern *mainPattern = createMainPattern();
1887        Paso_Pattern *colPattern, *rowPattern;
1888        createCouplePatterns(colIndices, numShared, &colPattern, &rowPattern);
1889    
1890        // allocate paso distribution
1891        Paso_Distribution* distribution = Paso_Distribution_alloc(m_mpiInfo,
1892                const_cast<index_t*>(&m_nodeDistribution[0]), 1, 0);
1893    
1894        // finally create the system matrix
1895        m_pattern = Paso_SystemMatrixPattern_alloc(MATRIX_FORMAT_DEFAULT,
1896                distribution, distribution, mainPattern, colPattern, rowPattern,
1897                m_connector, m_connector);
1898    
1899        Paso_Distribution_free(distribution);
1900    
1901        // useful debug output
1902        /*
1903        cout << "--- rcv_shcomp ---" << endl;
1904        cout << "numDOF=" << numDOF << ", numNeighbors=" << neighbour.size() << endl;
1905        for (size_t i=0; i<neighbour.size(); i++) {
1906            cout << "neighbor[" << i << "]=" << neighbour[i]
1907                << " offsetInShared[" << i+1 << "]=" << offsetInShared[i+1] << endl;
1908      }      }
1909      // case 4: nodes on front bottom edge are owned by the corresponding rank      for (size_t i=0; i<recvShared.size(); i++) {
1910      if (front>0 && bottom>0) {          cout << "shared[" << i << "]=" << recvShared[i] << endl;
         const int neighbour=m_mpiInfo->rank-m_NX*(m_NY+1);  
         const index_t N0=(neighbour%m_NX == 0 ? m_N0 : m_N0-1);  
         const index_t N1=(neighbour%(m_NX*m_NY)/m_NX==0 ? m_N1 : m_N1-1);  
         const index_t N2=(neighbour/(m_NX*m_NY)==0 ? m_N2 : m_N2-1);  
 #pragma omp parallel for  
         for (dim_t i0=left; i0<m_N0; i0++) {  
             m_nodeId[i0]=m_nodeDistribution[neighbour]  
                 + N0*N1*(N2-1)+(N1-1)*N0 + i0-left;  
         }  
1911      }      }
1912      // case 5: nodes on left bottom edge are owned by the corresponding rank      cout << "--- snd_shcomp ---" << endl;
1913      if (left>0 && bottom>0) {      for (size_t i=0; i<sendShared.size(); i++) {
1914          const int neighbour=m_mpiInfo->rank-m_NX-1;          cout << "shared[" << i << "]=" << sendShared[i] << endl;
         const index_t N0=(neighbour%m_NX == 0 ? m_N0 : m_N0-1);  
         const index_t N1=(neighbour%(m_NX*m_NY)/m_NX==0 ? m_N1 : m_N1-1);  
 #pragma omp parallel for  
         for (dim_t i2=front; i2<m_N2; i2++) {  
             m_nodeId[i2*m_N0*m_N1]=m_nodeDistribution[neighbour]  
                 + (1+i2-front)*N0*N1-1;  
         }  
1915      }      }
1916      // case 6: nodes on left front edge are owned by the corresponding rank      cout << "--- dofMap ---" << endl;
1917      if (left>0 && front>0) {      for (size_t i=0; i<m_dofMap.size(); i++) {
1918          const int neighbour=m_mpiInfo->rank-m_NX*m_NY-1;          cout << "m_dofMap[" << i << "]=" << m_dofMap[i] << endl;
         const index_t N0=(neighbour%m_NX == 0 ? m_N0 : m_N0-1);  
         const index_t N1=(neighbour%(m_NX*m_NY)/m_NX==0 ? m_N1 : m_N1-1);  
         const index_t N2=(neighbour/(m_NX*m_NY)==0 ? m_N2 : m_N2-1);  
 #pragma omp parallel for  
         for (dim_t i1=bottom; i1<m_N1; i1++) {  
             m_nodeId[i1*m_N0]=m_nodeDistribution[neighbour]  
                 + N0*N1*(N2-1)+N0-1+(i1-bottom)*N0;  
         }  
     }  
     // case 7: bottom-left-front corner node owned by corresponding rank  
     if (left>0 && bottom>0 && front>0) {  
         const int neighbour=m_mpiInfo->rank-m_NX*(m_NY+1)-1;  
         const index_t N0=(neighbour%m_NX == 0 ? m_N0 : m_N0-1);  
         const index_t N1=(neighbour%(m_NX*m_NY)/m_NX==0 ? m_N1 : m_N1-1);  
         const index_t N2=(neighbour/(m_NX*m_NY) == 0 ? m_N2 : m_N2-1);  
         m_nodeId[0]=m_nodeDistribution[neighbour]+N0*N1*N2-1;  
1919      }      }
1920        cout << "--- colIndices ---" << endl;
1921        for (size_t i=0; i<colIndices.size(); i++) {
1922            cout << "colIndices[" << i << "].size()=" << colIndices[i].size() << endl;
1923        }
1924        */
1925    
1926      // the rest of the id's are contiguous      /*
1927      const index_t firstId=m_nodeDistribution[m_mpiInfo->rank];      cout << "--- main_pattern ---" << endl;
1928  #pragma omp parallel for      cout << "M=" << mainPattern->numOutput << ", N=" << mainPattern->numInput << endl;
1929      for (dim_t i2=front; i2<m_N2; i2++) {      for (size_t i=0; i<mainPattern->numOutput+1; i++) {
1930          for (dim_t i1=bottom; i1<m_N1; i1++) {          cout << "ptr[" << i << "]=" << mainPattern->ptr[i] << endl;
1931              for (dim_t i0=left; i0<m_N0; i0++) {      }
1932                  m_nodeId[i0+i1*m_N0+i2*m_N0*m_N1] = firstId+i0-left      for (size_t i=0; i<mainPattern->ptr[mainPattern->numOutput]; i++) {
1933                      +(i1-bottom)*(m_N0-left)          cout << "index[" << i << "]=" << mainPattern->index[i] << endl;
1934                      +(i2-front)*(m_N0-left)*(m_N1-bottom);      }
1935        */
1936    
1937        /*
1938        cout << "--- colCouple_pattern ---" << endl;
1939        cout << "M=" << colPattern->numOutput << ", N=" << colPattern->numInput << endl;
1940        for (size_t i=0; i<colPattern->numOutput+1; i++) {
1941            cout << "ptr[" << i << "]=" << colPattern->ptr[i] << endl;
1942        }
1943        for (size_t i=0; i<colPattern->ptr[colPattern->numOutput]; i++) {
1944            cout << "index[" << i << "]=" << colPattern->index[i] << endl;
1945        }
1946        */
1947    
1948        /*
1949        cout << "--- rowCouple_pattern ---" << endl;
1950        cout << "M=" << rowPattern->numOutput << ", N=" << rowPattern->numInput << endl;
1951        for (size_t i=0; i<rowPattern->numOutput+1; i++) {
1952            cout << "ptr[" << i << "]=" << rowPattern->ptr[i] << endl;
1953        }
1954        for (size_t i=0; i<rowPattern->ptr[rowPattern->numOutput]; i++) {
1955            cout << "index[" << i << "]=" << rowPattern->index[i] << endl;
1956        }
1957        */
1958    
1959        Paso_Pattern_free(mainPattern);
1960        Paso_Pattern_free(colPattern);
1961        Paso_Pattern_free(rowPattern);
1962    }
1963    
1964    //private
1965    void Brick::addToMatrixAndRHS(Paso_SystemMatrix* S, escript::Data& F,
1966             const vector<double>& EM_S, const vector<double>& EM_F, bool addS,
1967             bool addF, index_t firstNode, dim_t nEq, dim_t nComp) const
1968    {
1969        IndexVector rowIndex;
1970        rowIndex.push_back(m_dofMap[firstNode]);
1971        rowIndex.push_back(m_dofMap[firstNode+1]);
1972        rowIndex.push_back(m_dofMap[firstNode+m_N0]);
1973        rowIndex.push_back(m_dofMap[firstNode+m_N0+1]);
1974        rowIndex.push_back(m_dofMap[firstNode+m_N0*m_N1]);
1975        rowIndex.push_back(m_dofMap[firstNode+m_N0*m_N1+1]);
1976        rowIndex.push_back(m_dofMap[firstNode+m_N0*(m_N1+1)]);
1977        rowIndex.push_back(m_dofMap[firstNode+m_N0*(m_N1+1)+1]);
1978        if (addF) {
1979            double *F_p=F.getSampleDataRW(0);
1980            for (index_t i=0; i<rowIndex.size(); i++) {
1981                if (rowIndex[i]<getNumDOF()) {
1982                    for (index_t eq=0; eq<nEq; eq++) {
1983                        F_p[INDEX2(eq, rowIndex[i], nEq)]+=EM_F[INDEX2(eq,i,nEq)];
1984                    }
1985              }              }
1986          }          }
1987      }      }
1988        if (addS) {
1989            addToSystemMatrix(S, rowIndex, nEq, rowIndex, nComp, EM_S);
1990        }
1991    }
1992    
1993      // elements  //protected
1994      m_elementId.resize(getNumElements());  void Brick::interpolateNodesOnElements(escript::Data& out, escript::Data& in,
1995  #pragma omp parallel for                                         bool reduced) const
1996      for (dim_t k=0; k<getNumElements(); k++) {  {
1997          m_elementId[k]=k;      const dim_t numComp = in.getDataPointSize();
1998        if (reduced) {
1999            out.requireWrite();
2000            const double c0 = .125;
2001    #pragma omp parallel
2002            {
2003                vector<double> f_000(numComp);
2004                vector<double> f_001(numComp);
2005                vector<double> f_010(numComp);
2006                vector<double> f_011(numComp);
2007                vector<double> f_100(numComp);
2008                vector<double> f_101(numComp);
2009                vector<double> f_110(numComp);
2010                vector<double> f_111(numComp);
2011    #pragma omp for
2012                for (index_t k2=0; k2 < m_NE2; ++k2) {
2013                    for (index_t k1=0; k1 < m_NE1; ++k1) {
2014                        for (index_t k0=0; k0 < m_NE0; ++k0) {
2015                            memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
2016                            memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2017                            memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
2018                            memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2019                            memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
2020                            memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2021                            memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
2022                            memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2023                            double* o = out.getSampleDataRW(INDEX3(k0,k1,k2,m_NE0,m_NE1));
2024                            for (index_t i=0; i < numComp; ++i) {
2025                                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]);
2026                            } // end of component loop i
2027                        } // end of k0 loop
2028                    } // end of k1 loop
2029                } // end of k2 loop
2030            } // end of parallel section
2031        } else {
2032            out.requireWrite();
2033            const double c0 = .0094373878376559314545;
2034            const double c1 = .035220810900864519624;
2035            const double c2 = .13144585576580214704;
2036            const double c3 = .49056261216234406855;
2037    #pragma omp parallel
2038            {
2039                vector<double> f_000(numComp);
2040                vector<double> f_001(numComp);
2041                vector<double> f_010(numComp);
2042                vector<double> f_011(numComp);
2043                vector<double> f_100(numComp);
2044                vector<double> f_101(numComp);
2045                vector<double> f_110(numComp);
2046                vector<double> f_111(numComp);
2047    #pragma omp for
2048                for (index_t k2=0; k2 < m_NE2; ++k2) {
2049                    for (index_t k1=0; k1 < m_NE1; ++k1) {
2050                        for (index_t k0=0; k0 < m_NE0; ++k0) {
2051                            memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
2052                            memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2053                            memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
2054                            memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2055                            memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
2056                            memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2057                            memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
2058                            memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2059                            double* o = out.getSampleDataRW(INDEX3(k0,k1,k2,m_NE0,m_NE1));
2060                            for (index_t i=0; i < numComp; ++i) {
2061                                o[INDEX2(i,numComp,0)] = f_000[i]*c3 + f_111[i]*c0 + c2*(f_001[i] + f_010[i] + f_100[i]) + c1*(f_011[i] + f_101[i] + f_110[i]);
2062                                o[INDEX2(i,numComp,1)] = f_011[i]*c0 + f_100[i]*c3 + c2*(f_000[i] + f_101[i] + f_110[i]) + c1*(f_001[i] + f_010[i] + f_111[i]);
2063                                o[INDEX2(i,numComp,2)] = f_010[i]*c3 + f_101[i]*c0 + c2*(f_000[i] + f_011[i] + f_110[i]) + c1*(f_001[i] + f_100[i] + f_111[i]);
2064                                o[INDEX2(i,numComp,3)] = f_001[i]*c0 + f_110[i]*c3 + c2*(f_010[i] + f_100[i] + f_111[i]) + c1*(f_000[i] + f_011[i] + f_101[i]);
2065                                o[INDEX2(i,numComp,4)] = f_001[i]*c3 + f_110[i]*c0 + c2*(f_000[i] + f_011[i] + f_101[i]) + c1*(f_010[i] + f_100[i] + f_111[i]);
2066                                o[INDEX2(i,numComp,5)] = f_010[i]*c0 + f_101[i]*c3 + c2*(f_001[i] + f_100[i] + f_111[i]) + c1*(f_000[i] + f_011[i] + f_110[i]);
2067                                o[INDEX2(i,numComp,6)] = f_011[i]*c3 + f_100[i]*c0 + c2*(f_001[i] + f_010[i] + f_111[i]) + c1*(f_000[i] + f_101[i] + f_110[i]);
2068                                o[INDEX2(i,numComp,7)] = f_000[i]*c0 + f_111[i]*c3 + c2*(f_011[i] + f_101[i] + f_110[i]) + c1*(f_001[i] + f_010[i] + f_100[i]);
2069                            } // end of component loop i
2070                        } // end of k0 loop
2071                    } // end of k1 loop
2072                } // end of k2 loop
2073            } // end of parallel section
2074      }      }
2075    }
2076    
2077      // face elements  //protected
2078      m_faceId.resize(getNumFaceElements());  void Brick::interpolateNodesOnFaces(escript::Data& out, escript::Data& in,
2079  #pragma omp parallel for                                      bool reduced) const
2080      for (dim_t k=0; k<getNumFaceElements(); k++) {  {
2081          m_faceId[k]=k;      const dim_t numComp = in.getDataPointSize();
2082        if (reduced) {
2083            out.requireWrite();
2084            const double c0 = .25;
2085    #pragma omp parallel
2086            {
2087                vector<double> f_000(numComp);
2088                vector<double> f_001(numComp);
2089                vector<double> f_010(numComp);
2090                vector<double> f_011(numComp);
2091                vector<double> f_100(numComp);
2092                vector<double> f_101(numComp);
2093                vector<double> f_110(numComp);
2094                vector<double> f_111(numComp);
2095                if (m_faceOffset[0] > -1) {
2096    #pragma omp for nowait
2097                    for (index_t k2=0; k2 < m_NE2; ++k2) {
2098                        for (index_t k1=0; k1 < m_NE1; ++k1) {
2099                            memcpy(&f_000[0], in.getSampleDataRO(INDEX3(0,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
2100                            memcpy(&f_001[0], in.getSampleDataRO(INDEX3(0,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2101                            memcpy(&f_010[0], in.getSampleDataRO(INDEX3(0,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
2102                            memcpy(&f_011[0], in.getSampleDataRO(INDEX3(0,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2103                            double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));
2104                            for (index_t i=0; i < numComp; ++i) {
2105                                o[INDEX2(i,numComp,0)] = c0*(f_000[i] + f_001[i] + f_010[i] + f_011[i]);
2106                            } // end of component loop i
2107                        } // end of k1 loop
2108                    } // end of k2 loop
2109                } // end of face 0
2110                if (m_faceOffset[1] > -1) {
2111    #pragma omp for nowait
2112                    for (index_t k2=0; k2 < m_NE2; ++k2) {
2113                        for (index_t k1=0; k1 < m_NE1; ++k1) {
2114                            memcpy(&f_100[0], in.getSampleDataRO(INDEX3(m_N0-1,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
2115                            memcpy(&f_101[0], in.getSampleDataRO(INDEX3(m_N0-1,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2116                            memcpy(&f_110[0], in.getSampleDataRO(INDEX3(m_N0-1,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
2117                            memcpy(&f_111[0], in.getSampleDataRO(INDEX3(m_N0-1,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2118                            double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));
2119                            for (index_t i=0; i < numComp; ++i) {
2120                                o[INDEX2(i,numComp,0)] = c0*(f_100[i] + f_101[i] + f_110[i] + f_111[i]);
2121                            } // end of component loop i
2122                        } // end of k1 loop
2123                    } // end of k2 loop
2124                } // end of face 1
2125                if (m_faceOffset[2] > -1) {
2126    #pragma omp for nowait
2127                    for (index_t k2=0; k2 < m_NE2; ++k2) {
2128                        for (index_t k0=0; k0 < m_NE0; ++k0) {
2129                            memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,0,k2, m_N0,m_N1)), numComp*sizeof(double));
2130                            memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,0,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2131                            memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,0,k2, m_N0,m_N1)), numComp*sizeof(double));
2132                            memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,0,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2133                            double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));
2134                            for (index_t i=0; i < numComp; ++i) {
2135                                o[INDEX2(i,numComp,0)] = c0*(f_000[i] + f_001[i] + f_100[i] + f_101[i]);
2136                            } // end of component loop i
2137                        } // end of k0 loop
2138                    } // end of k2 loop
2139                } // end of face 2
2140                if (m_faceOffset[3] > -1) {
2141    #pragma omp for nowait
2142                    for (index_t k2=0; k2 < m_NE2; ++k2) {
2143                        for (index_t k0=0; k0 < m_NE0; ++k0) {
2144                            memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,m_N1-1,k2, m_N0,m_N1)), numComp*sizeof(double));
2145                            memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,m_N1-1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2146                            memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-1,k2, m_N0,m_N1)), numComp*sizeof(double));
2147                            memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2148                            double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));
2149                            for (index_t i=0; i < numComp; ++i) {
2150                                o[INDEX2(i,numComp,0)] = c0*(f_010[i] + f_011[i] + f_110[i] + f_111[i]);
2151                            } // end of component loop i
2152                        } // end of k0 loop
2153                    } // end of k2 loop
2154                } // end of face 3
2155                if (m_faceOffset[4] > -1) {
2156    #pragma omp for nowait
2157                    for (index_t k1=0; k1 < m_NE1; ++k1) {
2158                        for (index_t k0=0; k0 < m_NE0; ++k0) {
2159                            memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,0, m_N0,m_N1)), numComp*sizeof(double));
2160                            memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,0, m_N0,m_N1)), numComp*sizeof(double));
2161                            memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,0, m_N0,m_N1)), numComp*sizeof(double));
2162                            memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,0, m_N0,m_N1)), numComp*sizeof(double));
2163                            double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));
2164                            for (index_t i=0; i < numComp; ++i) {
2165                                o[INDEX2(i,numComp,0)] = c0*(f_000[i] + f_010[i] + f_100[i] + f_110[i]);
2166                            } // end of component loop i
2167                        } // end of k0 loop
2168                    } // end of k1 loop
2169                } // end of face 4
2170                if (m_faceOffset[5] > -1) {
2171    #pragma omp for nowait
2172                    for (index_t k1=0; k1 < m_NE1; ++k1) {
2173                        for (index_t k0=0; k0 < m_NE0; ++k0) {
2174                            memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));
2175                            memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));
2176                            memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));
2177                            memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));
2178                            double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));
2179                            for (index_t i=0; i < numComp; ++i) {
2180                                o[INDEX2(i,numComp,0)] = c0*(f_001[i] + f_011[i] + f_101[i] + f_111[i]);
2181                            } // end of component loop i
2182                        } // end of k0 loop
2183                    } // end of k1 loop
2184                } // end of face 5
2185            } // end of parallel section
2186        } else {
2187            out.requireWrite();
2188            const double c0 = 0.044658198738520451079;
2189            const double c1 = 0.16666666666666666667;
2190            const double c2 = 0.62200846792814621559;
2191    #pragma omp parallel
2192            {
2193                vector<double> f_000(numComp);
2194                vector<double> f_001(numComp);
2195                vector<double> f_010(numComp);
2196                vector<double> f_011(numComp);
2197                vector<double> f_100(numComp);
2198                vector<double> f_101(numComp);
2199                vector<double> f_110(numComp);
2200                vector<double> f_111(numComp);
2201                if (m_faceOffset[0] > -1) {
2202    #pragma omp for nowait
2203                    for (index_t k2=0; k2 < m_NE2; ++k2) {
2204                        for (index_t k1=0; k1 < m_NE1; ++k1) {
2205                            memcpy(&f_000[0], in.getSampleDataRO(INDEX3(0,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
2206                            memcpy(&f_001[0], in.getSampleDataRO(INDEX3(0,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2207                            memcpy(&f_010[0], in.getSampleDataRO(INDEX3(0,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
2208                            memcpy(&f_011[0], in.getSampleDataRO(INDEX3(0,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2209                            double* o = out.getSampleDataRW(m_faceOffset[0]+INDEX2(k1,k2,m_NE1));
2210                            for (index_t i=0; i < numComp; ++i) {
2211                                o[INDEX2(i,numComp,0)] = f_000[i]*c2 + f_011[i]*c0 + c1*(f_001[i] + f_010[i]);
2212                                o[INDEX2(i,numComp,1)] = f_001[i]*c0 + f_010[i]*c2 + c1*(f_000[i] + f_011[i]);
2213                                o[INDEX2(i,numComp,2)] = f_001[i]*c2 + f_010[i]*c0 + c1*(f_000[i] + f_011[i]);
2214                                o[INDEX2(i,numComp,3)] = f_000[i]*c0 + f_011[i]*c2 + c1*(f_001[i] + f_010[i]);
2215                            } // end of component loop i
2216                        } // end of k1 loop
2217                    } // end of k2 loop
2218                } // end of face 0
2219                if (m_faceOffset[1] > -1) {
2220    #pragma omp for nowait
2221                    for (index_t k2=0; k2 < m_NE2; ++k2) {
2222                        for (index_t k1=0; k1 < m_NE1; ++k1) {
2223                            memcpy(&f_100[0], in.getSampleDataRO(INDEX3(m_N0-1,k1,k2, m_N0,m_N1)), numComp*sizeof(double));
2224                            memcpy(&f_101[0], in.getSampleDataRO(INDEX3(m_N0-1,k1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2225                            memcpy(&f_110[0], in.getSampleDataRO(INDEX3(m_N0-1,k1+1,k2, m_N0,m_N1)), numComp*sizeof(double));
2226                            memcpy(&f_111[0], in.getSampleDataRO(INDEX3(m_N0-1,k1+1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2227                            double* o = out.getSampleDataRW(m_faceOffset[1]+INDEX2(k1,k2,m_NE1));
2228                            for (index_t i=0; i < numComp; ++i) {
2229                                o[INDEX2(i,numComp,0)] = f_100[i]*c2 + f_111[i]*c0 + c1*(f_101[i] + f_110[i]);
2230                                o[INDEX2(i,numComp,1)] = f_101[i]*c0 + f_110[i]*c2 + c1*(f_100[i] + f_111[i]);
2231                                o[INDEX2(i,numComp,2)] = f_101[i]*c2 + f_110[i]*c0 + c1*(f_100[i] + f_111[i]);
2232                                o[INDEX2(i,numComp,3)] = f_100[i]*c0 + f_111[i]*c2 + c1*(f_101[i] + f_110[i]);
2233                            } // end of component loop i
2234                        } // end of k1 loop
2235                    } // end of k2 loop
2236                } // end of face 1
2237                if (m_faceOffset[2] > -1) {
2238    #pragma omp for nowait
2239                    for (index_t k2=0; k2 < m_NE2; ++k2) {
2240                        for (index_t k0=0; k0 < m_NE0; ++k0) {
2241                            memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,0,k2, m_N0,m_N1)), numComp*sizeof(double));
2242                            memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,0,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2243                            memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,0,k2, m_N0,m_N1)), numComp*sizeof(double));
2244                            memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,0,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2245                            double* o = out.getSampleDataRW(m_faceOffset[2]+INDEX2(k0,k2,m_NE0));
2246                            for (index_t i=0; i < numComp; ++i) {
2247                                o[INDEX2(i,numComp,0)] = f_000[i]*c2 + f_101[i]*c0 + c1*(f_001[i] + f_100[i]);
2248                                o[INDEX2(i,numComp,1)] = f_001[i]*c0 + f_100[i]*c2 + c1*(f_000[i] + f_101[i]);
2249                                o[INDEX2(i,numComp,2)] = f_001[i]*c2 + f_100[i]*c0 + c1*(f_000[i] + f_101[i]);
2250                                o[INDEX2(i,numComp,3)] = f_000[i]*c0 + f_101[i]*c2 + c1*(f_001[i] + f_100[i]);
2251                            } // end of component loop i
2252                        } // end of k0 loop
2253                    } // end of k2 loop
2254                } // end of face 2
2255                if (m_faceOffset[3] > -1) {
2256    #pragma omp for nowait
2257                    for (index_t k2=0; k2 < m_NE2; ++k2) {
2258                        for (index_t k0=0; k0 < m_NE0; ++k0) {
2259                            memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,m_N1-1,k2, m_N0,m_N1)), numComp*sizeof(double));
2260                            memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,m_N1-1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2261                            memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-1,k2, m_N0,m_N1)), numComp*sizeof(double));
2262                            memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,m_N1-1,k2+1, m_N0,m_N1)), numComp*sizeof(double));
2263                            double* o = out.getSampleDataRW(m_faceOffset[3]+INDEX2(k0,k2,m_NE0));
2264                            for (index_t i=0; i < numComp; ++i) {
2265                                o[INDEX2(i,numComp,0)] = f_010[i]*c2 + f_111[i]*c0 + c1*(f_011[i] + f_110[i]);
2266                                o[INDEX2(i,numComp,1)] = f_011[i]*c0 + f_110[i]*c2 + c1*(f_010[i] + f_111[i]);
2267                                o[INDEX2(i,numComp,2)] = f_011[i]*c2 + f_110[i]*c0 + c1*(f_010[i] + f_111[i]);
2268                                o[INDEX2(i,numComp,3)] = f_010[i]*c0 + f_111[i]*c2 + c1*(f_011[i] + f_110[i]);
2269                            } // end of component loop i
2270                        } // end of k0 loop
2271                    } // end of k2 loop
2272                } // end of face 3
2273                if (m_faceOffset[4] > -1) {
2274    #pragma omp for nowait
2275                    for (index_t k1=0; k1 < m_NE1; ++k1) {
2276                        for (index_t k0=0; k0 < m_NE0; ++k0) {
2277                            memcpy(&f_000[0], in.getSampleDataRO(INDEX3(k0,k1,0, m_N0,m_N1)), numComp*sizeof(double));
2278                            memcpy(&f_010[0], in.getSampleDataRO(INDEX3(k0,k1+1,0, m_N0,m_N1)), numComp*sizeof(double));
2279                            memcpy(&f_100[0], in.getSampleDataRO(INDEX3(k0+1,k1,0, m_N0,m_N1)), numComp*sizeof(double));
2280                            memcpy(&f_110[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,0, m_N0,m_N1)), numComp*sizeof(double));
2281                            double* o = out.getSampleDataRW(m_faceOffset[4]+INDEX2(k0,k1,m_NE0));
2282                            for (index_t i=0; i < numComp; ++i) {
2283                                o[INDEX2(i,numComp,0)] = f_000[i]*c2 + f_110[i]*c0 + c1*(f_010[i] + f_100[i]);
2284                                o[INDEX2(i,numComp,1)] = f_010[i]*c0 + f_100[i]*c2 + c1*(f_000[i] + f_110[i]);
2285                                o[INDEX2(i,numComp,2)] = f_010[i]*c2 + f_100[i]*c0 + c1*(f_000[i] + f_110[i]);
2286                                o[INDEX2(i,numComp,3)] = f_000[i]*c0 + f_110[i]*c2 + c1*(f_010[i] + f_100[i]);
2287                            } // end of component loop i
2288                        } // end of k0 loop
2289                    } // end of k1 loop
2290                } // end of face 4
2291                if (m_faceOffset[5] > -1) {
2292    #pragma omp for nowait
2293                    for (index_t k1=0; k1 < m_NE1; ++k1) {
2294                        for (index_t k0=0; k0 < m_NE0; ++k0) {
2295                            memcpy(&f_001[0], in.getSampleDataRO(INDEX3(k0,k1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));
2296                            memcpy(&f_011[0], in.getSampleDataRO(INDEX3(k0,k1+1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));
2297                            memcpy(&f_101[0], in.getSampleDataRO(INDEX3(k0+1,k1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));
2298                            memcpy(&f_111[0], in.getSampleDataRO(INDEX3(k0+1,k1+1,m_N2-1, m_N0,m_N1)), numComp*sizeof(double));
2299                            double* o = out.getSampleDataRW(m_faceOffset[5]+INDEX2(k0,k1,m_NE0));
2300                            for (index_t i=0; i < numComp; ++i) {
2301                                o[INDEX2(i,numComp,0)] = f_001[i]*c2 + f_111[i]*c0 + c1*(f_011[i] + f_101[i]);
2302                                o[INDEX2(i,numComp,1)] = f_011[i]*c0 + f_101[i]*c2 + c1*(f_001[i] + f_111[i]);
2303                                o[INDEX2(i,numComp,2)] = f_011[i]*c2 + f_101[i]*c0 + c1*(f_001[i] + f_111[i]);
2304                                o[INDEX2(i,numComp,3)] = f_001[i]*c0 + f_111[i]*c2 + c1*(f_011[i] + f_101[i]);
2305                            } // end of component loop i
2306                        } // end of k0 loop
2307                    } // end of k1 loop
2308                } // end of face 5
2309            } // end of parallel section
2310        }
2311    }
2312    
2313    //protected
2314    void Brick::assemblePDESingle(Paso_SystemMatrix* mat, escript::Data& rhs,
2315            const escript::Data& A, const escript::Data& B,
2316            const escript::Data& C, const escript::Data& D,
2317            const escript::Data& X, const escript::Data& Y) const
2318    {
2319        const double h0 = m_l0/m_gNE0;
2320        const double h1 = m_l1/m_gNE1;
2321        const double h2 = m_l2/m_gNE2;
2322        const double w0 = 0.0009303791403858427308*h1*h2/h0;
2323        const double w1 = 0.0009303791403858427308*h2;
2324        const double w2 = -0.00024929433932114870101*h1;
2325        const double w3 = 0.0009303791403858427308*h0*h2/h1;
2326        const double w4 = -0.00024929433932114870101*h0;
2327        const double w5 = 0.0009303791403858427308*h1;
2328        const double w6 = 0.0009303791403858427308*h0;
2329        const double w7 = -0.00024929433932114870101*h0*h1/h2;
2330        const double w8 = 0.0034722222222222222222*h2;
2331        const double w9 = -0.0009303791403858427308*h1;
2332        const double w10 = 0.012958509748503046158*h0*h2/h1;
2333        const double w11 = -0.0034722222222222222222*h0;
2334        const double w12 = 0.0034722222222222222222*h1;
2335        const double w13 = 0.012958509748503046158*h0;
2336        const double w14 = -0.0034722222222222222222*h0*h1/h2;
2337        const double w15 = 0.012958509748503046158*h1*h2/h0;
2338        const double w16 = -0.0034722222222222222222*h1;
2339        const double w17 = -0.0009303791403858427308*h0;
2340        const double w18 = 0.012958509748503046158*h1;
2341        const double w19 = 0.0034722222222222222222*h0;
2342        const double w20 = 0.012958509748503046158*h2;
2343        const double w21 = -0.012958509748503046158*h1;
2344        const double w22 = -0.012958509748503046158*h0;
2345        const double w23 = 0.04836181677178996241*h1;
2346        const double w24 = 0.04836181677178996241*h0;
2347        const double w25 = -0.04836181677178996241*h0*h1/h2;
2348        const double w26 = 0.00024929433932114870101*h1;
2349        const double w27 = 0.00024929433932114870101*h0;
2350        const double w28 = -0.04836181677178996241*h1;
2351        const double w29 = -0.04836181677178996241*h0;
2352        const double w30 = -0.0009303791403858427308*h1*h2/h0;
2353        const double w31 = -0.0009303791403858427308*h2;
2354        const double w32 = -0.0009303791403858427308*h0*h2/h1;
2355        const double w33 = 0.0034722222222222222222*h0*h1/h2;
2356        const double w34 = -0.0034722222222222222222*h2;
2357        const double w35 = -0.00024929433932114870101*h2;
2358        const double w36 = -0.012958509748503046158*h1*h2/h0;
2359        const double w37 = -0.012958509748503046158*h2;
2360        const double w38 = -0.012958509748503046158*h0*h2/h1;
2361        const double w39 = -0.04836181677178996241*h2;
2362        const double w40 = -0.0034722222222222222222*h0*h2/h1;
2363        const double w41 = 0.0009303791403858427308*h0*h1/h2;
2364        const double w42 = 0.04836181677178996241*h2;
2365        const double w43 = -0.04836181677178996241*h0*h2/h1;
2366        const double w44 = 0.012958509748503046158*h0*h1/h2;
2367        const double w45 = -0.00024929433932114870101*h0*h2/h1;
2368        const double w46 = 0.00024929433932114870101*h2;
2369        const double w47 = -0.0034722222222222222222*h1*h2/h0;
2370        const double w48 = -0.00024929433932114870101*h1*h2/h0;
2371        const double w49 = -0.04836181677178996241*h1*h2/h0;
2372        const double w50 = 0.0034722222222222222222*h0*h2/h1;
2373        const double w51 = -0.0009303791403858427308*h0*h1/h2;
2374        const double w52 = -0.012958509748503046158*h0*h1/h2;
2375        const double w53 = 0.0034722222222222222222*h1*h2/h0;
2376        const double w54 = 0.00024929433932114870101*h0*h1/h2;
2377        const double w55 = 0.04836181677178996241*h0*h2/h1;
2378        const double w56 = 0.04836181677178996241*h1*h2/h0;
2379        const double w57 = 0.04836181677178996241*h0*h1/h2;
2380        const double w58 = 0.00024929433932114870101*h1*h2/h0;
2381        const double w59 = 0.00024929433932114870101*h0*h2/h1;
2382        const double w60 = 0.055555555555555555556*h1*h2/h0;
2383        const double w61 = 0.041666666666666666667*h2;
2384        const double w62 = -0.083333333333333333333*h1;
2385        const double w63 = 0.055555555555555555556*h0*h2/h1;
2386        const double w64 = -0.083333333333333333333*h0;
2387        const double w65 = 0.083333333333333333333*h1;
2388        const double w66 = 0.083333333333333333333*h0;
2389        const double w67 = -0.11111111111111111111*h0*h1/h2;
2390        const double w68 = -0.055555555555555555556*h1*h2/h0;
2391        const double w69 = -0.083333333333333333333*h2;
2392        const double w70 = -0.041666666666666666667*h1;
2393        const double w71 = -0.055555555555555555556*h0*h2/h1;
2394        const double w72 = -0.041666666666666666667*h0;
2395        const double w73 = 0.041666666666666666667*h1;
2396        const double w74 = 0.041666666666666666667*h0;
2397        const double w75 = 0.027777777777777777778*h0*h1/h2;
2398        const double w76 = 0.083333333333333333333*h2;
2399        const double w77 = -0.11111111111111111111*h0*h2/h1;
2400        const double w78 = 0.055555555555555555556*h0*h1/h2;
2401        const double w79 = -0.11111111111111111111*h1*h2/h0;
2402        const double w80 = -0.027777777777777777778*h1*h2/h0;
2403        const double w81 = -0.041666666666666666667*h2;
2404        const double w82 = -0.027777777777777777778*h0*h2/h1;
2405        const double w83 = -0.027777777777777777778*h0*h1/h2;
2406        const double w84 = 0.027777777777777777778*h0*h2/h1;
2407        const double w85 = -0.055555555555555555556*h0*h1/h2;
2408        const double w86 = 0.11111111111111111111*h1*h2/h0;
2409        const double w87 = 0.11111111111111111111*h0*h2/h1;
2410        const double w88 = 0.11111111111111111111*h0*h1/h2;
2411        const double w89 = 0.027777777777777777778*h1*h2/h0;
2412        const double w90 = 0.0001966122466178319053*h1*h2;
2413        const double w91 = 0.0001966122466178319053*h0*h2;
2414        const double w92 = 0.0001966122466178319053*h0*h1;
2415        const double w93 = 0.0007337668937680108255*h1*h2;
2416        const double w94 = 0.0027384553284542113967*h0*h2;
2417        const double w95 = 0.0027384553284542113967*h0*h1;
2418        const double w96 = 0.0027384553284542113967*h1*h2;
2419        const double w97 = 0.0007337668937680108255*h0*h2;
2420        const double w98 = 0.010220054420048834761*h1*h2;
2421        const double w99 = 0.010220054420048834761*h0*h2;
2422        const double w100 = 0.038141762351741127649*h0*h1;
2423        const double w101 = 0.000052682092703316795705*h0*h1;
2424        const double w102 = 0.0007337668937680108255*h0*h1;
2425        const double w103 = 0.010220054420048834761*h0*h1;
2426        const double w104 = -0.0001966122466178319053*h1*h2;
2427        const double w105 = -0.0001966122466178319053*h0*h2;
2428        const double w106 = -0.0007337668937680108255*h1*h2;
2429        const double w107 = -0.0007337668937680108255*h0*h2;
2430        const double w108 = -0.0027384553284542113967*h1*h2;
2431        const double w109 = -0.0027384553284542113967*h0*h2;
2432        const double w110 = -0.010220054420048834761*h1*h2;
2433        const double w111 = -0.010220054420048834761*h0*h2;
2434        const double w112 = -0.0007337668937680108255*h0*h1;
2435        const double w113 = -0.010220054420048834761*h0*h1;
2436        const double w114 = -0.038141762351741127649*h0*h2;
2437        const double w115 = -0.000052682092703316795705*h0*h2;
2438        const double w116 = -0.0001966122466178319053*h0*h1;
2439        const double w117 = -0.0027384553284542113967*h0*h1;
2440        const double w118 = 0.000052682092703316795705*h0*h2;
2441        const double w119 = 0.038141762351741127649*h0*h2;
2442        const double w120 = 0.000052682092703316795705*h1*h2;
2443        const double w121 = 0.038141762351741127649*h1*h2;
2444        const double w122 = -0.000052682092703316795705*h0*h1;
2445        const double w123 = -0.038141762351741127649*h0*h1;
2446        const double w124 = -0.000052682092703316795705*h1*h2;
2447        const double w125 = -0.038141762351741127649*h1*h2;
2448        const double w126 = 0.027777777777777777778*h1*h2;
2449        const double w127 = 0.027777777777777777778*h0*h2;
2450        const double w128 = 0.055555555555555555556*h0*h1;
2451        const double w129 = -0.027777777777777777778*h1*h2;
2452        const double w130 = -0.027777777777777777778*h0*h2;
2453        const double w131 = 0.013888888888888888889*h0*h1;
2454        const double w132 = -0.055555555555555555556*h0*h2;
2455        const double w133 = -0.027777777777777777778*h0*h1;
2456        const double w134 = 0.055555555555555555556*h0*h2;
2457        const double w135 = 0.027777777777777777778*h0*h1;
2458        const double w136 = -0.013888888888888888889*h0*h1;
2459        const double w137 = 0.055555555555555555556*h1*h2;
2460        const double w138 = -0.013888888888888888889*h1*h2;
2461        const double w139 = -0.013888888888888888889*h0*h2;
2462        const double w140 = -0.055555555555555555556*h0*h1;
2463        const double w141 = 0.013888888888888888889*h1*h2;
2464        const double w142 = 0.013888888888888888889*h0*h2;
2465        const double w143 = -0.055555555555555555556*h1*h2;
2466        const double w144 = 0.000041549056553524783501*h0*h1*h2;
2467        const double w145 = 0.0005787037037037037037*h0*h1*h2;
2468        const double w146 = 0.0080603027952983270684*h0*h1*h2;
2469        const double w147 = 0.0001550631900643071218*h0*h1*h2;
2470        const double w148 = 0.002159751624750507693*h0*h1*h2;
2471        const double w149 = 0.03008145955644280058*h0*h1*h2;
2472        const double w150 = 0.000011133036149792012204*h0*h1*h2;
2473        const double w151 = 0.018518518518518518519*h0*h1*h2;
2474        const double w152 = 0.0092592592592592592592*h0*h1*h2;
2475        const double w153 = 0.0046296296296296296296*h0*h1*h2;
2476        const double w154 = 0.037037037037037037037*h0*h1*h2;
2477        const double w155 = -0.077751058491018276949*h1*h2;
2478        const double w156 = -0.077751058491018276949*h0*h2;
2479        const double w157 = -0.077751058491018276949*h0*h1;
2480        const double w158 = -0.020833333333333333333*h0*h2;
2481        const double w159 = -0.020833333333333333333*h0*h1;
2482        const double w160 = -0.020833333333333333333*h1*h2;
2483        const double w161 = -0.0055822748423150563848*h0*h1;
2484        const double w162 = -0.0055822748423150563848*h0*h2;
2485        const double w163 = -0.0055822748423150563848*h1*h2;
2486        const double w164 = 0.077751058491018276949*h1*h2;
2487        const double w165 = 0.020833333333333333333*h1*h2;
2488        const double w166 = 0.0055822748423150563848*h1*h2;
2489        const double w167 = 0.077751058491018276949*h0*h2;
2490        const double w168 = 0.020833333333333333333*h0*h2;
2491        const double w169 = 0.0055822748423150563848*h0*h2;
2492        const double w170 = 0.077751058491018276949*h0*h1;
2493        const double w171 = 0.020833333333333333333*h0*h1;
2494        const double w172 = 0.0055822748423150563848*h0*h1;
2495        const double w173 = -0.25*h1*h2;
2496        const double w174 = -0.25*h0*h2;
2497        const double w175 = -0.25*h0*h1;
2498        const double w176 = 0.25*h1*h2;
2499        const double w177 = 0.25*h0*h2;
2500        const double w178 = 0.25*h0*h1;
2501        const double w179 = 0.061320326520293008568*h0*h1*h2;
2502        const double w180 = 0.01643073197072526838*h0*h1*h2;
2503        const double w181 = 0.004402601362608064953*h0*h1*h2;
2504        const double w182 = 0.0011796734797069914318*h0*h1*h2;
2505        const double w183 = 0.125*h0*h1*h2;
2506    
2507        rhs.requireWrite();
2508    #pragma omp parallel
2509        {
2510            for (index_t k2_0=0; k2_0<2; k2_0++) { // colouring
2511    #pragma omp for
2512                for (index_t k2=k2_0; k2<m_NE2; k2+=2) {
2513                    for (index_t k1=0; k1<m_NE1; ++k1) {
2514                        for (index_t k0=0; k0<m_NE0; ++k0)  {
2515                            bool add_EM_S=false;
2516                            bool add_EM_F=false;
2517                            vector<double> EM_S(8*8, 0);
2518                            vector<double> EM_F(8, 0);
2519                            const index_t e = k0 + m_NE0*k1 + m_NE0*m_NE1*k2;
2520                            ///////////////
2521                            // process A //
2522                            ///////////////
2523                            if (!A.isEmpty()) {
2524                                add_EM_S=true;
2525                                const double* A_p=const_cast<escript::Data*>(&A)->getSampleDataRO(e);
2526                                if (A.actsExpanded()) {
2527                                    const double A_00_0 = A_p[INDEX3(0,0,0,3,3)];
2528                                    const double A_01_0 = A_p[INDEX3(0,1,0,3,3)];
2529                                    const double A_02_0 = A_p[INDEX3(0,2,0,3,3)];
2530                                    const double A_10_0 = A_p[INDEX3(1,0,0,3,3)];
2531                                    const double A_11_0 = A_p[INDEX3(1,1,0,3,3)];
2532                                    const double A_12_0 = A_p[INDEX3(1,2,0,3,3)];
2533                                    const double A_20_0 = A_p[INDEX3(2,0,0,3,3)];
2534                                    const double A_21_0 = A_p[INDEX3(2,1,0,3,3)];
2535                                    const double A_22_0 = A_p[INDEX3(2,2,0,3,3)];
2536                                    const double A_00_1 = A_p[INDEX3(0,0,1,3,3)];
2537                                    const double A_01_1 = A_p[INDEX3(0,1,1,3,3)];
2538                                    const double A_02_1 = A_p[INDEX3(0,2,1,3,3)];
2539                                    const double A_10_1 = A_p[INDEX3(1,0,1,3,3)];
2540                                    const double A_11_1 = A_p[INDEX3(1,1,1,3,3)];
2541                                    const double A_12_1 = A_p[INDEX3(1,2,1,3,3)];
2542                                    const double A_20_1 = A_p[INDEX3(2,0,1,3,3)];
2543                                    const double A_21_1 = A_p[INDEX3(2,1,1,3,3)];
2544                                    const double A_22_1 = A_p[INDEX3(2,2,1,3,3)];
2545                                    const double A_00_2 = A_p[INDEX3(0,0,2,3,3)];
2546                                    const double A_01_2 = A_p[INDEX3(0,1,2,3,3)];
2547                                    const double A_02_2 = A_p[INDEX3(0,2,2,3,3)];
2548                                    const double A_10_2 = A_p[INDEX3(1,0,2,3,3)];
2549                                    const double A_11_2 = A_p[INDEX3(1,1,2,3,3)];
2550                                    const double A_12_2 = A_p[INDEX3(1,2,2,3,3)];
2551                                    const double A_20_2 = A_p[INDEX3(2,0,2,3,3)];
2552                                    const double A_21_2 = A_p[INDEX3(2,1,2,3,3)];
2553                                    const double A_22_2 = A_p[INDEX3(2,2,2,3,3)];
2554                                    const double A_00_3 = A_p[INDEX3(0,0,3,3,3)];
2555                                    const double A_01_3 = A_p[INDEX3(0,1,3,3,3)];
2556                                    const double A_02_3 = A_p[INDEX3(0,2,3,3,3)];
2557                                    const double A_10_3 = A_p[INDEX3(1,0,3,3,3)];
2558                                    const double A_11_3 = A_p[INDEX3(1,1,3,3,3)];
2559                                    const double A_12_3 = A_p[INDEX3(1,2,3,3,3)];
2560                                    const double A_20_3 = A_p[INDEX3(2,0,3,3,3)];
2561                                    const double A_21_3 = A_p[INDEX3(2,1,3,3,3)];
2562                                    const double A_22_3 = A_p[INDEX3(2,2,3,3,3)];
2563                                    const double A_00_4 = A_p[INDEX3(0,0,4,3,3)];
2564                                    const double A_01_4 = A_p[INDEX3(0,1,4,3,3)];
2565                                    const double A_02_4 = A_p[INDEX3(0,2,4,3,3)];
2566                                    const double A_10_4 = A_p[INDEX3(1,0,4,3,3)];
2567                                    const double A_11_4 = A_p[INDEX3(1,1,4,3,3)];
2568                                    const double A_12_4 = A_p[INDEX3(1,2,4,3,3)];
2569                                    const double A_20_4 = A_p[INDEX3(2,0,4,3,3)];
2570                                    const double A_21_4 = A_p[INDEX3(2,1,4,3,3)];
2571                                    const double A_22_4 = A_p[INDEX3(2,2,4,3,3)];
2572                                    const double A_00_5 = A_p[INDEX3(0,0,5,3,3)];
2573                                    const double A_01_5 = A_p[INDEX3(0,1,5,3,3)];
2574                                    const double A_02_5 = A_p[INDEX3(0,2,5,3,3)];
2575                                    const double A_10_5 = A_p[INDEX3(1,0,5,3,3)];
2576                                    const double A_11_5 = A_p[INDEX3(1,1,5,3,3)];
2577                                    const double A_12_5 = A_p[INDEX3(1,2,5,3,3)];
2578                                    const double A_20_5 = A_p[INDEX3(2,0,5,3,3)];
2579                                    const double A_21_5 = A_p[INDEX3(2,1,5,3,3)];
2580                                    const double A_22_5 = A_p[INDEX3(2,2,5,3,3)];
2581                                    const double A_00_6 = A_p[INDEX3(0,0,6,3,3)];
2582                                    const double A_01_6 = A_p[INDEX3(0,1,6,3,3)];
2583                                    const double A_02_6 = A_p[INDEX3(0,2,6,3,3)];
2584                                    const double A_10_6 = A_p[INDEX3(1,0,6,3,3)];
2585                                    const double A_11_6 = A_p[INDEX3(1,1,6,3,3)];
2586                                    const double A_12_6 = A_p[INDEX3(1,2,6,3,3)];
2587                                    const double A_20_6 = A_p[INDEX3(2,0,6,3,3)];
2588                                    const double A_21_6 = A_p[INDEX3(2,1,6,3,3)];
2589                                    const double A_22_6 = A_p[INDEX3(2,2,6,3,3)];
2590                                    const double A_00_7 = A_p[INDEX3(0,0,7,3,3)];
2591                                    const double A_01_7 = A_p[INDEX3(0,1,7,3,3)];
2592                                    const double A_02_7 = A_p[INDEX3(0,2,7,3,3)];
2593                                    const double A_10_7 = A_p[INDEX3(1,0,7,3,3)];
2594                                    const double A_11_7 = A_p[INDEX3(1,1,7,3,3)];
2595                                    const double A_12_7 = A_p[INDEX3(1,2,7,3,3)];
2596                                    const double A_20_7 = A_p[INDEX3(2,0,7,3,3)];
2597                                    const double A_21_7 = A_p[INDEX3(2,1,7,3,3)];
2598                                    const double A_22_7 = A_p[INDEX3(2,2,7,3,3)];
2599                                    const double tmp160_0 = A_12_0 + A_12_6 + A_21_0 + A_21_6;
2600                                    const double tmp8_0 = A_21_0 + A_21_6;
2601                                    const double tmp135_0 = A_10_1 + A_10_2 + A_10_5 + A_10_6;
2602                                    const double tmp67_0 = A_02_2 + A_02_7;
2603                                    const double tmp211_0 = A_12_6 + A_21_6;
2604                                    const double tmp180_0 = A_10_2 + A_10_6;
2605                                    const double tmp37_0 = A_00_0 + A_00_1 + A_00_2 + A_00_3;
2606                                    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;
2607                                    const double tmp195_0 = A_02_2 + A_20_2;
2608                                    const double tmp70_0 = A_01_0 + A_01_7;
2609                                    const double tmp139_0 = A_02_3 + A_02_4 + A_20_1 + A_20_6;
2610                                    const double tmp200_0 = A_12_3 + A_12_5 + A_21_3 + A_21_5;
2611                                    const double tmp60_0 = A_22_0 + A_22_2 + A_22_4 + A_22_6;
2612                                    const double tmp192_0 = A_01_5 + A_10_5;
2613                                    const double tmp46_0 = A_21_0 + A_21_7;
2614                                    const double tmp48_0 = A_10_0 + A_10_7;
2615                                    const double tmp166_0 = A_11_5 + A_11_7;
2616                                    const double tmp221_0 = A_02_1 + A_02_6 + A_20_3 + A_20_4;
2617                                    const double tmp50_0 = A_02_4 + A_02_6 + A_20_4 + A_20_6;
2618                                    const double tmp217_0 = A_02_3 + A_02_4 + A_20_3 + A_20_4;
2619                                    const double tmp216_0 = A_01_2 + A_01_5 + A_10_2 + A_10_5;
2620                                    const double tmp104_0 = A_22_2 + A_22_6;
2621                                    const double tmp72_0 = A_20_3 + A_20_6;
2622                                    const double tmp79_0 = A_10_4 + A_10_7;
2623                                    const double tmp86_0 = A_01_2 + A_01_6 + A_10_1 + A_10_5;
2624                                    const double tmp214_0 = A_12_0 + A_12_7 + A_21_0 + A_21_7;
2625                                    const double tmp32_0 = A_02_0 + A_02_2;
2626                                    const double tmp112_0 = A_01_0 + A_01_4 + A_10_3 + A_10_7;
2627                                    const double tmp197_0 = A_12_0 + A_21_0;
2628                                    const double tmp106_0 = A_22_1 + A_22_5;
2629                                    const double tmp2_0 = A_00_0 + A_00_1 + A_00_4 + A_00_5;
2630                                    const double tmp115_0 = A_02_5 + A_02_7 + A_20_0 + A_20_2;
2631                                    const double tmp175_0 = A_01_3 + A_01_7;
2632                                    const double tmp126_0 = A_01_2 + A_01_5 + A_10_1 + A_10_6;
2633                                    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;
2634                                    const double tmp47_0 = A_12_0 + A_12_6;
2635                                    const double tmp205_0 = A_02_7 + A_20_7;
2636                                    const double tmp148_0 = A_01_3 + A_01_4;
2637                                    const double tmp113_0 = A_01_3 + A_01_7 + A_10_0 + A_10_4;
2638                                    const double tmp43_0 = A_20_4 + A_20_6;
2639                                    const double tmp161_0 = A_02_1 + A_02_6 + A_20_1 + A_20_6;
2640                                    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;
2641                                    const double tmp176_0 = A_01_1 + A_01_2 + A_01_5 + A_01_6;
2642                                    const double tmp105_0 = A_01_2 + A_01_6 + A_10_2 + A_10_6;
2643                                    const double tmp22_0 = A_01_5 + A_10_6;
2644                                    const double tmp91_0 = A_02_4 + A_02_6 + A_20_1 + A_20_3;
2645                                    const double tmp206_0 = A_12_7 + A_21_7;
2646                                    const double tmp188_0 = A_02_5 + A_20_5;
2647                                    const double tmp117_0 = A_21_1 + A_21_6;
2648                                    const double tmp165_0 = A_01_1 + A_01_6;
2649                                    const double tmp66_0 = A_00_4 + A_00_5;
2650                                    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;
2651                                    const double tmp31_0 = A_21_4 + A_21_5;
2652                                    const double tmp3_0 = A_11_0 + A_11_2 + A_11_4 + A_11_6;
2653                                    const double tmp183_0 = A_12_0 + A_12_7;
2654                                    const double tmp61_0 = A_02_1 + A_02_3 + A_20_1 + A_20_3;
2655                                    const double tmp54_0 = A_10_5 + A_10_6;
2656                                    const double tmp18_0 = A_02_3 + A_02_6;
2657                                    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;
2658                                    const double tmp29_0 = A_21_2 + A_21_3;
2659                                    const double tmp17_0 = A_01_3 + A_01_7 + A_10_3 + A_10_7;
2660                                    const double tmp212_0 = A_02_6 + A_20_6;
2661                                    const double tmp220_0 = A_02_3 + A_20_6;
2662                                    const double tmp78_0 = A_20_0 + A_20_7;
2663                                    const double tmp215_0 = A_01_6 + A_10_6;
2664                                    const double tmp203_0 = A_01_7 + A_10_7;
2665                                    const double tmp87_0 = A_12_2 + A_12_3 + A_21_4 + A_21_5;
2666                                    const double tmp114_0 = A_02_0 + A_02_2 + A_20_5 + A_20_7;
2667                                    const double tmp0_0 = A_01_0 + A_01_4 + A_10_0 + A_10_4;
2668                                    const double tmp202_0 = A_01_3 + A_01_4 + A_10_3 + A_10_4;
2669                                    const double tmp4_0 = A_20_0 + A_20_5;
2670                                    const double tmp65_0 = A_00_2 + A_00_3;
2671                                    const double tmp24_0 = A_20_1 + A_20_3;
2672                                    const double tmp64_0 = A_10_0 + A_10_3;
2673                                    const double tmp170_0 = A_02_0 + A_02_2 + A_20_0 + A_20_2;
2674                                    const double tmp11_0 = A_20_1 + A_20_6;
2675                                    const double tmp82_0 = A_12_4 + A_12_5 + A_21_4 + A_21_5;
2676                                    const double tmp99_0 = A_01_4 + A_10_7;
2677                                    const double tmp49_0 = A_12_1 + A_12_7;
2678                                    const double tmp130_0 = A_12_0 + A_12_1 + A_12_6 + A_12_7;
2679                                    const double tmp144_0 = A_01_0 + A_10_3;
2680                                    const double tmp109_0 = A_22_0 + A_22_3 + A_22_4 + A_22_7;
2681                                    const double tmp185_0 = A_02_0 + A_02_7 + A_20_2 + A_20_5;
2682                                    const double tmp157_0 = A_01_4 + A_10_4;
2683                                    const double tmp51_0 = A_22_1 + A_22_3 + A_22_5 + A_22_7;
2684                                    const double tmp146_0 = A_00_6 + A_00_7;
2685                                    const double tmp147_0 = A_12_0 + A_12_1 + A_21_0 + A_21_1;
2686                                    const double tmp150_0 = A_00_2 + A_00_3 + A_00_4 + A_00_5;
2687                                    const double tmp62_0 = A_21_3 + A_21_5;
2688                                    const double tmp223_0 = A_12_2 + A_21_4;
2689                                    const double tmp16_0 = A_02_2 + A_02_5;
2690                                    const double tmp168_0 = A_11_1 + A_11_3 + A_11_4 + A_11_6;
2691                                    const double tmp88_0 = A_12_4 + A_12_5 + A_21_2 + A_21_3;
2692                                    const double tmp142_0 = A_01_7 + A_10_4;
2693                                    const double tmp34_0 = A_20_0 + A_20_2 + A_20_5 + A_20_7;
2694                                    const double tmp71_0 = A_00_0 + A_00_1 + A_00_6 + A_00_7;
2695                                    const double tmp213_0 = A_02_1 + A_20_1;
2696                                    const double tmp227_0 = A_12_2 + A_12_5 + A_21_3 + A_21_4;
2697                                    const double tmp228_0 = A_12_1 + A_21_7;
2698                                    const double tmp140_0 = A_01_2 + A_01_6;
2699                                    const double tmp74_0 = A_22_0 + A_22_1 + A_22_4 + A_22_5;
2700                                    const double tmp167_0 = A_11_0 + A_11_2;
2701                                    const double tmp143_0 = A_01_3 + A_01_4 + A_10_0 + A_10_7;
2702                                    const double tmp83_0 = A_02_0 + A_02_5;
2703                                    const double tmp14_0 = A_22_1 + A_22_2 + A_22_5 + A_22_6;
2704                                    const double tmp5_0 = A_12_1 + A_12_6;
2705                                    const double tmp94_0 = A_02_1 + A_02_3;
2706                                    const double tmp193_0 = A_01_1 + A_01_6 + A_10_1 + A_10_6;
2707                                    const double tmp97_0 = A_02_0 + A_02_2 + A_02_5 + A_02_7;
2708                                    const double tmp131_0 = A_01_1 + A_01_5;
2709                                    const double tmp124_0 = A_01_6 + A_10_5;
2710                                    const double tmp149_0 = A_12_6 + A_12_7 + A_21_6 + A_21_7;
2711                                    const double tmp187_0 = A_01_2 + A_10_2;
2712                                    const double tmp93_0 = A_01_1 + A_01_2 + A_10_1 + A_10_2;
2713                                    const double tmp25_0 = A_01_4 + A_01_7 + A_10_4 + A_10_7;
2714                                    const double tmp156_0 = A_12_2 + A_12_5 + A_21_2 + A_21_5;
2715                                    const double tmp20_0 = A_21_2 + A_21_5;
2716                                    const double tmp55_0 = A_21_2 + A_21_4;
2717                                    const double tmp208_0 = A_12_1 + A_12_6 + A_21_0 + A_21_7;
2718                                    const double tmp125_0 = A_12_4 + A_12_5;
2719                                    const double tmp158_0 = A_01_0 + A_01_7 + A_10_0 + A_10_7;
2720                                    const double tmp108_0 = A_01_1 + A_01_5 + A_10_1 + A_10_5;
2721                                    const double tmp199_0 = A_12_2 + A_12_4 + A_21_2 + A_21_4;
2722                                    const double tmp10_0 = A_02_1 + A_02_4;
2723                                    const double tmp182_0 = A_02_3 + A_02_6 + A_20_3 + A_20_6;
2724                                    const double tmp132_0 = A_02_1 + A_20_4;
2725                                    const double tmp191_0 = A_12_3 + A_12_4 + A_21_3 + A_21_4;
2726                                    const double tmp35_0 = A_11_0 + A_11_1 + A_11_2 + A_11_3;
2727                                    const double tmp164_0 = A_10_3 + A_10_4;
2728                                    const double tmp190_0 = A_12_5 + A_21_5;
2729                                    const double tmp73_0 = A_02_1 + A_02_6;
2730                                    const double tmp98_0 = A_01_0 + A_01_7 + A_10_3 + A_10_4;
2731                                    const double tmp225_0 = A_12_4 + A_21_2;
2732                                    const double tmp103_0 = A_02_4 + A_02_6;
2733                                    const double tmp194_0 = A_02_0 + A_02_7 + A_20_0 + A_20_7;
2734                                    const double tmp207_0 = A_12_0 + A_21_6;
2735                                    const double tmp102_0 = A_20_5 + A_20_7;
2736                                    const double tmp1_0 = A_22_3 + A_22_7;
2737                                    const double tmp172_0 = A_10_1 + A_10_5;
2738                                    const double tmp222_0 = A_12_5 + A_21_3;
2739                                    const double tmp201_0 = A_02_2 + A_02_5 + A_20_2 + A_20_5;
2740                                    const double tmp155_0 = A_12_4 + A_21_4;
2741                                    const double tmp174_0 = A_02_1 + A_02_4 + A_20_1 + A_20_4;
2742                                    const double tmp59_0 = A_01_0 + A_01_3;
2743                                    const double tmp21_0 = A_20_2 + A_20_7;
2744                                    const double tmp141_0 = A_02_2 + A_02_7 + A_20_2 + A_20_7;
2745                                    const double tmp210_0 = A_01_1 + A_10_1;
2746                                    const double tmp145_0 = A_00_0 + A_00_1;
2747                                    const double tmp121_0 = A_12_0 + A_12_1 + A_21_6 + A_21_7;
2748                                    const double tmp224_0 = A_12_3 + A_12_4 + A_21_2 + A_21_5;
2749                                    const double tmp186_0 = A_02_2 + A_20_7;
2750                                    const double tmp53_0 = A_11_4 + A_11_6;
2751                                    const double tmp184_0 = A_02_5 + A_20_0;
2752                                    const double tmp38_0 = A_12_0 + A_12_1;
2753                                    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;
2754                                    const double tmp230_0 = A_12_6 + A_21_0;
2755                                    const double tmp23_0 = A_11_4 + A_11_5 + A_11_6 + A_11_7;
2756                                    const double tmp81_0 = A_20_1 + A_20_4;
2757                                    const double tmp134_0 = A_10_3 + A_10_7;
2758                                    const double tmp129_0 = A_21_0 + A_21_1;
2759                                    const double tmp137_0 = A_01_0 + A_01_3 + A_01_4 + A_01_7;
2760                                    const double tmp198_0 = A_01_0 + A_10_0;
2761                                    const double tmp9_0 = A_21_1 + A_21_7;
2762                                    const double tmp179_0 = A_01_0 + A_01_4;
2763                                    const double tmp100_0 = A_20_1 + A_20_3 + A_20_4 + A_20_6;
2764                                    const double tmp173_0 = A_02_0 + A_20_5;
2765                                    const double tmp42_0 = A_21_0 + A_21_1 + A_21_6 + A_21_7;
2766                                    const double tmp226_0 = A_12_3 + A_21_5;
2767                                    const double tmp6_0 = A_22_0 + A_22_4;
2768                                    const double tmp218_0 = A_12_1 + A_21_1;
2769                                    const double tmp28_0 = A_01_2 + A_10_1;
2770                                    const double tmp133_0 = A_02_6 + A_20_3;
2771                                    const double tmp13_0 = A_00_2 + A_00_3 + A_00_6 + A_00_7;
2772                                    const double tmp27_0 = A_12_2 + A_12_3 + A_12_4 + A_12_5;
2773                                    const double tmp75_0 = A_10_1 + A_10_6;
2774                                    const double tmp36_0 = A_01_0 + A_01_3 + A_10_0 + A_10_3;
2775                                    const double tmp138_0 = A_10_0 + A_10_4;
2776                                    const double tmp189_0 = A_12_2 + A_21_2;
2777                                    const double tmp181_0 = A_02_7 + A_20_2;
2778                                    const double tmp85_0 = A_02_1 + A_02_3 + A_20_4 + A_20_6;
2779                                    const double tmp122_0 = A_01_1 + A_10_2;
2780                                    const double tmp95_0 = A_01_3 + A_10_0;
2781                                    const double tmp120_0 = A_12_6 + A_12_7 + A_21_0 + A_21_1;
2782                                    const double tmp196_0 = A_02_0 + A_20_0;
2783                                    const double tmp171_0 = A_02_3 + A_02_4;
2784                                    const double tmp204_0 = A_12_1 + A_12_6 + A_21_1 + A_21_6;
2785                                    const double tmp45_0 = A_10_1 + A_10_2;
2786                                    const double tmp101_0 = A_01_5 + A_01_6 + A_10_5 + A_10_6;
2787                                    const double tmp58_0 = A_11_0 + A_11_2 + A_11_5 + A_11_7;
2788                                    const double tmp107_0 = A_20_3 + A_20_4;
2789                                    const double tmp30_0 = A_01_1 + A_01_6 + A_10_2 + A_10_5;
2790                                    const double tmp63_0 = A_12_2 + A_12_5;
2791                                    const double tmp127_0 = A_12_2 + A_12_3;
2792                                    const double tmp177_0 = A_02_2 + A_02_5 + A_20_0 + A_20_7;
2793                                    const double tmp178_0 = A_10_0 + A_10_3 + A_10_4 + A_10_7;
2794                                    const double tmp76_0 = A_01_1 + A_01_2;
2795                                    const double tmp80_0 = A_22_2 + A_22_3 + A_22_6 + A_22_7;
2796                                    const double tmp41_0 = A_12_6 + A_12_7;
2797                                    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;
2798                                    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;
2799                                    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;
2800                                    const double tmp169_0 = A_21_3 + A_21_4;
2801                                    const double tmp96_0 = A_20_0 + A_20_2;
2802                                    const double tmp111_0 = A_12_3 + A_12_4;
2803                                    const double tmp118_0 = A_20_2 + A_20_5;
2804                                    const double tmp19_0 = A_12_3 + A_12_5;
2805                                    const double tmp68_0 = A_01_5 + A_01_6;
2806                                    const double tmp7_0 = A_11_1 + A_11_3 + A_11_5 + A_11_7;
2807                                    const double tmp154_0 = A_12_3 + A_21_3;
2808                                    const double tmp152_0 = A_02_4 + A_20_4;
2809                                    const double tmp153_0 = A_02_3 + A_20_3;
2810                                    const double tmp163_0 = A_02_5 + A_02_7 + A_20_5 + A_20_7;
2811                                    const double tmp44_0 = A_01_4 + A_01_7;
2812                                    const double tmp39_0 = A_02_1 + A_02_3 + A_02_4 + A_02_6;
2813                                    const double tmp123_0 = A_21_2 + A_21_3 + A_21_4 + A_21_5;
2814                                    const double tmp40_0 = A_02_5 + A_02_7;
2815                                    const double tmp110_0 = A_02_0 + A_02_7;
2816                                    const double tmp77_0 = A_12_2 + A_12_3 + A_21_2 + A_21_3;
2817                                    const double tmp209_0 = A_12_7 + A_21_1;
2818                                    const double tmp219_0 = A_02_4 + A_20_1;
2819                                    const double tmp84_0 = A_01_1 + A_01_5 + A_10_2 + A_10_6;
2820                                    const double tmp162_0 = A_12_1 + A_12_7 + A_21_1 + A_21_7;
2821                                    const double tmp159_0 = A_01_3 + A_10_3;
2822                                    const double tmp56_0 = A_11_1 + A_11_3;
2823                                    const double tmp52_0 = A_01_2 + A_01_5;
2824                                    const double tmp26_0 = A_00_4 + A_00_5 + A_00_6 + A_00_7;
2825                                    const double tmp229_0 = A_12_0 + A_12_7 + A_21_1 + A_21_6;
2826                                    const double tmp151_0 = A_10_2 + A_10_5;
2827                                    const double tmp136_0 = A_02_0 + A_02_5 + A_20_0 + A_20_5;
2828                                    const double tmp128_0 = A_21_6 + A_21_7;
2829                                    const double tmp15_0 = A_12_2 + A_12_4;
2830                                    const double tmp296_1 = tmp159_0*w42;
2831                                    const double tmp130_1 = tmp67_0*w5;
2832                                    const double tmp98_1 = A_01_6*w42;
2833                                    const double tmp231_1 = tmp125_0*w6;
2834                                    const double tmp42_1 = tmp34_0*w12;
2835                                    const double tmp199_1 = A_02_5*w28;
2836                                    const double tmp113_1 = tmp29_0*w13;
2837                                    const double tmp330_1 = tmp152_0*w28;
2838                                    const double tmp90_1 = A_01_1*w46;
2839                                    const double tmp446_1 = tmp77_0*w22;
2840                                    const double tmp108_1 = tmp43_0*w5;
2841                                    const double tmp524_1 = A_12_6*w29;
2842                                    const double tmp232_1 = tmp126_0*w34;
2843                                    const double tmp33_1 = tmp25_0*w37;
2844                                    const double tmp461_1 = tmp180_0*w1;
2845                                    const double tmp14_1 = tmp8_0*w6;
2846                                    const double tmp447_1 = tmp205_0*w26;
2847                                    const double tmp452_1 = tmp198_0*w42;
2848                                    const double tmp217_1 = tmp81_0*w9;
2849                                    const double tmp76_1 = tmp59_0*w20;
2850                                    const double tmp421_1 = tmp134_0*w31;
2851                                    const double tmp485_1 = tmp51_0*w51;
2852                                    const double tmp240_1 = tmp131_0*w1;
2853                                    const double tmp160_1 = tmp91_0*w9;
2854                                    const double tmp174_1 = A_20_1*w26;
2855                                    const double tmp273_1 = A_10_1*w46;
2856                                    const double tmp159_1 = tmp90_0*w47;
2857                                    const double tmp228_1 = tmp103_0*w5;
2858                                    const double tmp313_1 = tmp166_0*w45;
2859                                    const double tmp45_1 = tmp37_0*w30;
2860                                    const double tmp512_1 = tmp147_0*w13;
2861                                    const double tmp73_1 = tmp56_0*w43;
2862                                    const double tmp61_1 = A_01_6*w46;
2863                                    const double tmp316_1 = tmp167_0*w43;
2864                                    const double tmp189_1 = tmp112_0*w20;
2865                                    const double tmp455_1 = tmp215_0*w39;
2866                                    const double tmp360_1 = A_21_5*w24;
2867                                    const double tmp258_1 = A_20_7*w2;
2868                                    const double tmp196_1 = A_20_6*w26;
2869                                    const double tmp37_1 = tmp29_0*w6;
2870                                    const double tmp9_1 = A_12_7*w29;
2871                                    const double tmp80_1 = tmp63_0*w19;
2872                                    const double tmp312_1 = tmp165_0*w8;
2873                                    const double tmp264_1 = tmp101_0*w1;
2874                                    const double tmp124_1 = A_02_3*w26;
2875                                    const double tmp229_1 = tmp123_0*w11;
2876                                    const double tmp333_1 = tmp159_0*w46;
2877                                    const double tmp533_1 = tmp222_0*w4;
2878                                    const double tmp201_1 = tmp108_0*w37;
2879                                    const double tmp444_1 = tmp35_0*w10;
2880                                    const double tmp51_1 = tmp43_0*w18;
2881                                    const double tmp214_1 = A_21_7*w29;
2882                                    const double tmp518_1 = tmp86_0*w37;
2883                                    const double tmp192_1 = tmp115_0*w5;
2884                                    const double tmp355_1 = A_21_2*w27;
2885                                    const double tmp156_1 = tmp87_0*w22;
2886                                    const double tmp516_1 = tmp230_0*w27;
2887                                    const double tmp366_1 = tmp104_0*w57;
2888                                    const double tmp271_1 = tmp146_0*w49;
2889                                    const double tmp437_1 = tmp218_0*w24;
2890                                    const double tmp436_1 = tmp104_0*w54;
2891                                    const double tmp167_1 = tmp98_0*w8;
2892                                    const double tmp136_1 = tmp70_0*w34;
2893                                    const double tmp406_1 = tmp207_0*w27;
2894                                    const double tmp193_1 = tmp116_0*w12;
2895                                    const double tmp486_1 = tmp225_0*w29;
2896                                    const double tmp469_1 = tmp224_0*w11;
2897                                    const double tmp287_1 = tmp71_0*w53;
2898                                    const double tmp430_1 = tmp213_0*w28;
2899                                    const double tmp462_1 = tmp220_0*w2;
2900                                    const double tmp294_1 = tmp53_0*w59;
2901                                    const double tmp218_1 = tmp118_0*w16;
2902                                    const double tmp116_1 = tmp25_0*w31;
2903                                    const double tmp495_1 = tmp76_0*w37;
2904                                    const double tmp501_1 = tmp99_0*w46;
2905                                    const double tmp0_1 = tmp0_0*w1;
2906                                    const double tmp99_1 = tmp62_0*w17;
2907                                    const double tmp429_1 = tmp212_0*w2;
2908                                    const double tmp249_1 = tmp136_0*w9;
2909                                    const double tmp504_1 = tmp229_0*w19;
2910                                    const double tmp197_1 = A_12_2*w27;
2911                                    const double tmp531_1 = tmp122_0*w35;
2912                                    const double tmp265_1 = tmp142_0*w46;
2913                                    const double tmp488_1 = tmp226_0*w4;
2914                                    const double tmp528_1 = tmp115_0*w18;
2915                                    const double tmp438_1 = tmp219_0*w2;
2916                                    const double tmp233_1 = tmp127_0*w13;
2917                                    const double tmp491_1 = tmp79_0*w1;
2918                                    const double tmp215_1 = A_21_0*w4;
2919                                    const double tmp24_1 = tmp18_0*w21;
2920                                    const double tmp538_1 = tmp209_0*w27;
2921                                    const double tmp379_1 = tmp167_0*w55;
2922                                    const double tmp332_1 = tmp154_0*w4;
2923                                    const double tmp498_1 = tmp68_0*w31;
2924                                    const double tmp41_1 = tmp33_0*w33;
2925                                    const double tmp464_1 = tmp179_0*w37;
2926                                    const double tmp317_1 = tmp168_0*w40;
2927                                    const double tmp378_1 = tmp106_0*w54;
2928                                    const double tmp184_1 = tmp109_0*w14;
2929                                    const double tmp292_1 = tmp14_0*w33;
2930                                    const double tmp11_1 = tmp5_0*w11;
2931                                    const double tmp354_1 = A_02_6*w26;
2932                                    const double tmp84_1 = tmp37_0*w0;
2933                                    const double tmp422_1 = tmp13_0*w30;
2934                                    const double tmp132_1 = tmp69_0*w11;
2935                                    const double tmp251_1 = tmp138_0*w31;
2936                                    const double tmp18_1 = tmp12_0*w8;
2937                                    const double tmp88_1 = A_21_1*w4;
2938                                    const double tmp188_1 = A_12_2*w24;
2939                                    const double tmp465_1 = tmp175_0*w31;
2940                                    const double tmp235_1 = tmp128_0*w17;
2941                                    const double tmp323_1 = A_02_1*w26;
2942                                    const double tmp31_1 = tmp23_0*w38;
2943                                    const double tmp397_1 = tmp170_0*w5;
2944                                    const double tmp175_1 = tmp7_0*w3;
2945                                    const double tmp148_1 = tmp81_0*w21;
2946                                    const double tmp238_1 = tmp130_0*w19;
2947                                    const double tmp59_1 = tmp46_0*w11;
2948                                    const double tmp432_1 = tmp215_0*w35;
2949                                    const double tmp398_1 = A_01_2*w46;
2950                                    const double tmp497_1 = A_10_5*w46;
2951                                    const double tmp28_1 = tmp21_0*w18;
2952                                    const double tmp115_1 = tmp23_0*w32;
2953                                    const double tmp441_1 = tmp23_0*w3;
2954                                    const double tmp131_1 = tmp68_0*w37;
2955                                    const double tmp289_1 = tmp155_0*w4;
2956                                    const double tmp278_1 = tmp80_0*w44;
2957                                    const double tmp5_1 = A_21_4*w27;
2958                                    const double tmp254_1 = tmp140_0*w20;
2959                                    const double tmp183_1 = tmp108_0*w31;
2960                                    const double tmp279_1 = tmp151_0*w8;
2961                                    const double tmp298_1 = tmp161_0*w16;
2962                                    const double tmp505_1 = tmp230_0*w24;
2963                                    const double tmp246_1 = tmp80_0*w52;
2964                                    const double tmp100_1 = tmp53_0*w43;
2965                                    const double tmp440_1 = tmp221_0*w16;
2966                                    const double tmp481_1 = tmp188_0*w23;
2967                                    const double tmp480_1 = tmp187_0*w35;
2968                                    const double tmp384_1 = tmp150_0*w53;
2969                                    const double tmp142_1 = tmp76_0*w31;
2970                                    const double tmp372_1 = tmp191_0*w11;
2971                                    const double tmp307_1 = A_10_7*w35;
2972                                    const double tmp186_1 = tmp111_0*w19;
2973                                    const double tmp127_1 = A_20_2*w2;
2974                                    const double tmp391_1 = tmp167_0*w59;
2975                                    const double tmp223_1 = tmp113_0*w20;
2976                                    const double tmp454_1 = tmp197_0*w24;
2977                                    const double tmp241_1 = tmp74_0*w51;
2978                                    const double tmp529_1 = tmp114_0*w5;
2979                                    const double tmp202_1 = tmp104_0*w7;
2980                                    const double tmp236_1 = tmp96_0*w21;
2981                                    const double tmp358_1 = tmp183_0*w11;
2982                                    const double tmp102_1 = tmp51_0*w41;
2983                                    const double tmp493_1 = A_20_5*w2;
2984                                    const double tmp468_1 = tmp223_0*w4;
2985                                    const double tmp435_1 = tmp217_0*w16;
2986                                    const double tmp110_1 = tmp37_0*w36;
2987                                    const double tmp479_1 = tmp189_0*w4;
2988                                    const double tmp120_1 = tmp38_0*w22;
2989                                    const double tmp16_1 = tmp10_0*w9;
2990                                    const double tmp407_1 = tmp90_0*w53;
2991                                    const double tmp442_1 = tmp66_0*w48;
2992                                    const double tmp60_1 = A_10_4*w35;
2993                                    const double tmp69_1 = tmp53_0*w45;
2994                                    const double tmp144_1 = tmp77_0*w17;
2995                                    const double tmp507_1 = tmp146_0*w48;
2996                                    const double tmp424_1 = tmp174_0*w18;
2997                                    const double tmp352_1 = tmp181_0*w23;
2998                                    const double tmp451_1 = tmp199_0*w13;
2999                                    const double tmp253_1 = tmp139_0*w16;
3000                                    const double tmp353_1 = tmp182_0*w18;
3001                                    const double tmp521_1 = tmp88_0*w22;
3002                                    const double tmp346_1 = tmp175_0*w37;
3003                                    const double tmp416_1 = tmp138_0*w37;
3004                                    const double tmp324_1 = A_10_0*w35;
3005                                    const double tmp152_1 = tmp84_0*w37;
3006                                    const double tmp119_1 = tmp32_0*w21;
3007                                    const double tmp86_1 = A_21_6*w29;
3008                                    const double tmp290_1 = tmp156_0*w11;
3009                                    const double tmp382_1 = tmp196_0*w26;
3010                                    const double tmp91_1 = tmp49_0*w6;
3011                                    const double tmp499_1 = A_10_2*w42;
3012                                    const double tmp226_1 = tmp121_0*w13;
3013                                    const double tmp477_1 = tmp195_0*w26;
3014                                    const double tmp150_1 = A_02_4*w23;
3015                                    const double tmp318_1 = tmp15_0*w22;
3016                                    const double tmp396_1 = tmp206_0*w24;
3017                                    const double tmp474_1 = A_02_0*w28;
3018                                    const double tmp245_1 = tmp134_0*w37;
3019                                    const double tmp3_1 = A_20_4*w26;
3020                                    const double tmp44_1 = tmp36_0*w31;
3021                                    const double tmp487_1 = tmp60_0*w52;
3022                                    const double tmp293_1 = tmp158_0*w8;
3023                                    const double tmp314_1 = A_01_2*w42;
3024                                    const double tmp414_1 = tmp80_0*w51;
3025                                    const double tmp472_1 = A_21_3*w27;
3026                                    const double tmp321_1 = A_21_2*w24;
3027                                    const double tmp225_1 = tmp120_0*w6;
3028                                    const double tmp377_1 = tmp166_0*w59;
3029                                    const double tmp413_1 = tmp186_0*w26;
3030                                    const double tmp385_1 = tmp166_0*w55;
3031                                    const double tmp310_1 = tmp164_0*w34;
3032                                    const double tmp158_1 = tmp89_0*w34;
3033                                    const double tmp449_1 = tmp203_0*w46;
3034                                    const double tmp439_1 = tmp220_0*w28;
3035                                    const double tmp22_1 = tmp16_0*w16;
3036                                    const double tmp164_1 = tmp95_0*w46;
3037                                    const double tmp417_1 = tmp74_0*w52;
3038                                    const double tmp257_1 = tmp6_0*w25;
3039                                    const double tmp203_1 = tmp18_0*w9;
3040                                    const double tmp286_1 = tmp153_0*w28;
3041                                    const double tmp155_1 = tmp33_0*w14;
3042                                    const double tmp389_1 = tmp201_0*w12;
3043                                    const double tmp508_1 = tmp145_0*w49;
3044                                    const double tmp300_1 = tmp56_0*w55;
3045                                    const double tmp299_1 = tmp162_0*w22;
3046                                    const double tmp173_1 = tmp104_0*w25;
3047                                    const double tmp32_1 = tmp24_0*w5;
3048                                    const double tmp227_1 = tmp122_0*w39;
3049                                    const double tmp484_1 = tmp3_0*w38;
3050                                    const double tmp171_1 = tmp102_0*w21;
3051                                    const double tmp478_1 = tmp190_0*w29;
3052                                    const double tmp320_1 = tmp170_0*w18;
3053                                    const double tmp327_1 = tmp6_0*w57;
3054                                    const double tmp490_1 = tmp7_0*w32;
3055                                    const double tmp419_1 = tmp127_0*w6;
3056                                    const double tmp463_1 = tmp219_0*w28;
3057                                    const double tmp12_1 = tmp6_0*w7;
3058                                    const double tmp49_1 = tmp41_0*w22;
3059                                    const double tmp344_1 = tmp173_0*w26;
3060                                    const double tmp243_1 = tmp132_0*w2;
3061                                    const double tmp83_1 = A_10_4*w39;
3062                                    const double tmp297_1 = tmp160_0*w17;
3063                                    const double tmp275_1 = tmp148_0*w34;
3064                                    const double tmp168_1 = tmp99_0*w42;
3065                                    const double tmp409_1 = tmp3_0*w32;
3066                                    const double tmp1_1 = tmp1_0*w25;
3067                                    const double tmp426_1 = tmp210_0*w39;
3068                                    const double tmp375_1 = tmp109_0*w33;
3069                                    const double tmp50_1 = tmp42_0*w19;
3070                                    const double tmp513_1 = A_10_1*w42;
3071                                    const double tmp97_1 = tmp45_0*w31;
3072                                    const double tmp403_1 = tmp140_0*w1;
3073                                    const double tmp71_1 = A_01_1*w42;
3074                                    const double tmp520_1 = tmp84_0*w31;
3075                                    const double tmp510_1 = A_10_6*w46;
3076                                    const double tmp302_1 = A_10_0*w39;
3077                                    const double tmp364_1 = tmp128_0*w22;
3078                                    const double tmp515_1 = tmp142_0*w42;
3079                                    const double tmp283_1 = tmp65_0*w56;
3080                                    const double tmp222_1 = tmp112_0*w1;
3081                                    const double tmp428_1 = tmp211_0*w27;
3082                                    const double tmp371_1 = tmp190_0*w4;
3083                                    const double tmp423_1 = tmp184_0*w23;
3084                                    const double tmp276_1 = tmp149_0*w13;
3085                                    const double tmp65_1 = tmp50_0*w9;
3086                                    const double tmp305_1 = A_12_0*w29;
3087                                    const double tmp170_1 = tmp101_0*w20;
3088                                    const double tmp350_1 = tmp179_0*w31;
3089                                    const double tmp466_1 = tmp172_0*w20;
3090                                    const double tmp361_1 = tmp184_0*w26;
3091                                    const double tmp431_1 = tmp214_0*w19;
3092                                    const double tmp363_1 = tmp129_0*w17;
3093                                    const double tmp178_1 = A_02_2*w28;
3094                                    const double tmp527_1 = tmp120_0*w13;
3095                                    const double tmp415_1 = tmp182_0*w5;
3096                                    const double tmp450_1 = tmp200_0*w6;
3097                                    const double tmp269_1 = A_01_7*w39;
3098                                    const double tmp285_1 = tmp152_0*w2;
3099                                    const double tmp272_1 = A_01_0*w35;
3100                                    const double tmp339_1 = tmp136_0*w21;
3101                                    const double tmp502_1 = tmp95_0*w42;
3102                                    const double tmp38_1 = tmp30_0*w34;
3103                                    const double tmp514_1 = tmp144_0*w46;
3104                                    const double tmp96_1 = tmp56_0*w45;
3105                                    const double tmp399_1 = tmp167_0*w45;
3106                                    const double tmp483_1 = tmp173_0*w23;
3107                                    const double tmp522_1 = tmp87_0*w17;
3108                                    const double tmp519_1 = tmp91_0*w21;
3109                                    const double tmp209_1 = A_12_5*w24;
3110                                    const double tmp126_1 = tmp65_0*w48;
3111                                    const double tmp367_1 = tmp187_0*w39;
3112                                    const double tmp221_1 = tmp67_0*w18;
3113                                    const double tmp381_1 = tmp146_0*w56;
3114                                    const double tmp70_1 = tmp54_0*w31;
3115                                    const double tmp216_1 = tmp117_0*w11;
3116                                    const double tmp473_1 = A_02_7*w2;
3117                                    const double tmp149_1 = tmp82_0*w22;
3118                                    const double tmp357_1 = A_12_6*w4;
3119                                    const double tmp534_1 = tmp226_0*w29;
3120                                    const double tmp95_1 = tmp26_0*w15;
3121                                    const double tmp500_1 = tmp64_0*w20;
3122                                    const double tmp387_1 = tmp199_0*w6;
3123                                    const double tmp471_1 = A_20_4*w23;
3124                                    const double tmp281_1 = tmp74_0*w41;
3125                                    const double tmp351_1 = tmp180_0*w20;
3126                                    const double tmp63_1 = tmp48_0*w34;
3127                                    const double tmp365_1 = tmp186_0*w23;
3128                                    const double tmp448_1 = tmp206_0*w27;
3129                                    const double tmp39_1 = tmp31_0*w13;
3130                                    const double tmp453_1 = tmp196_0*w23;
3131                                    const double tmp402_1 = tmp163_0*w18;
3132                                    const double tmp137_1 = tmp71_0*w47;
3133                                    const double tmp6_1 = A_02_0*w2;
3134                                    const double tmp34_1 = tmp26_0*w36;
3135                                    const double tmp383_1 = tmp197_0*w27;
3136                                    const double tmp166_1 = tmp97_0*w12;
3137                                    const double tmp114_1 = tmp40_0*w9;
3138                                    const double tmp306_1 = A_12_7*w4;
3139                                    const double tmp530_1 = tmp124_0*w39;
3140                                    const double tmp388_1 = tmp200_0*w13;
3141                                    const double tmp252_1 = tmp2_0*w30;
3142                                    const double tmp210_1 = A_02_4*w26;
3143                                    const double tmp200_1 = tmp21_0*w5;
3144                                    const double tmp181_1 = tmp3_0*w10;
3145                                    const double tmp425_1 = tmp106_0*w57;
3146                                    const double tmp261_1 = A_21_7*w4;
3147                                    const double tmp64_1 = tmp49_0*w13;
3148                                    const double tmp506_1 = A_01_0*w39;
3149                                    const double tmp457_1 = tmp213_0*w2;
3150                                    const double tmp2_1 = tmp2_0*w0;
3151                                    const double tmp393_1 = tmp203_0*w42;
3152                                    const double tmp133_1 = A_01_3*w35;
3153                                    const double tmp147_1 = tmp80_0*w41;
3154                                    const double tmp8_1 = tmp4_0*w5;
3155                                    const double tmp267_1 = tmp144_0*w42;
3156                                    const double tmp17_1 = tmp11_0*w12;
3157                                    const double tmp284_1 = tmp58_0*w50;
3158                                    const double tmp328_1 = tmp66_0*w56;
3159                                    const double tmp405_1 = tmp60_0*w51;
3160                                    const double tmp467_1 = tmp222_0*w29;
3161                                    const double tmp535_1 = tmp225_0*w4;