1 |
francois |
283 |
//------------------------------------------------------------ |
2 |
|
|
//------------------------------------------------------------ |
3 |
|
|
// MAGiC |
4 |
|
|
// Jean Christophe Cuilli�e et Vincent FRANCOIS |
5 |
|
|
// D�artement de G�ie M�anique - UQTR |
6 |
|
|
//------------------------------------------------------------ |
7 |
|
|
// Le projet MAGIC est un projet de recherche du d�artement |
8 |
|
|
// de g�ie m�anique de l'Universit�du Qu�ec � |
9 |
|
|
// Trois Rivi�es |
10 |
|
|
// Les librairies ne peuvent �re utilis�s sans l'accord |
11 |
|
|
// des auteurs (contact : francois@uqtr.ca) |
12 |
|
|
//------------------------------------------------------------ |
13 |
|
|
//------------------------------------------------------------ |
14 |
|
|
// |
15 |
|
|
// fem_tetra.cpp |
16 |
|
|
// |
17 |
|
|
//------------------------------------------------------------ |
18 |
|
|
//------------------------------------------------------------ |
19 |
|
|
// COPYRIGHT 2000 |
20 |
|
|
// Version du 02/03/2006 �11H22 |
21 |
|
|
//------------------------------------------------------------ |
22 |
|
|
//------------------------------------------------------------ |
23 |
|
|
|
24 |
|
|
|
25 |
|
|
#include "gestionversion.h" |
26 |
|
|
#include <math.h> |
27 |
francois |
309 |
#include "fem_element3.h" |
28 |
francois |
339 |
#include "xfem_element3.h" |
29 |
francois |
283 |
#include "fem_noeud.h" |
30 |
francois |
339 |
#include "fem_maillage.h" |
31 |
francois |
283 |
#include "mg_element_maillage.h" |
32 |
francois |
481 |
#include "ot_boite_3d.h" |
33 |
francois |
628 |
#include "ot_mathematique.h" |
34 |
francois |
283 |
|
35 |
francois |
399 |
FEM_ELEMENT3::FEM_ELEMENT3(unsigned long num,class MG_ELEMENT_MAILLAGE* mai):FEM_ELEMENT_MAILLAGE(num,mai) |
36 |
francois |
283 |
{ |
37 |
|
|
} |
38 |
francois |
399 |
FEM_ELEMENT3::FEM_ELEMENT3(unsigned long num,class MG_ELEMENT_TOPOLOGIQUE* topo):FEM_ELEMENT_MAILLAGE(num,topo) |
39 |
francois |
378 |
{ |
40 |
|
|
} |
41 |
francois |
399 |
FEM_ELEMENT3::FEM_ELEMENT3(unsigned long num,class MG_ELEMENT_TOPOLOGIQUE* topo,class MG_ELEMENT_MAILLAGE* mai):FEM_ELEMENT_MAILLAGE(num,topo,mai) |
42 |
francois |
378 |
{ |
43 |
|
|
} |
44 |
francois |
283 |
|
45 |
francois |
399 |
FEM_ELEMENT3::FEM_ELEMENT3(class MG_ELEMENT_MAILLAGE* mai):FEM_ELEMENT_MAILLAGE(mai) |
46 |
francois |
283 |
{ |
47 |
|
|
} |
48 |
|
|
|
49 |
francois |
399 |
FEM_ELEMENT3::FEM_ELEMENT3(class MG_ELEMENT_TOPOLOGIQUE* topo):FEM_ELEMENT_MAILLAGE(topo) |
50 |
francois |
378 |
{ |
51 |
|
|
} |
52 |
francois |
399 |
FEM_ELEMENT3::FEM_ELEMENT3(class MG_ELEMENT_TOPOLOGIQUE* topo,class MG_ELEMENT_MAILLAGE* mai):FEM_ELEMENT_MAILLAGE(topo,mai) |
53 |
francois |
378 |
{ |
54 |
|
|
} |
55 |
francois |
283 |
|
56 |
francois |
378 |
|
57 |
francois |
399 |
FEM_ELEMENT3::FEM_ELEMENT3(FEM_ELEMENT3& mdd):FEM_ELEMENT_MAILLAGE(mdd) |
58 |
francois |
283 |
{ |
59 |
|
|
} |
60 |
|
|
|
61 |
|
|
|
62 |
|
|
|
63 |
francois |
309 |
FEM_ELEMENT3::~FEM_ELEMENT3() |
64 |
francois |
283 |
{ |
65 |
|
|
} |
66 |
|
|
|
67 |
|
|
|
68 |
francois |
309 |
void FEM_ELEMENT3::extrapoler_solution_noeud(void) |
69 |
francois |
283 |
{ |
70 |
|
|
int nb=get_nb_fem_noeud(); |
71 |
|
|
for (int i=0;i<nb;i++) |
72 |
francois |
377 |
for (int j=0;j<MAX_TYPE_SOLUTION;j++) |
73 |
francois |
375 |
get_fem_noeud(i)->change_solution(solution[j],j); |
74 |
francois |
283 |
} |
75 |
|
|
|
76 |
|
|
|
77 |
francois |
635 |
bool FEM_ELEMENT3::get_param_element_fini(double *xyz,double *uvw) |
78 |
francois |
628 |
{ |
79 |
|
|
OT_MATRICE_3D mat; |
80 |
|
|
OT_VECTEUR_3D vec; |
81 |
|
|
uvw[0]=0.; |
82 |
|
|
uvw[1]=0.; |
83 |
|
|
uvw[2]=0.; |
84 |
francois |
283 |
|
85 |
francois |
684 |
int compteur=0; |
86 |
francois |
628 |
int ok=0; |
87 |
francois |
684 |
while (ok!=1) |
88 |
|
|
{ |
89 |
|
|
ok=0; |
90 |
|
|
int cas=compteur/100-1; |
91 |
|
|
int base=4; |
92 |
|
|
if (compteur!=0) |
93 |
|
|
{ |
94 |
|
|
int i=cas%base; |
95 |
|
|
int j=(cas/base)%base; |
96 |
|
|
int k=(cas/base/base)%base; |
97 |
|
|
uvw[0]=-1.+2.*i/(base-1); |
98 |
|
|
uvw[1]=-1.+2.*j/(base-1); |
99 |
|
|
uvw[2]=-1.+2.*k/(base-1); |
100 |
|
|
} |
101 |
|
|
if (cas>base*base*base) return false; |
102 |
francois |
628 |
while (ok==0) |
103 |
|
|
{ |
104 |
|
|
mat(0,0)=0.;mat(0,1)=0.;mat(0,2)=0.; |
105 |
|
|
mat(1,0)=0.;mat(1,1)=0.;mat(1,2)=0.; |
106 |
|
|
mat(2,0)=0.;mat(2,1)=0.;mat(2,2)=0.; |
107 |
|
|
vec(0)=xyz[0];vec(1)=xyz[1];vec(2)=xyz[2]; |
108 |
|
|
|
109 |
|
|
for (int i=0;i<get_nb_fem_noeud();i++) |
110 |
|
|
{ |
111 |
|
|
mat(0,0)=mat(0,0)+get_fonction_derive_interpolation(i+1,1,uvw)*get_fem_noeud(i)->get_x(); |
112 |
|
|
mat(0,1)=mat(0,1)+get_fonction_derive_interpolation(i+1,2,uvw)*get_fem_noeud(i)->get_x(); |
113 |
|
|
mat(0,2)=mat(0,2)+get_fonction_derive_interpolation(i+1,3,uvw)*get_fem_noeud(i)->get_x(); |
114 |
|
|
mat(1,0)=mat(1,0)+get_fonction_derive_interpolation(i+1,1,uvw)*get_fem_noeud(i)->get_y(); |
115 |
|
|
mat(1,1)=mat(1,1)+get_fonction_derive_interpolation(i+1,2,uvw)*get_fem_noeud(i)->get_y(); |
116 |
|
|
mat(1,2)=mat(1,2)+get_fonction_derive_interpolation(i+1,3,uvw)*get_fem_noeud(i)->get_y(); |
117 |
|
|
mat(2,0)=mat(2,0)+get_fonction_derive_interpolation(i+1,1,uvw)*get_fem_noeud(i)->get_z(); |
118 |
|
|
mat(2,1)=mat(2,1)+get_fonction_derive_interpolation(i+1,2,uvw)*get_fem_noeud(i)->get_z(); |
119 |
|
|
mat(2,2)=mat(2,2)+get_fonction_derive_interpolation(i+1,3,uvw)*get_fem_noeud(i)->get_z(); |
120 |
|
|
vec(0)=vec(0)-get_fonction_interpolation(i+1,uvw)*get_fem_noeud(i)->get_x(); |
121 |
|
|
vec(1)=vec(1)-get_fonction_interpolation(i+1,uvw)*get_fem_noeud(i)->get_y(); |
122 |
|
|
vec(2)=vec(2)-get_fonction_interpolation(i+1,uvw)*get_fem_noeud(i)->get_z(); |
123 |
|
|
} |
124 |
|
|
double det=mat.get_determinant(); |
125 |
francois |
684 |
if (fabs(det)<1e-12) ok=3; |
126 |
francois |
628 |
OT_MATRICE_3D mat1(vec,mat.get_vecteur2(),mat.get_vecteur3()); |
127 |
|
|
OT_MATRICE_3D mat2(mat.get_vecteur1(),vec,mat.get_vecteur3()); |
128 |
|
|
OT_MATRICE_3D mat3(mat.get_vecteur1(),mat.get_vecteur2(),vec); |
129 |
|
|
double d1=mat1.get_determinant()/det; |
130 |
|
|
double d2=mat2.get_determinant()/det; |
131 |
|
|
double d3=mat3.get_determinant()/det; |
132 |
francois |
635 |
compteur++; |
133 |
francois |
684 |
if (compteur%100==0) ok=2; |
134 |
francois |
628 |
if ((fabs(d1)<1e-8)&&(fabs(d2)<1e-8)&&(fabs(d3)<1e-8)) ok=1; |
135 |
|
|
uvw[0]=uvw[0]+d1; |
136 |
|
|
uvw[1]=uvw[1]+d2; |
137 |
|
|
uvw[2]=uvw[2]+d3; |
138 |
|
|
} |
139 |
francois |
684 |
} |
140 |
francois |
674 |
return true; |
141 |
francois |
628 |
} |
142 |
|
|
|
143 |
|
|
|
144 |
|
|
void FEM_ELEMENT3::get_interpolation_xyz(double* uvw, double* xyz) |
145 |
|
|
{ |
146 |
|
|
xyz[0]=0.;xyz[1]=0.;xyz[2]=0; |
147 |
|
|
for (int i=0;i<get_nb_fem_noeud();i++) |
148 |
|
|
{ |
149 |
|
|
xyz[0]=xyz[0]+get_fonction_interpolation(i+1,uvw)*get_fem_noeud(i)->get_x(); |
150 |
|
|
xyz[1]=xyz[1]+get_fonction_interpolation(i+1,uvw)*get_fem_noeud(i)->get_y(); |
151 |
|
|
xyz[2]=xyz[2]+get_fonction_interpolation(i+1,uvw)*get_fem_noeud(i)->get_z(); |
152 |
|
|
} |
153 |
|
|
} |
154 |
|
|
|