ViewVC Help
View File | Revision Log | Show Annotations | View Changeset | Root Listing
root/REPOS_ERICCA/magic/lib/geometrie/src/fem_tetra4.cpp
Revision: 222
Committed: Thu Nov 19 19:14:16 2009 UTC (15 years, 5 months ago) by francois
Original Path: magic/lib/geometrie/geometrie/src/fem_tetra4.cpp
File size: 8427 byte(s)
Log Message: 
Divers corrections : vectorisation  toxfem et extraction de peau.

File Contents

# User Rev Content
1 5 //------------------------------------------------------------
2     //------------------------------------------------------------
3     // MAGiC
4 francois 195 // Jean Christophe Cuilli�re et Vincent FRANCOIS
5     // D�partement de G�nie M�canique - UQTR
6 5 //------------------------------------------------------------
7 francois 195 // Le projet MAGIC est un projet de recherche du d�partement
8     // de g�nie m�canique de l'Universit� du Qu�bec �
9     // Trois Rivi�res
10     // Les librairies ne peuvent �tre utilis�es sans l'accord
11 5 // des auteurs (contact : francois@uqtr.ca)
12     //------------------------------------------------------------
13     //------------------------------------------------------------
14     //
15     // fem_tetra4.cpp
16     //
17     //------------------------------------------------------------
18     //------------------------------------------------------------
19     // COPYRIGHT 2000
20 francois 195 // Version du 02/03/2006 � 11H22
21 5 //------------------------------------------------------------
22     //------------------------------------------------------------
23    
24    
25     #include "gestionversion.h"
26     #include "fem_tetra4.h"
27     #include "fem_noeud.h"
28     #include "mg_element_maillage.h"
29     #include "fem_maillage.h"
30    
31    
32     FEM_TETRA4::FEM_TETRA4(unsigned long num,class MG_ELEMENT_MAILLAGE* mai,class FEM_NOEUD** tabnoeud):FEM_TETRA(num,mai),FEM_TEMPLATE_ELEMENT<4>(tabnoeud)
33     {
34 francois 195 if (liaison_topologique!=NULL)
35     if (liaison_topologique->get_dimension()==3) liaison_topologique->get_lien_fem_maillage()->ajouter(this);
36 5 tab[0]->get_lien_tetra()->ajouter(this);
37     tab[1]->get_lien_tetra()->ajouter(this);
38     tab[2]->get_lien_tetra()->ajouter(this);
39     tab[3]->get_lien_tetra()->ajouter(this);
40     get_fem_noeudpetitid()->get_lien_petit_tetra()->ajouter(this);
41     }
42    
43     FEM_TETRA4::FEM_TETRA4(class MG_ELEMENT_MAILLAGE* mai,FEM_NOEUD** tabnoeud):FEM_TETRA(mai),FEM_TEMPLATE_ELEMENT<4>(tabnoeud)
44     {
45 francois 195 if (liaison_topologique!=NULL)
46     if (liaison_topologique->get_dimension()==3) liaison_topologique->get_lien_fem_maillage()->ajouter(this);
47 5 tab[0]->get_lien_tetra()->ajouter(this);
48     tab[1]->get_lien_tetra()->ajouter(this);
49     tab[2]->get_lien_tetra()->ajouter(this);
50     tab[3]->get_lien_tetra()->ajouter(this);
51     get_fem_noeudpetitid()->get_lien_petit_tetra()->ajouter(this);
52     }
53    
54     FEM_TETRA4::FEM_TETRA4(FEM_TETRA4& mdd):FEM_TETRA(mdd),FEM_TEMPLATE_ELEMENT<4>(mdd)
55     {
56 francois 195 if (liaison_topologique!=NULL) if (liaison_topologique->get_dimension()==3) liaison_topologique->get_lien_fem_maillage()->ajouter(this);
57 5 tab[0]->get_lien_tetra()->ajouter(this);
58     tab[1]->get_lien_tetra()->ajouter(this);
59     tab[2]->get_lien_tetra()->ajouter(this);
60     tab[3]->get_lien_tetra()->ajouter(this);
61     get_fem_noeudpetitid()->get_lien_petit_tetra()->ajouter(this);
62     }
63    
64     FEM_TETRA4::~FEM_TETRA4()
65     {
66     if (liaison_topologique==NULL) return;
67     if (liaison_topologique->get_dimension()==0) liaison_topologique->get_lien_fem_maillage()->supprimer(this);
68     tab[0]->get_lien_tetra()->supprimer(this);
69     tab[1]->get_lien_tetra()->supprimer(this);
70     tab[2]->get_lien_tetra()->supprimer(this);
71     tab[3]->get_lien_tetra()->supprimer(this);
72     get_fem_noeudpetitid()->get_lien_petit_tetra()->supprimer(this);
73     }
74    
75    
76     FEM_ELEMENT_MAILLAGE* FEM_TETRA4::dupliquer(FEM_MAILLAGE *femmai,long decalage)
77     {
78     FEM_NOEUD* tabnoeud[4];
79     tabnoeud[0]=femmai->get_fem_noeudid(tab[0]->get_id()+decalage);
80     tabnoeud[1]=femmai->get_fem_noeudid(tab[1]->get_id()+decalage);
81     tabnoeud[2]=femmai->get_fem_noeudid(tab[2]->get_id()+decalage);
82     tabnoeud[3]=femmai->get_fem_noeudid(tab[3]->get_id()+decalage);
83     FEM_TETRA4* tet=new FEM_TETRA4(get_id()+decalage,maillage,tabnoeud);
84     femmai->ajouter_fem_tetra(tet);
85     return tet;
86     }
87    
88    
89     int FEM_TETRA4::get_type_entite(void)
90     {
91     return IDFEM_TETRA4;
92     }
93    
94     int FEM_TETRA4::get_dimension(void)
95     {
96     return 3;
97     }
98    
99    
100     int FEM_TETRA4::get_nb_fem_noeud(void)
101     {
102     return FEM_TEMPLATE_ELEMENT<4>::get_nb_fem_noeud();
103     }
104    
105     FEM_NOEUD* FEM_TETRA4::get_fem_noeud(int num)
106     {
107     return FEM_TEMPLATE_ELEMENT<4>::get_fem_noeud(num);
108     }
109    
110     void FEM_TETRA4::change_noeud(int num,FEM_NOEUD* noeud)
111     {
112     FEM_TEMPLATE_ELEMENT<4>::change_noeud(num,noeud);
113     }
114    
115    
116     BOITE_3D& FEM_TETRA4::get_boite_3D(void)
117     {
118     return FEM_TEMPLATE_ELEMENT<4>::get_boite_3D();
119     }
120 francois 222 int FEM_TETRA4::nb_fonction_interpolation(void)
121     {
122     return 4;
123     }
124 5
125    
126 francois 222 double FEM_TETRA4::get_fonction_interpolation(int num,double *uv)
127     {
128     double val;
129     switch (num)
130     {
131     case 1:val=1-uv[0]-uv[1]-uv[2];break;
132     case 2:val=uv[0];break;
133     case 3:val=uv[1];break;
134     case 4:val=uv[2];break;
135     }
136     return val;
137     }
138    
139     double FEM_TETRA4::get_fonction_derive_interpolation(int num,int num_variable,double *uv)
140     {
141     double val;
142    
143     switch (num)
144     {
145     case 1:switch (num_variable)
146     {
147     case 1:val=-1;break;
148     case 2:val=-1;break;
149     case 3:val=-1;break;
150     } break;
151     case 2:switch (num_variable)
152     {
153     case 1:val=1;break;
154     case 2:val=0;break;
155     case 3:val=0;break;
156     }break;
157     case 3:switch (num_variable)
158     {
159     case 1:val=0;break;
160     case 2:val=1;break;
161     case 3:val=0;break;
162     }break;
163     case 4:switch (num_variable)
164     {
165     case 1:val=0;break;
166     case 2:val=0;break;
167     case 3:val=1;break;
168     }break;
169    
170     }
171     return val;
172     }
173    
174     double FEM_TETRA4::get_jacobien(double* jac,double *uv,int& li,int& col,double unite)
175     {
176     li=3;
177     col=3;
178     double *xyz1=tab[0]->get_coord();
179     double *xyz2=tab[1]->get_coord();
180     double *xyz3=tab[2]->get_coord();
181     double *xyz4=tab[3]->get_coord();
182    
183     jac[0]=unite*(xyz2[0] - xyz1[0]) ;
184     jac[1]=unite*(xyz2[1] - xyz1[1]) ;
185     jac[2]=unite*(xyz2[2] - xyz1[2]) ;
186    
187     jac[3]=unite*(xyz3[0] - xyz1[0]) ;
188     jac[4]=unite*(xyz3[1] - xyz1[1]) ;
189     jac[5]=unite*(xyz3[2] - xyz1[2]) ;
190    
191     jac[6]=unite*(xyz4[0] - xyz1[0]) ;
192     jac[7]=unite*(xyz4[1] - xyz1[1]) ;
193     jac[8]=unite*(xyz4[2] - xyz1[2]) ;
194    
195     double SIX_V= jac[0]*(jac[4]*jac[8]-jac[7]*jac[5])+jac[1]*(jac[5]*jac[6]-jac[8]*jac[3])+jac[2]*(jac[3]*jac[7]-jac[6]*jac[4]);
196    
197     return SIX_V;
198     }
199    
200     void FEM_TETRA4::get_inverse_jacob(double* j,double *uv,double unite)
201     {
202     double *xyz1=tab[0]->get_coord();
203     double *xyz2=tab[1]->get_coord();
204     double *xyz3=tab[2]->get_coord();
205     double *xyz4=tab[3]->get_coord();
206    
207     double jac[9];
208    
209     jac[0*3+0]= unite*(xyz2[0] - xyz1[0]) ;
210     jac[0*3+1]= unite*(xyz2[1] - xyz1[1]) ;
211     jac[0*3+2]= unite*(xyz2[2] - xyz1[2]) ;
212    
213     jac[1*3+0]= unite*(xyz3[0] - xyz1[0]) ;
214     jac[1*3+1]= unite*(xyz3[1] - xyz1[1]) ;
215     jac[1*3+2]= unite*(xyz3[2] - xyz1[2]) ;
216    
217     jac[2*3+0]= unite*(xyz4[0] - xyz1[0]) ;
218     jac[2*3+1]= unite*(xyz4[1] - xyz1[1]) ;
219     jac[2*3+2]= unite*(xyz4[2] - xyz1[2]) ;
220    
221     double detj=(jac[0*3+0]*jac[1*3+1]*jac[2*3+2]-jac[0*3+0]*jac[1*3+2]*jac[2*3+1]-jac[1*3+0]*jac[0*3+1]*jac[2*3+2]+jac[1*3+0]*jac[0*3+2]*jac[2*3+1]+jac[2*3+0]*jac[0*3+1]*jac[1*3+2]-jac[2*3+0]*jac[0*3+2]*jac[1*3+1]);
222    
223     j[0*3+0] = (jac[1*3+1]*jac[2*3+2]-jac[1*3+2]*jac[2*3+1])/(detj);
224     j[0*3+1] = -(jac[0*3+1]*jac[2*3+2]-jac[0*3+2]*jac[2*3+1])/(detj);
225     j[0*3+2] =-(-jac[0*3+1]*jac[1*3+2]+jac[0*3+2]*jac[1*3+1])/(detj);
226    
227     j[1*3+0] = -(jac[1*3+0]*jac[2*3+2]-jac[1*3+2]*jac[2*3+0])/(detj);
228     j[1*3+1] = (jac[0*3+0]*jac[2*3+2]-jac[0*3+2]*jac[2*3+0])/(detj);
229     j[1*3+2] = -(jac[0*3+0]*jac[1*3+2]-jac[0*3+2]*jac[1*3+0])/(detj);
230    
231     j[2*3+0] =-(-jac[1*3+0]*jac[2*3+1]+jac[1*3+1]*jac[2*3+0])/(detj);
232     j[2*3+1] = -(jac[0*3+0]*jac[2*3+1]-jac[0*3+1]*jac[2*3+0])/(detj);
233     j[2*3+2] = (jac[0*3+0]*jac[1*3+1]-jac[0*3+1]*jac[1*3+0])/(detj);
234    
235    
236    
237     }
238    
239    
240 5 void FEM_TETRA4::enregistrer(std::ostream& o)
241     {
242     if (get_lien_topologie()!=NULL) o << "%" << get_id() << "=FEM_TETRA4($"<< get_lien_topologie()->get_id() << ",$" << maillage->get_id() << ",$" << tab[0]->get_id() << ",$" << tab[1]->get_id() << ",$" << tab[2]->get_id() << ",$" << tab[3]->get_id() << ");" << std::endl;
243     else o << "%" << get_id() << "=FEM_TETRA4(NULL,$"<< maillage->get_id() << ",$" << tab[0]->get_id() << ",$" << tab[1]->get_id() << ",$" << tab[2]->get_id() << ",$" << tab[3]->get_id() << ");" << std::endl;
244    
245     }