geometrie/src/fem_element3.cpp

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


#include "gestionversion.h"
#include <math.h>
#include "fem_element3.h"
#include "xfem_element3.h"
#include "fem_noeud.h"
#include "fem_maillage.h"
#include "mg_element_maillage.h"
#include "ot_boite_3d.h"
#include "ot_mathematique.h"

FEM_ELEMENT3::FEM_ELEMENT3(unsigned long num,class MG_ELEMENT_MAILLAGE* mai):FEM_ELEMENT_MAILLAGE(num,mai)
{
}
FEM_ELEMENT3::FEM_ELEMENT3(unsigned long num,class MG_ELEMENT_TOPOLOGIQUE* topo):FEM_ELEMENT_MAILLAGE(num,topo)
{
}
FEM_ELEMENT3::FEM_ELEMENT3(unsigned long num,class MG_ELEMENT_TOPOLOGIQUE* topo,class MG_ELEMENT_MAILLAGE* mai):FEM_ELEMENT_MAILLAGE(num,topo,mai)
{
}

FEM_ELEMENT3::FEM_ELEMENT3(class MG_ELEMENT_MAILLAGE* mai):FEM_ELEMENT_MAILLAGE(mai)
{
}

FEM_ELEMENT3::FEM_ELEMENT3(class MG_ELEMENT_TOPOLOGIQUE* topo):FEM_ELEMENT_MAILLAGE(topo)
{
}
FEM_ELEMENT3::FEM_ELEMENT3(class MG_ELEMENT_TOPOLOGIQUE* topo,class MG_ELEMENT_MAILLAGE* mai):FEM_ELEMENT_MAILLAGE(topo,mai)
{
}


FEM_ELEMENT3::FEM_ELEMENT3(FEM_ELEMENT3& mdd):FEM_ELEMENT_MAILLAGE(mdd)
{
}


FEM_ELEMENT3::~FEM_ELEMENT3()
{
}


void FEM_ELEMENT3::extrapoler_solution_noeud(void)
{
    int nb=get_nb_fem_noeud();
    for (int i=0;i<nb;i++)
        for (int j=0;j<MAX_TYPE_SOLUTION;j++)  
          get_fem_noeud(i)->change_solution(solution[j],j);
}


bool FEM_ELEMENT3::get_param_element_fini(double *xyz,double *uvw)
{
OT_MATRICE_3D mat;
OT_VECTEUR_3D vec;
uvw[0]=0.;
uvw[1]=0.;
uvw[2]=0.;


int ok=0;
int compteur=0;
while (ok==0)
{
mat(0,0)=0.;mat(0,1)=0.;mat(0,2)=0.;
mat(1,0)=0.;mat(1,1)=0.;mat(1,2)=0.;
mat(2,0)=0.;mat(2,1)=0.;mat(2,2)=0.;
vec(0)=xyz[0];vec(1)=xyz[1];vec(2)=xyz[2];

for (int i=0;i<get_nb_fem_noeud();i++)
  {
  mat(0,0)=mat(0,0)+get_fonction_derive_interpolation(i+1,1,uvw)*get_fem_noeud(i)->get_x();
  mat(0,1)=mat(0,1)+get_fonction_derive_interpolation(i+1,2,uvw)*get_fem_noeud(i)->get_x();
  mat(0,2)=mat(0,2)+get_fonction_derive_interpolation(i+1,3,uvw)*get_fem_noeud(i)->get_x();
  mat(1,0)=mat(1,0)+get_fonction_derive_interpolation(i+1,1,uvw)*get_fem_noeud(i)->get_y();
  mat(1,1)=mat(1,1)+get_fonction_derive_interpolation(i+1,2,uvw)*get_fem_noeud(i)->get_y();
  mat(1,2)=mat(1,2)+get_fonction_derive_interpolation(i+1,3,uvw)*get_fem_noeud(i)->get_y();
  mat(2,0)=mat(2,0)+get_fonction_derive_interpolation(i+1,1,uvw)*get_fem_noeud(i)->get_z();
  mat(2,1)=mat(2,1)+get_fonction_derive_interpolation(i+1,2,uvw)*get_fem_noeud(i)->get_z();
  mat(2,2)=mat(2,2)+get_fonction_derive_interpolation(i+1,3,uvw)*get_fem_noeud(i)->get_z();
  vec(0)=vec(0)-get_fonction_interpolation(i+1,uvw)*get_fem_noeud(i)->get_x();
  vec(1)=vec(1)-get_fonction_interpolation(i+1,uvw)*get_fem_noeud(i)->get_y();
  vec(2)=vec(2)-get_fonction_interpolation(i+1,uvw)*get_fem_noeud(i)->get_z();
  }
double det=mat.get_determinant();
if (det<1e-12) return false;
OT_MATRICE_3D mat1(vec,mat.get_vecteur2(),mat.get_vecteur3());
OT_MATRICE_3D mat2(mat.get_vecteur1(),vec,mat.get_vecteur3());
OT_MATRICE_3D mat3(mat.get_vecteur1(),mat.get_vecteur2(),vec);
double d1=mat1.get_determinant()/det;
double d2=mat2.get_determinant()/det;
double d3=mat3.get_determinant()/det;
if (compteur>100) return false;
compteur++;
if ((fabs(d1)<1e-8)&&(fabs(d2)<1e-8)&&(fabs(d3)<1e-8))  ok=1;
uvw[0]=uvw[0]+d1;
uvw[1]=uvw[1]+d2;
uvw[2]=uvw[2]+d3;
}
  
}


void FEM_ELEMENT3::get_interpolation_xyz(double* uvw, double* xyz)
{
xyz[0]=0.;xyz[1]=0.;xyz[2]=0;
for (int i=0;i<get_nb_fem_noeud();i++)
  {
  xyz[0]=xyz[0]+get_fonction_interpolation(i+1,uvw)*get_fem_noeud(i)->get_x();
  xyz[1]=xyz[1]+get_fonction_interpolation(i+1,uvw)*get_fem_noeud(i)->get_y();
  xyz[2]=xyz[2]+get_fonction_interpolation(i+1,uvw)*get_fem_noeud(i)->get_z();
  }
}

Revision:	635
Committed:	Fri Jan 16 22:48:47 2015 UTC (10 years, 3 months ago) by francois
File size:	4637 byte(s)
Log Message:	Generalisation de la projection d'une solution sur un maillage avec gestion d'erreur
#	User	Rev	Content
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
86	francois	628	int ok=0;
87	francois	635	int compteur=0;
88	francois	628	while (ok==0)
89			{
90			mat(0,0)=0.;mat(0,1)=0.;mat(0,2)=0.;
91			mat(1,0)=0.;mat(1,1)=0.;mat(1,2)=0.;
92			mat(2,0)=0.;mat(2,1)=0.;mat(2,2)=0.;
93			vec(0)=xyz[0];vec(1)=xyz[1];vec(2)=xyz[2];
94
95			for (int i=0;i<get_nb_fem_noeud();i++)
96			{
97			mat(0,0)=mat(0,0)+get_fonction_derive_interpolation(i+1,1,uvw)*get_fem_noeud(i)->get_x();
98			mat(0,1)=mat(0,1)+get_fonction_derive_interpolation(i+1,2,uvw)*get_fem_noeud(i)->get_x();
99			mat(0,2)=mat(0,2)+get_fonction_derive_interpolation(i+1,3,uvw)*get_fem_noeud(i)->get_x();
100			mat(1,0)=mat(1,0)+get_fonction_derive_interpolation(i+1,1,uvw)*get_fem_noeud(i)->get_y();
101			mat(1,1)=mat(1,1)+get_fonction_derive_interpolation(i+1,2,uvw)*get_fem_noeud(i)->get_y();
102			mat(1,2)=mat(1,2)+get_fonction_derive_interpolation(i+1,3,uvw)*get_fem_noeud(i)->get_y();
103			mat(2,0)=mat(2,0)+get_fonction_derive_interpolation(i+1,1,uvw)*get_fem_noeud(i)->get_z();
104			mat(2,1)=mat(2,1)+get_fonction_derive_interpolation(i+1,2,uvw)*get_fem_noeud(i)->get_z();
105			mat(2,2)=mat(2,2)+get_fonction_derive_interpolation(i+1,3,uvw)*get_fem_noeud(i)->get_z();
106			vec(0)=vec(0)-get_fonction_interpolation(i+1,uvw)*get_fem_noeud(i)->get_x();
107			vec(1)=vec(1)-get_fonction_interpolation(i+1,uvw)*get_fem_noeud(i)->get_y();
108			vec(2)=vec(2)-get_fonction_interpolation(i+1,uvw)*get_fem_noeud(i)->get_z();
109			}
110			double det=mat.get_determinant();
111	francois	635	if (det<1e-12) return false;
112	francois	628	OT_MATRICE_3D mat1(vec,mat.get_vecteur2(),mat.get_vecteur3());
113			OT_MATRICE_3D mat2(mat.get_vecteur1(),vec,mat.get_vecteur3());
114			OT_MATRICE_3D mat3(mat.get_vecteur1(),mat.get_vecteur2(),vec);
115			double d1=mat1.get_determinant()/det;
116			double d2=mat2.get_determinant()/det;
117			double d3=mat3.get_determinant()/det;
118	francois	635	if (compteur>100) return false;
119			compteur++;
120	francois	628	if ((fabs(d1)<1e-8)&&(fabs(d2)<1e-8)&&(fabs(d3)<1e-8)) ok=1;
121			uvw[0]=uvw[0]+d1;
122			uvw[1]=uvw[1]+d2;
123			uvw[2]=uvw[2]+d3;
124			}
125
126			}
127
128
129			void FEM_ELEMENT3::get_interpolation_xyz(double* uvw, double* xyz)
130			{
131			xyz[0]=0.;xyz[1]=0.;xyz[2]=0;
132			for (int i=0;i<get_nb_fem_noeud();i++)
133			{
134			xyz[0]=xyz[0]+get_fonction_interpolation(i+1,uvw)*get_fem_noeud(i)->get_x();
135			xyz[1]=xyz[1]+get_fonction_interpolation(i+1,uvw)*get_fem_noeud(i)->get_y();
136			xyz[2]=xyz[2]+get_fonction_interpolation(i+1,uvw)*get_fem_noeud(i)->get_z();
137			}
138			}
139