geometrie/src/xfem_tetra4.cpp

//------------------------------------------------------------
//------------------------------------------------------------
//  MAGiC
//  Jean Christophe Cuilli�re et Vincent FRANCOIS
//  D�partement de G�nie M�canique - UQTR
//------------------------------------------------------------
//  Le projet MAGIC est un projet de recherche du d�partement
//  de g�nie m�canique de l'Universit� du Qu�bec �
//  Trois Rivi�res
//  Les librairies ne peuvent �tre utilis�es sans l'accord
//  des auteurs (contact : francois@uqtr.ca)
//------------------------------------------------------------
//------------------------------------------------------------
//
//       fem_element34.cpp
//
//------------------------------------------------------------
//------------------------------------------------------------
//  COPYRIGHT 2000
//  Version du 02/03/2006 � 11H22
//------------------------------------------------------------
//------------------------------------------------------------


#include "gestionversion.h"
#include "xfem_tetra4.h"
#include "fem_tetra4.h"
#include "fem_noeud.h"
#include "mg_element_maillage.h"
#include "fem_maillage.h"


XFEM_TETRA4::XFEM_TETRA4(unsigned long num,class FEM_TETRA4* tet,class FEM_NOEUD** tabnoeud):XFEM_ELEMENT3(num,tet->get_mg_element_maillage()),FEM_TEMPLATE_ELEMENT<4>(tabnoeud),tetra(tet)
{
tetra->ajouter_xfem(this);
}

XFEM_TETRA4::XFEM_TETRA4(class FEM_TETRA4* tet,FEM_NOEUD** tabnoeud):XFEM_ELEMENT3(tet->get_mg_element_maillage()),FEM_TEMPLATE_ELEMENT<4>(tabnoeud),tetra(tet)
{
tetra->ajouter_xfem(this);
}

XFEM_TETRA4::XFEM_TETRA4(XFEM_TETRA4& mdd):XFEM_ELEMENT3(mdd),FEM_TEMPLATE_ELEMENT<4>(mdd),tetra(mdd.tetra),n1(mdd.n1),n2(mdd.n2),n3(mdd.n3),n4(mdd.n4)
{
}

XFEM_TETRA4::~XFEM_TETRA4()
{
tetra->supprimer_xfem(this);
}

XFEM_TETRA4::XFEM_TETRA4(class FEM_TETRA4 *tet,unsigned long num1,unsigned long num2,unsigned long num3,unsigned long num4):XFEM_ELEMENT3(tet->get_mg_element_maillage()),FEM_TEMPLATE_ELEMENT<4>(),tetra(tet),n1(num1),n2(num2),n3(num3),n4(num4)
{
tetra->ajouter_xfem(this);
}


int XFEM_TETRA4::get_type_entite(void)
{
    return   IDXFEM_TETRA4;
}

int XFEM_TETRA4::get_dimension(void)
{
    return 3;
}


int XFEM_TETRA4::get_nb_fem_noeud(void)
{
    return FEM_TEMPLATE_ELEMENT<4>::get_nb_fem_noeud();
}

FEM_NOEUD* XFEM_TETRA4::get_fem_noeud(int num)
{
    return FEM_TEMPLATE_ELEMENT<4>::get_fem_noeud(num);
}

void XFEM_TETRA4::change_noeud(int num,FEM_NOEUD* noeud)
{
    FEM_TEMPLATE_ELEMENT<4>::change_noeud(num,noeud);
}


BOITE_3D& XFEM_TETRA4::get_boite_3D(void)
{
    return FEM_TEMPLATE_ELEMENT<4>::get_boite_3D();
}

void XFEM_TETRA4::enregistrer(std::ostream& o)
{
    o << "%" << get_id() << "=XFEM_TETRA4($"<< tetra->get_id() << ",$"  << tab[0]->get_id() << ",$" << tab[1]->get_id() << ",$" << tab[2]->get_id() << ",$" << tab[3]->get_id()   << ");" << std::endl;

}

FEM_ELEMENT_MAILLAGE* XFEM_TETRA4::dupliquer(FEM_MAILLAGE *femmai,long decalage)
{
tab[0]=femmai->get_fem_noeudid(n1);
tab[1]=femmai->get_fem_noeudid(n2);
tab[2]=femmai->get_fem_noeudid(n3);
tab[3]=femmai->get_fem_noeudid(n4);
}


int XFEM_TETRA4::nb_fonction_interpolation(void)
{
return 4;
}
double XFEM_TETRA4::get_fonction_interpolation(int num,double *uv)
{
double val;
    switch (num)
    {
    case 1:
        val=1-uv[0]-uv[1]-uv[2];
        break;
    case 2:
        val=uv[0];
        break;
    case 3:
        val=uv[1];
        break;
    case 4:
        val=uv[2];
        break;
    }
    return val;
}
double XFEM_TETRA4::get_fonction_derive_interpolation(int num,int num_variable,double *uv)
{
double val;

    switch (num)
    {
    case 1:
        switch (num_variable)
        {
        case 1:
            val=-1;
            break;
        case 2:
            val=-1;
            break;
        case 3:
            val=-1;
            break;
        } break;
    case 2:
        switch (num_variable)
        {
        case 1:
            val=1;
            break;
        case 2:
            val=0;
            break;
        case 3:
            val=0;
            break;
        }break;
    case 3:
        switch (num_variable)
        {
        case 1:
            val=0;
            break;
        case 2:
            val=1;
            break;
        case 3:
            val=0;
            break;
        }break;
    case 4:
        switch (num_variable)
        {
        case 1:
            val=0;
            break;
        case 2:
            val=0;
            break;
        case 3:
            val=1;
            break;
        }break;

    }
    return val;
}
double XFEM_TETRA4::get_jacobien(double* jac,double *uv,int& li,int& col,double unite)
{
li=3;
    col=3;
    double *xyz1=tab[0]->get_coord();
    double *xyz2=tab[1]->get_coord();
    double *xyz3=tab[2]->get_coord();
    double *xyz4=tab[3]->get_coord();

    jac[0]=unite*(xyz2[0] - xyz1[0])  ;
    jac[1]=unite*(xyz2[1] - xyz1[1])  ;
    jac[2]=unite*(xyz2[2] - xyz1[2])  ;

    jac[3]=unite*(xyz3[0] - xyz1[0])  ;
    jac[4]=unite*(xyz3[1] - xyz1[1])  ;
    jac[5]=unite*(xyz3[2] - xyz1[2])  ;

    jac[6]=unite*(xyz4[0] - xyz1[0])  ;
    jac[7]=unite*(xyz4[1] - xyz1[1])  ;
    jac[8]=unite*(xyz4[2] - xyz1[2])  ;

    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]);

    return SIX_V;
}
void XFEM_TETRA4::get_inverse_jacob(double* j,double *uv,double unite)
{
double *xyz1=tab[0]->get_coord();
    double *xyz2=tab[1]->get_coord();
    double *xyz3=tab[2]->get_coord();
    double *xyz4=tab[3]->get_coord();

    double jac[9];

    jac[0*3+0]=  unite*(xyz2[0] - xyz1[0])  ;
    jac[0*3+1]=  unite*(xyz2[1] - xyz1[1])  ;
    jac[0*3+2]=  unite*(xyz2[2] - xyz1[2])  ;

    jac[1*3+0]=  unite*(xyz3[0] - xyz1[0])  ;
    jac[1*3+1]=  unite*(xyz3[1] - xyz1[1])  ;
    jac[1*3+2]=  unite*(xyz3[2] - xyz1[2])  ;

    jac[2*3+0]=  unite*(xyz4[0] - xyz1[0])  ;
    jac[2*3+1]=  unite*(xyz4[1] - xyz1[1])  ;
    jac[2*3+2]=  unite*(xyz4[2] - xyz1[2])  ;

    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]);

    j[0*3+0] =  (jac[1*3+1]*jac[2*3+2]-jac[1*3+2]*jac[2*3+1])/(detj);
    j[0*3+1] = -(jac[0*3+1]*jac[2*3+2]-jac[0*3+2]*jac[2*3+1])/(detj);
    j[0*3+2] =-(-jac[0*3+1]*jac[1*3+2]+jac[0*3+2]*jac[1*3+1])/(detj);

    j[1*3+0] = -(jac[1*3+0]*jac[2*3+2]-jac[1*3+2]*jac[2*3+0])/(detj);
    j[1*3+1] =  (jac[0*3+0]*jac[2*3+2]-jac[0*3+2]*jac[2*3+0])/(detj);
    j[1*3+2] = -(jac[0*3+0]*jac[1*3+2]-jac[0*3+2]*jac[1*3+0])/(detj);

    j[2*3+0] =-(-jac[1*3+0]*jac[2*3+1]+jac[1*3+1]*jac[2*3+0])/(detj);
    j[2*3+1] = -(jac[0*3+0]*jac[2*3+1]-jac[0*3+1]*jac[2*3+0])/(detj);
    j[2*3+2] =  (jac[0*3+0]*jac[1*3+1]-jac[0*3+1]*jac[1*3+0])/(detj);

}
Revision:	340
Committed:	Wed May 30 19:05:46 2012 UTC (13 years, 3 months ago) by francois
File size:	6879 byte(s)
Log Message:	ajouet commit precedent sur xfem
#	Content
1	//------------------------------------------------------------
2	//------------------------------------------------------------
3	// MAGiC
4	// Jean Christophe Cuilli�re et Vincent FRANCOIS
5	// D�partement de G�nie M�canique - UQTR
6	//------------------------------------------------------------
7	// 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	// des auteurs (contact : francois@uqtr.ca)
12	//------------------------------------------------------------
13	//------------------------------------------------------------
14	//
15	// fem_element34.cpp
16	//
17	//------------------------------------------------------------
18	//------------------------------------------------------------
19	// COPYRIGHT 2000
20	// Version du 02/03/2006 � 11H22
21	//------------------------------------------------------------
22	//------------------------------------------------------------
23
24
25	#include "gestionversion.h"
26	#include "xfem_tetra4.h"
27	#include "fem_tetra4.h"
28	#include "fem_noeud.h"
29	#include "mg_element_maillage.h"
30	#include "fem_maillage.h"
31
32
33	XFEM_TETRA4::XFEM_TETRA4(unsigned long num,class FEM_TETRA4* tet,class FEM_NOEUD** tabnoeud):XFEM_ELEMENT3(num,tet->get_mg_element_maillage()),FEM_TEMPLATE_ELEMENT<4>(tabnoeud),tetra(tet)
34	{
35	tetra->ajouter_xfem(this);
36	}
37
38	XFEM_TETRA4::XFEM_TETRA4(class FEM_TETRA4* tet,FEM_NOEUD** tabnoeud):XFEM_ELEMENT3(tet->get_mg_element_maillage()),FEM_TEMPLATE_ELEMENT<4>(tabnoeud),tetra(tet)
39	{
40	tetra->ajouter_xfem(this);
41	}
42
43	XFEM_TETRA4::XFEM_TETRA4(XFEM_TETRA4& mdd):XFEM_ELEMENT3(mdd),FEM_TEMPLATE_ELEMENT<4>(mdd),tetra(mdd.tetra),n1(mdd.n1),n2(mdd.n2),n3(mdd.n3),n4(mdd.n4)
44	{
45	}
46
47	XFEM_TETRA4::~XFEM_TETRA4()
48	{
49	tetra->supprimer_xfem(this);
50	}
51
52	XFEM_TETRA4::XFEM_TETRA4(class FEM_TETRA4 *tet,unsigned long num1,unsigned long num2,unsigned long num3,unsigned long num4):XFEM_ELEMENT3(tet->get_mg_element_maillage()),FEM_TEMPLATE_ELEMENT<4>(),tetra(tet),n1(num1),n2(num2),n3(num3),n4(num4)
53	{
54	tetra->ajouter_xfem(this);
55	}
56
57
58	int XFEM_TETRA4::get_type_entite(void)
59	{
60	return IDXFEM_TETRA4;
61	}
62
63	int XFEM_TETRA4::get_dimension(void)
64	{
65	return 3;
66	}
67
68
69	int XFEM_TETRA4::get_nb_fem_noeud(void)
70	{
71	return FEM_TEMPLATE_ELEMENT<4>::get_nb_fem_noeud();
72	}
73
74	FEM_NOEUD* XFEM_TETRA4::get_fem_noeud(int num)
75	{
76	return FEM_TEMPLATE_ELEMENT<4>::get_fem_noeud(num);
77	}
78
79	void XFEM_TETRA4::change_noeud(int num,FEM_NOEUD* noeud)
80	{
81	FEM_TEMPLATE_ELEMENT<4>::change_noeud(num,noeud);
82	}
83
84
85	BOITE_3D& XFEM_TETRA4::get_boite_3D(void)
86	{
87	return FEM_TEMPLATE_ELEMENT<4>::get_boite_3D();
88	}
89
90	void XFEM_TETRA4::enregistrer(std::ostream& o)
91	{
92	o << "%" << get_id() << "=XFEM_TETRA4($"<< tetra->get_id() << ",$" << tab[0]->get_id() << ",$" << tab[1]->get_id() << ",$" << tab[2]->get_id() << ",$" << tab[3]->get_id() << ");" << std::endl;
93
94	}
95
96	FEM_ELEMENT_MAILLAGE* XFEM_TETRA4::dupliquer(FEM_MAILLAGE *femmai,long decalage)
97	{
98	tab[0]=femmai->get_fem_noeudid(n1);
99	tab[1]=femmai->get_fem_noeudid(n2);
100	tab[2]=femmai->get_fem_noeudid(n3);
101	tab[3]=femmai->get_fem_noeudid(n4);
102	}
103
104
105
106	int XFEM_TETRA4::nb_fonction_interpolation(void)
107	{
108	return 4;
109	}
110	double XFEM_TETRA4::get_fonction_interpolation(int num,double *uv)
111	{
112	double val;
113	switch (num)
114	{
115	case 1:
116	val=1-uv[0]-uv[1]-uv[2];
117	break;
118	case 2:
119	val=uv[0];
120	break;
121	case 3:
122	val=uv[1];
123	break;
124	case 4:
125	val=uv[2];
126	break;
127	}
128	return val;
129	}
130	double XFEM_TETRA4::get_fonction_derive_interpolation(int num,int num_variable,double *uv)
131	{
132	double val;
133
134	switch (num)
135	{
136	case 1:
137	switch (num_variable)
138	{
139	case 1:
140	val=-1;
141	break;
142	case 2:
143	val=-1;
144	break;
145	case 3:
146	val=-1;
147	break;
148	} break;
149	case 2:
150	switch (num_variable)
151	{
152	case 1:
153	val=1;
154	break;
155	case 2:
156	val=0;
157	break;
158	case 3:
159	val=0;
160	break;
161	}break;
162	case 3:
163	switch (num_variable)
164	{
165	case 1:
166	val=0;
167	break;
168	case 2:
169	val=1;
170	break;
171	case 3:
172	val=0;
173	break;
174	}break;
175	case 4:
176	switch (num_variable)
177	{
178	case 1:
179	val=0;
180	break;
181	case 2:
182	val=0;
183	break;
184	case 3:
185	val=1;
186	break;
187	}break;
188
189	}
190	return val;
191	}
192	double XFEM_TETRA4::get_jacobien(double* jac,double *uv,int& li,int& col,double unite)
193	{
194	li=3;
195	col=3;
196	double *xyz1=tab[0]->get_coord();
197	double *xyz2=tab[1]->get_coord();
198	double *xyz3=tab[2]->get_coord();
199	double *xyz4=tab[3]->get_coord();
200
201	jac[0]=unite*(xyz2[0] - xyz1[0]) ;
202	jac[1]=unite*(xyz2[1] - xyz1[1]) ;
203	jac[2]=unite*(xyz2[2] - xyz1[2]) ;
204
205	jac[3]=unite*(xyz3[0] - xyz1[0]) ;
206	jac[4]=unite*(xyz3[1] - xyz1[1]) ;
207	jac[5]=unite*(xyz3[2] - xyz1[2]) ;
208
209	jac[6]=unite*(xyz4[0] - xyz1[0]) ;
210	jac[7]=unite*(xyz4[1] - xyz1[1]) ;
211	jac[8]=unite*(xyz4[2] - xyz1[2]) ;
212
213	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]);
214
215	return SIX_V;
216	}
217	void XFEM_TETRA4::get_inverse_jacob(double* j,double *uv,double unite)
218	{
219	double *xyz1=tab[0]->get_coord();
220	double *xyz2=tab[1]->get_coord();
221	double *xyz3=tab[2]->get_coord();
222	double *xyz4=tab[3]->get_coord();
223
224	double jac[9];
225
226	jac[03+0]= unite(xyz2[0] - xyz1[0]) ;
227	jac[03+1]= unite(xyz2[1] - xyz1[1]) ;
228	jac[03+2]= unite(xyz2[2] - xyz1[2]) ;
229
230	jac[13+0]= unite(xyz3[0] - xyz1[0]) ;
231	jac[13+1]= unite(xyz3[1] - xyz1[1]) ;
232	jac[13+2]= unite(xyz3[2] - xyz1[2]) ;
233
234	jac[23+0]= unite(xyz4[0] - xyz1[0]) ;
235	jac[23+1]= unite(xyz4[1] - xyz1[1]) ;
236	jac[23+2]= unite(xyz4[2] - xyz1[2]) ;
237
238	double detj=(jac[03+0]jac[13+1]jac[23+2]-jac[03+0]jac[13+2]jac[23+1]-jac[13+0]jac[03+1]jac[23+2]+jac[13+0]jac[03+2]jac[23+1]+jac[23+0]jac[03+1]jac[13+2]-jac[23+0]jac[03+2]jac[13+1]);
239
240	j[03+0] = (jac[13+1]jac[23+2]-jac[13+2]jac[2*3+1])/(detj);
241	j[03+1] = -(jac[03+1]jac[23+2]-jac[03+2]jac[2*3+1])/(detj);
242	j[03+2] =-(-jac[03+1]jac[13+2]+jac[03+2]jac[1*3+1])/(detj);
243
244	j[13+0] = -(jac[13+0]jac[23+2]-jac[13+2]jac[2*3+0])/(detj);
245	j[13+1] = (jac[03+0]jac[23+2]-jac[03+2]jac[2*3+0])/(detj);
246	j[13+2] = -(jac[03+0]jac[13+2]-jac[03+2]jac[1*3+0])/(detj);
247
248	j[23+0] =-(-jac[13+0]jac[23+1]+jac[13+1]jac[2*3+0])/(detj);
249	j[23+1] = -(jac[03+0]jac[23+1]-jac[03+1]jac[2*3+0])/(detj);
250	j[23+2] = (jac[03+0]jac[13+1]-jac[03+1]jac[1*3+0])/(detj);
251
252	}