geometrie/src/mg_volume.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)
//------------------------------------------------------------
//------------------------------------------------------------
//
//       mg_volume.cpp
//
//------------------------------------------------------------
//------------------------------------------------------------
//  COPYRIGHT 2000
//  Version du 02/03/2006 ? 11H22
//------------------------------------------------------------
//------------------------------------------------------------


#include "gestionversion.h"
#include "mg_volume.h"
#include "ot_mathematique.h"
#include "mg_maillage.h"
#include "vct_volume.h"
//#include "message.h"

MG_VOLUME::MG_VOLUME(std::string idori,unsigned long num):MG_ELEMENT_TOPOLOGIQUE(num,idori),num_materiau(-1),vect(NULL)
{
}

MG_VOLUME::MG_VOLUME(std::string idori):MG_ELEMENT_TOPOLOGIQUE(idori),num_materiau(-1),vect(NULL)
{
}

MG_VOLUME::MG_VOLUME(MG_VOLUME& mdd):MG_ELEMENT_TOPOLOGIQUE(mdd),lst_coquille(mdd.lst_coquille),vect(mdd.vect)
{
}

MG_VOLUME::~MG_VOLUME()
{
}

void MG_VOLUME::ajouter_mg_coquille(class MG_COQUILLE* mgcoq)
{
lst_coquille.insert(lst_coquille.end(),mgcoq);
}

void MG_VOLUME::supprimer_mg_coquille(class MG_COQUILLE* mgcoq)
{
   std::vector<MG_COQUILLE*>::iterator i;
   for (i=lst_coquille.begin();i!=lst_coquille.end();i++)
   {
   if ((*i)==mgcoq) 
      {
      lst_coquille.erase(i);
      return;
      }
   }
}


int MG_VOLUME::get_nb_mg_coquille(void)
{
return lst_coquille.size();
}

MG_COQUILLE* MG_VOLUME::get_mg_coquille(int num)
{
return lst_coquille[num];
}

int MG_VOLUME::get_dimension(void)
{
return 3;
}
VCT& MG_VOLUME::get_vectorisation(void)
{
//VCT* p=NULL;
//return *p;
if (vect==NULL) vect=new VCT_VOLUME(this);
return *vect;
}

void MG_VOLUME::enregistrer(std::ostream& o)
{
   o << "%" << get_id() << "=VOLUME(" << get_idoriginal() << ",(";
   for (unsigned int i=0;i<lst_coquille.size();i++)
      {
         o << "$" << lst_coquille[i]->get_id();  
         if (i!=lst_coquille.size()-1) o << ","; else o << ")";
      }
   int nb=get_nb_ccf();
   o << "," << num_materiau << "," << nb;
   if (nb!=0)
        {
        o << ",(";
        for (int i=0;i<nb;i++)
                {
                char nom[3];
                get_type_ccf(i,nom);
                o << "(" <<  nom << "," << get_valeur_ccf(i) << ")";
                if (i!=nb-1) o << "," ;
                }
        o << ")";
        }
   o << ");" << std::endl;
}

void MG_VOLUME::change_num_materiau(int num)
{
num_materiau=num;
}

int MG_VOLUME::get_num_materiau(void)
{
return num_materiau;
}

void MG_VOLUME::get_propriete_massique(class MG_MAILLAGE* mai,double& volume,class OT_VECTEUR_3D& cdm,class OT_MATRICE_3D& inertieglobale,class OT_MATRICE_3D& inertiecdm,double dens)
{
double vol=0.;
double xg=0.;
double yg=0.;
double zg=0.;
double a=0.;
double b=0.;
double c=0.;
double d=0.;
double e=0.;
double f=0.;
int nbcoquille=get_nb_mg_coquille();
for (int i=0;i<nbcoquille;i++)
        {
        MG_COQUILLE* coq=get_mg_coquille(i);
        int nbface=coq->get_nb_mg_coface();
        for (int j=0;j<nbface;j++)
                {
                MG_COFACE* coface=coq->get_mg_coface(j);
                MG_FACE* face=coface->get_face();
                TPL_SET<MG_ELEMENT_MAILLAGE*>::ITERATEUR it;
                for (MG_TRIANGLE* tri=(MG_TRIANGLE*)face->get_lien_maillage()->get_premier(it);tri!=NULL;tri=(MG_TRIANGLE*)face->get_lien_maillage()->get_suivant(it))
                        {
                        if (mai->get_mg_triangleid(tri->get_id())==NULL) continue;
                        MG_NOEUD* noeud1=tri->get_noeud1();
                        MG_NOEUD* noeud2=tri->get_noeud2();
                        MG_NOEUD* noeud3=tri->get_noeud3();
                        double *xyz1=noeud1->get_coord();
                        double *xyz2=noeud2->get_coord();
                        double *xyz3=noeud3->get_coord();
                        OT_VECTEUR_3D vec1(xyz1,xyz2);
                        OT_VECTEUR_3D vec2(xyz1,xyz3);
                        OT_VECTEUR_3D n=vec1&vec2;
                        double detj=n.get_longueur();
                        n.norme();
                        n=-1.*coface->get_orientation()*n;
                        for (int k=0;k<3;k++)
                                {
                                double xsi=1./6.;
                                double eta=1./6.;
                                double wi=1./6.;
                                if (k==1) xsi=2./3.;
                                if (k==2) eta=2./3.;
                                double x=(1-xsi-eta)*xyz1[0]+xsi*xyz2[0]+eta*xyz3[0];
                                double y=(1-xsi-eta)*xyz1[1]+xsi*xyz2[1]+eta*xyz3[1];
                                double z=(1-xsi-eta)*xyz1[2]+xsi*xyz2[2]+eta*xyz3[2];
                                OT_VECTEUR_3D psi1(x,0,0);
                                OT_VECTEUR_3D psi2(0.5*x*x,0,0);
                                OT_VECTEUR_3D psi3(0,0.5*y*y,0);
                                OT_VECTEUR_3D psi4(0,0,0.5*z*z);
                                OT_VECTEUR_3D psi5(0,y*y*y/3.,z*z*z/3.);
                                OT_VECTEUR_3D psi6(x*x*x/3.,0,z*z*z/3.);
                                OT_VECTEUR_3D psi7(x*x*x/3.,y*y*y/3.,0);
                                OT_VECTEUR_3D psi8(0.,y*y*z/2.,0);
                                OT_VECTEUR_3D psi9(x*x*z/2.,0.,0);
                                OT_VECTEUR_3D psi10(x*x*y/2.,0,0);
                                vol=vol+detj*wi*(psi1*n);
                                xg=xg+wi*detj*(psi2*n);
                                yg=yg+wi*detj*(psi3*n);
                                zg=zg+wi*detj*(psi4*n);
                                a=a+wi*detj*(psi5*n);
                                b=b+wi*detj*(psi6*n);
                                c=c+wi*detj*(psi7*n);
                                d=d+wi*detj*(psi8*n);
                                e=e+wi*detj*(psi9*n);
                                f=f+wi*detj*(psi10*n);
                                }
                        }
                }
        }
volume=vol;
cdm.change_x(xg/volume);
cdm.change_y(yg/volume);
cdm.change_z(zg/volume);
inertieglobale(0,0)=a*dens;
inertieglobale(1,1)=b*dens;
inertieglobale(2,2)=c*dens;
inertieglobale(1,0)=f*dens;
inertieglobale(0,1)=f*dens;
inertieglobale(2,0)=e*dens;
inertieglobale(0,2)=e*dens;
inertieglobale(2,1)=d*dens;
inertieglobale(1,2)=d*dens;
OT_VECTEUR_3D m1(volume*(cdm.get_y()*cdm.get_y()+cdm.get_z()*cdm.get_z()),volume*cdm.get_x()*cdm.get_y(),volume*cdm.get_x()*cdm.get_z());
OT_VECTEUR_3D m2(volume*cdm.get_x()*cdm.get_y(),volume*(cdm.get_x()*cdm.get_x()+cdm.get_z()*cdm.get_z()),volume*cdm.get_y()*cdm.get_z());
OT_VECTEUR_3D m3(volume*cdm.get_x()*cdm.get_z(),volume*cdm.get_y()*cdm.get_z(),volume*(cdm.get_x()*cdm.get_x()+cdm.get_y()*cdm.get_y()));
m1=(-1.)*m1;
m2=(-1.)*m2;
m3=(-1.)*m3;
OT_MATRICE_3D change(m1,m2,m3);
inertiecdm=inertieglobale+change;
}

Revision:	155
Committed:	Fri Sep 12 14:48:21 2008 UTC (16 years, 8 months ago) by francois
Original Path:	*magic/lib/geometrie/geometrie/src/mg_volume.cpp*
File size:	6394 byte(s)
Log Message:	Mise a jour remailleur il y a encore un pb avec la distance de destruction qui fait que le remaillage ne donne pas des qualite top
#	User	Rev	Content
1		5	//------------------------------------------------------------
2			//------------------------------------------------------------
3			// MAGiC
4	francois	155	// Jean Christophe Cuilli?re et Vincent FRANCOIS
5			// D?partement de G?nie M?canique - UQTR
6		5	//------------------------------------------------------------
7	francois	155	// 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			// mg_volume.cpp
16			//
17			//------------------------------------------------------------
18			//------------------------------------------------------------
19			// COPYRIGHT 2000
20	francois	155	// Version du 02/03/2006 ? 11H22
21		5	//------------------------------------------------------------
22			//------------------------------------------------------------
23
24
25			#include "gestionversion.h"
26			#include "mg_volume.h"
27	francois	155	#include "ot_mathematique.h"
28			#include "mg_maillage.h"
29	souaissa	150	#include "vct_volume.h"
30		5	//#include "message.h"
31
32	souaissa	150	MG_VOLUME::MG_VOLUME(std::string idori,unsigned long num):MG_ELEMENT_TOPOLOGIQUE(num,idori),num_materiau(-1),vect(NULL)
33		5	{
34			}
35
36	souaissa	150	MG_VOLUME::MG_VOLUME(std::string idori):MG_ELEMENT_TOPOLOGIQUE(idori),num_materiau(-1),vect(NULL)
37		5	{
38			}
39
40	souaissa	150	MG_VOLUME::MG_VOLUME(MG_VOLUME& mdd):MG_ELEMENT_TOPOLOGIQUE(mdd),lst_coquille(mdd.lst_coquille),vect(mdd.vect)
41		5	{
42			}
43
44			MG_VOLUME::~MG_VOLUME()
45			{
46			}
47
48			void MG_VOLUME::ajouter_mg_coquille(class MG_COQUILLE* mgcoq)
49			{
50			lst_coquille.insert(lst_coquille.end(),mgcoq);
51			}
52
53			void MG_VOLUME::supprimer_mg_coquille(class MG_COQUILLE* mgcoq)
54			{
55			std::vector<MG_COQUILLE*>::iterator i;
56			for (i=lst_coquille.begin();i!=lst_coquille.end();i++)
57			{
58			if ((*i)==mgcoq)
59			{
60			lst_coquille.erase(i);
61			return;
62			}
63			}
64			}
65
66
67			int MG_VOLUME::get_nb_mg_coquille(void)
68			{
69			return lst_coquille.size();
70			}
71
72			MG_COQUILLE* MG_VOLUME::get_mg_coquille(int num)
73			{
74			return lst_coquille[num];
75			}
76
77			int MG_VOLUME::get_dimension(void)
78			{
79			return 3;
80			}
81	souaissa	71	VCT& MG_VOLUME::get_vectorisation(void)
82			{
83	souaissa	150	//VCT* p=NULL;
84			//return *p;
85			if (vect==NULL) vect=new VCT_VOLUME(this);
86			return *vect;
87	souaissa	71	}
88		5
89			void MG_VOLUME::enregistrer(std::ostream& o)
90			{
91			o << "%" << get_id() << "=VOLUME(" << get_idoriginal() << ",(";
92			for (unsigned int i=0;i<lst_coquille.size();i++)
93			{
94			o << "$" << lst_coquille[i]->get_id();
95			if (i!=lst_coquille.size()-1) o << ","; else o << ")";
96			}
97			int nb=get_nb_ccf();
98			o << "," << num_materiau << "," << nb;
99			if (nb!=0)
100			{
101			o << ",(";
102			for (int i=0;i<nb;i++)
103			{
104			char nom[3];
105			get_type_ccf(i,nom);
106			o << "(" << nom << "," << get_valeur_ccf(i) << ")";
107			if (i!=nb-1) o << "," ;
108			}
109			o << ")";
110			}
111			o << ");" << std::endl;
112			}
113
114			void MG_VOLUME::change_num_materiau(int num)
115			{
116			num_materiau=num;
117			}
118
119			int MG_VOLUME::get_num_materiau(void)
120			{
121			return num_materiau;
122			}
123
124	francois	155	void MG_VOLUME::get_propriete_massique(class MG_MAILLAGE* mai,double& volume,class OT_VECTEUR_3D& cdm,class OT_MATRICE_3D& inertieglobale,class OT_MATRICE_3D& inertiecdm,double dens)
125			{
126			double vol=0.;
127			double xg=0.;
128			double yg=0.;
129			double zg=0.;
130			double a=0.;
131			double b=0.;
132			double c=0.;
133			double d=0.;
134			double e=0.;
135			double f=0.;
136			int nbcoquille=get_nb_mg_coquille();
137			for (int i=0;i<nbcoquille;i++)
138			{
139			MG_COQUILLE* coq=get_mg_coquille(i);
140			int nbface=coq->get_nb_mg_coface();
141			for (int j=0;j<nbface;j++)
142			{
143			MG_COFACE* coface=coq->get_mg_coface(j);
144			MG_FACE* face=coface->get_face();
145			TPL_SET<MG_ELEMENT_MAILLAGE*>::ITERATEUR it;
146			for (MG_TRIANGLE* tri=(MG_TRIANGLE)face->get_lien_maillage()->get_premier(it);tri!=NULL;tri=(MG_TRIANGLE)face->get_lien_maillage()->get_suivant(it))
147			{
148			if (mai->get_mg_triangleid(tri->get_id())==NULL) continue;
149			MG_NOEUD* noeud1=tri->get_noeud1();
150			MG_NOEUD* noeud2=tri->get_noeud2();
151			MG_NOEUD* noeud3=tri->get_noeud3();
152			double *xyz1=noeud1->get_coord();
153			double *xyz2=noeud2->get_coord();
154			double *xyz3=noeud3->get_coord();
155			OT_VECTEUR_3D vec1(xyz1,xyz2);
156			OT_VECTEUR_3D vec2(xyz1,xyz3);
157			OT_VECTEUR_3D n=vec1&vec2;
158			double detj=n.get_longueur();
159			n.norme();
160			n=-1.coface->get_orientation()n;
161			for (int k=0;k<3;k++)
162			{
163			double xsi=1./6.;
164			double eta=1./6.;
165			double wi=1./6.;
166			if (k==1) xsi=2./3.;
167			if (k==2) eta=2./3.;
168			double x=(1-xsi-eta)xyz1[0]+xsixyz2[0]+eta*xyz3[0];
169			double y=(1-xsi-eta)xyz1[1]+xsixyz2[1]+eta*xyz3[1];
170			double z=(1-xsi-eta)xyz1[2]+xsixyz2[2]+eta*xyz3[2];
171			OT_VECTEUR_3D psi1(x,0,0);
172			OT_VECTEUR_3D psi2(0.5xx,0,0);
173			OT_VECTEUR_3D psi3(0,0.5yy,0);
174			OT_VECTEUR_3D psi4(0,0,0.5zz);
175			OT_VECTEUR_3D psi5(0,yyy/3.,zzz/3.);
176			OT_VECTEUR_3D psi6(xxx/3.,0,zzz/3.);
177			OT_VECTEUR_3D psi7(xxx/3.,yyy/3.,0);
178			OT_VECTEUR_3D psi8(0.,yyz/2.,0);
179			OT_VECTEUR_3D psi9(xxz/2.,0.,0);
180			OT_VECTEUR_3D psi10(xxy/2.,0,0);
181			vol=vol+detjwi(psi1*n);
182			xg=xg+widetj(psi2*n);
183			yg=yg+widetj(psi3*n);
184			zg=zg+widetj(psi4*n);
185			a=a+widetj(psi5*n);
186			b=b+widetj(psi6*n);
187			c=c+widetj(psi7*n);
188			d=d+widetj(psi8*n);
189			e=e+widetj(psi9*n);
190			f=f+widetj(psi10*n);
191			}
192			}
193			}
194			}
195			volume=vol;
196			cdm.change_x(xg/volume);
197			cdm.change_y(yg/volume);
198			cdm.change_z(zg/volume);
199			inertieglobale(0,0)=a*dens;
200			inertieglobale(1,1)=b*dens;
201			inertieglobale(2,2)=c*dens;
202			inertieglobale(1,0)=f*dens;
203			inertieglobale(0,1)=f*dens;
204			inertieglobale(2,0)=e*dens;
205			inertieglobale(0,2)=e*dens;
206			inertieglobale(2,1)=d*dens;
207			inertieglobale(1,2)=d*dens;
208			OT_VECTEUR_3D m1(volume(cdm.get_y()cdm.get_y()+cdm.get_z()cdm.get_z()),volumecdm.get_x()cdm.get_y(),volumecdm.get_x()*cdm.get_z());
209			OT_VECTEUR_3D m2(volumecdm.get_x()cdm.get_y(),volume(cdm.get_x()cdm.get_x()+cdm.get_z()cdm.get_z()),volumecdm.get_y()*cdm.get_z());
210			OT_VECTEUR_3D m3(volumecdm.get_x()cdm.get_z(),volumecdm.get_y()cdm.get_z(),volume(cdm.get_x()cdm.get_x()+cdm.get_y()*cdm.get_y()));
211			m1=(-1.)*m1;
212			m2=(-1.)*m2;
213			m3=(-1.)*m3;
214			OT_MATRICE_3D change(m1,m2,m3);
215			inertiecdm=inertieglobale+change;
216			}
217		5