Salome HOME
33c65b32a934292f67c9d2e26eccbeac8a88ed11
[tools/medcoupling.git] / src / INTERP_KERNEL / MappedBarycentric3DIntersectorP1P1.txx
1 // Copyright (C) 2007-2020  CEA/DEN, EDF R&D
2 //
3 // This library is free software; you can redistribute it and/or
4 // modify it under the terms of the GNU Lesser General Public
5 // License as published by the Free Software Foundation; either
6 // version 2.1 of the License, or (at your option) any later version.
7 //
8 // This library is distributed in the hope that it will be useful,
9 // but WITHOUT ANY WARRANTY; without even the implied warranty of
10 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
11 // Lesser General Public License for more details.
12 //
13 // You should have received a copy of the GNU Lesser General Public
14 // License along with this library; if not, write to the Free Software
15 // Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
16 //
17 // See http://www.salome-platform.org/ or email : webmaster.salome@opencascade.com
18 //
19 // Author : Adrien Bruneton (CEA/DEN)
20
21 #ifndef __MAPPEDBARYCENTRIC3DINTERSECTORP1P1_TXX__
22 #define __MAPPEDBARYCENTRIC3DINTERSECTORP1P1_TXX__
23
24 #include "MappedBarycentric3DIntersectorP1P1.hxx"
25 #include "Intersector3DP1P1.txx"
26 #include "MeshUtils.hxx"
27
28 namespace INTERP_KERNEL
29 {
30
31   /**
32    * Constructor creating object from target cell global number 
33    * 
34    * @param targetMesh  mesh containing the target elements
35    * @param srcMesh     mesh containing the source elements
36    */
37   template<class MyMeshType, class MyMatrix>
38   MappedBarycentric3DIntersectorP1P1<MyMeshType,MyMatrix>::MappedBarycentric3DIntersectorP1P1(const MyMeshType& targetMesh, const MyMeshType& srcMesh, double precision):
39     Intersector3DP1P1<MyMeshType,MyMatrix>(targetMesh,srcMesh),_precision(precision)
40   {
41   }
42
43   template<class MyMeshType, class MyMatrix>
44   MappedBarycentric3DIntersectorP1P1<MyMeshType,MyMatrix>::~MappedBarycentric3DIntersectorP1P1()
45   {
46   }
47
48   /**
49    * @param targetCell in C mode.
50    * @param srcCells in C mode.
51    */
52   template<class MyMeshType, class MyMatrix>
53   void MappedBarycentric3DIntersectorP1P1<MyMeshType,MyMatrix>::intersectCells(ConnType targetCell, const std::vector<ConnType>& srcCells, MyMatrix& res)
54   {
55     std::vector<double> CoordsT;
56     const ConnType *startOfCellNodeConnT=Intersector3DP1P1<MyMeshType,MyMatrix>::getStartConnOfTargetCell(targetCell);
57     Intersector3DP1P1<MyMeshType,MyMatrix>::getRealTargetCoordinates(OTT<ConnType,numPol>::indFC(targetCell),CoordsT);
58     std::size_t nbOfNodesT=CoordsT.size()/SPACEDIM;
59     const double *coordsS=Intersector3DP1P1<MyMeshType,MyMatrix>::_src_mesh.getCoordinatesPtr();
60     for(std::size_t nodeIdT=0;nodeIdT<nbOfNodesT;nodeIdT++)
61       {
62         typename MyMatrix::value_type& resRow=res[OTT<ConnType,numPol>::ind2C(startOfCellNodeConnT[nodeIdT])];
63         if(!resRow.empty())
64           continue;
65         for(typename std::vector<ConnType>::const_iterator iterCellS=srcCells.begin();iterCellS!=srcCells.end();iterCellS++)
66           {
67             NormalizedCellType tS=Intersector3DP1P1<MyMeshType,MyMatrix>::_src_mesh.getTypeOfElement(OTT<ConnType,numPol>::indFC(*iterCellS));
68             if(tS!=NORM_HEXA8)
69               throw INTERP_KERNEL::Exception("Invalid source cell detected for meshdim==3. Only HEXA8 supported !");
70             const CellModel& cmTypeS=CellModel::GetCellModel(tS);
71             //
72             std::vector<ConnType> connOfCurCellS;
73             Intersector3DP1P1<MyMeshType,MyMatrix>::getConnOfSourceCell(OTT<ConnType,numPol>::indFC(*iterCellS),connOfCurCellS);
74             if( PointLocatorAlgos<MyMeshType>::isElementContainsPointAlg3D(&CoordsT[nodeIdT*SPACEDIM],&connOfCurCellS[0],ToConnType(connOfCurCellS.size()),coordsS,cmTypeS,_precision) )
75               {
76                 double mco[3];  // mapped coordinates in the hexa8
77                 std::vector<double> localCoordsS;
78                 Intersector3DP1P1<MyMeshType,MyMatrix>::getRealSourceCoordinates(OTT<ConnType,numPol>::indFC(*iterCellS),localCoordsS);
79                 std::vector<const double*> coo(8);
80                 coo[0]=&localCoordsS[0]; coo[1]=&localCoordsS[3]; coo[2]=&localCoordsS[6]; coo[3]=&localCoordsS[9];
81                 coo[4]=&localCoordsS[12]; coo[5]=&localCoordsS[15]; coo[6]=&localCoordsS[18]; coo[7]=&localCoordsS[21];
82                 cuboid_mapped_coords(coo,&CoordsT[nodeIdT*SPACEDIM],mco);
83
84                 // Now use the form function of the HEXA8 to map the field values
85                 double resLoc[8];
86                 // See HEXA8 standard connectivity and cuboid_mapped_coords() convention:
87                 resLoc[5] = (1.-mco[0]) * (1.-mco[1]) * (1.-mco[2]);
88                 resLoc[6] =  mco[0]     * (1.-mco[1]) * (1.-mco[2]);
89                 resLoc[7] =  mco[0]     *   mco[1]    * (1.-mco[2]);
90                 resLoc[4] = (1.-mco[0]) *   mco[1]    * (1.-mco[2]);
91
92                 resLoc[1] = (1.-mco[0]) * (1.-mco[1]) * mco[2];
93                 resLoc[2] =  mco[0]     * (1.-mco[1]) * mco[2];
94                 resLoc[3] =  mco[0]     *   mco[1]    * mco[2];
95                 resLoc[0] = (1.-mco[0]) *   mco[1]    * mco[2];
96
97                 const ConnType *startOfCellNodeConnS=Intersector3DP1P1<MyMeshType,MyMatrix>::getStartConnOfSourceCell(*iterCellS);
98                 for(int nodeIdS=0;nodeIdS<8;nodeIdS++)
99                   {
100                     if(fabs(resLoc[nodeIdS])>_precision)
101                       {
102                         ConnType curNodeSInCmode=OTT<ConnType,numPol>::coo2C(startOfCellNodeConnS[nodeIdS]);
103                         resRow.insert(std::make_pair(OTT<ConnType,numPol>::indFC(curNodeSInCmode),resLoc[nodeIdS]));
104                       }
105                   }
106               }
107           }
108       }
109   }
110 }
111
112 #endif