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::get_topologie_sousjacente(TPL_MAP_ENTITE<MG_ELEMENT_TOPOLOGIQUE*> *lst)
{
int nbcoq=lst_coquille.size();
for (int i=0;i<nbcoq;i++)
        {
        MG_COQUILLE* coq=lst_coquille[i];
        int nbface=coq->get_nb_mg_coface();
        for (int j=0;j<nbface;j++)
                {
                MG_FACE* face=coq->get_mg_coface(j)->get_face();
                lst->ajouter(face);
                face->get_topologie_sousjacente(lst);
                }
        }
}


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:	253
Committed:	Tue Jul 13 19:40:46 2010 UTC (14 years, 10 months ago) by francois
File size:	6787 byte(s)
Log Message:	changement de hiearchie et utilisation de ccmake + mise a jour
#	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	francois	195	void MG_VOLUME::get_topologie_sousjacente(TPL_MAP_ENTITE<MG_ELEMENT_TOPOLOGIQUE> lst)
89			{
90			int nbcoq=lst_coquille.size();
91			for (int i=0;i<nbcoq;i++)
92			{
93			MG_COQUILLE* coq=lst_coquille[i];
94			int nbface=coq->get_nb_mg_coface();
95			for (int j=0;j<nbface;j++)
96			{
97			MG_FACE* face=coq->get_mg_coface(j)->get_face();
98			lst->ajouter(face);
99			face->get_topologie_sousjacente(lst);
100			}
101			}
102			}
103		5
104	francois	195
105		5	void MG_VOLUME::enregistrer(std::ostream& o)
106			{
107			o << "%" << get_id() << "=VOLUME(" << get_idoriginal() << ",(";
108			for (unsigned int i=0;i<lst_coquille.size();i++)
109			{
110			o << "$" << lst_coquille[i]->get_id();
111			if (i!=lst_coquille.size()-1) o << ","; else o << ")";
112			}
113			int nb=get_nb_ccf();
114			o << "," << num_materiau << "," << nb;
115			if (nb!=0)
116			{
117			o << ",(";
118			for (int i=0;i<nb;i++)
119			{
120			char nom[3];
121			get_type_ccf(i,nom);
122			o << "(" << nom << "," << get_valeur_ccf(i) << ")";
123			if (i!=nb-1) o << "," ;
124			}
125			o << ")";
126			}
127			o << ");" << std::endl;
128			}
129
130			void MG_VOLUME::change_num_materiau(int num)
131			{
132			num_materiau=num;
133			}
134
135			int MG_VOLUME::get_num_materiau(void)
136			{
137			return num_materiau;
138			}
139
140	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)
141			{
142			double vol=0.;
143			double xg=0.;
144			double yg=0.;
145			double zg=0.;
146			double a=0.;
147			double b=0.;
148			double c=0.;
149			double d=0.;
150			double e=0.;
151			double f=0.;
152			int nbcoquille=get_nb_mg_coquille();
153			for (int i=0;i<nbcoquille;i++)
154			{
155			MG_COQUILLE* coq=get_mg_coquille(i);
156			int nbface=coq->get_nb_mg_coface();
157			for (int j=0;j<nbface;j++)
158			{
159			MG_COFACE* coface=coq->get_mg_coface(j);
160			MG_FACE* face=coface->get_face();
161			TPL_SET<MG_ELEMENT_MAILLAGE*>::ITERATEUR it;
162			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))
163			{
164			if (mai->get_mg_triangleid(tri->get_id())==NULL) continue;
165			MG_NOEUD* noeud1=tri->get_noeud1();
166			MG_NOEUD* noeud2=tri->get_noeud2();
167			MG_NOEUD* noeud3=tri->get_noeud3();
168			double *xyz1=noeud1->get_coord();
169			double *xyz2=noeud2->get_coord();
170			double *xyz3=noeud3->get_coord();
171			OT_VECTEUR_3D vec1(xyz1,xyz2);
172			OT_VECTEUR_3D vec2(xyz1,xyz3);
173			OT_VECTEUR_3D n=vec1&vec2;
174			double detj=n.get_longueur();
175			n.norme();
176			n=-1.coface->get_orientation()n;
177			for (int k=0;k<3;k++)
178			{
179			double xsi=1./6.;
180			double eta=1./6.;
181			double wi=1./6.;
182			if (k==1) xsi=2./3.;
183			if (k==2) eta=2./3.;
184			double x=(1-xsi-eta)xyz1[0]+xsixyz2[0]+eta*xyz3[0];
185			double y=(1-xsi-eta)xyz1[1]+xsixyz2[1]+eta*xyz3[1];
186			double z=(1-xsi-eta)xyz1[2]+xsixyz2[2]+eta*xyz3[2];
187			OT_VECTEUR_3D psi1(x,0,0);
188			OT_VECTEUR_3D psi2(0.5xx,0,0);
189			OT_VECTEUR_3D psi3(0,0.5yy,0);
190			OT_VECTEUR_3D psi4(0,0,0.5zz);
191			OT_VECTEUR_3D psi5(0,yyy/3.,zzz/3.);
192			OT_VECTEUR_3D psi6(xxx/3.,0,zzz/3.);
193			OT_VECTEUR_3D psi7(xxx/3.,yyy/3.,0);
194			OT_VECTEUR_3D psi8(0.,yyz/2.,0);
195			OT_VECTEUR_3D psi9(xxz/2.,0.,0);
196			OT_VECTEUR_3D psi10(xxy/2.,0,0);
197			vol=vol+detjwi(psi1*n);
198			xg=xg+widetj(psi2*n);
199			yg=yg+widetj(psi3*n);
200			zg=zg+widetj(psi4*n);
201			a=a+widetj(psi5*n);
202			b=b+widetj(psi6*n);
203			c=c+widetj(psi7*n);
204			d=d+widetj(psi8*n);
205			e=e+widetj(psi9*n);
206			f=f+widetj(psi10*n);
207			}
208			}
209			}
210			}
211			volume=vol;
212			cdm.change_x(xg/volume);
213			cdm.change_y(yg/volume);
214			cdm.change_z(zg/volume);
215			inertieglobale(0,0)=a*dens;
216			inertieglobale(1,1)=b*dens;
217			inertieglobale(2,2)=c*dens;
218			inertieglobale(1,0)=f*dens;
219			inertieglobale(0,1)=f*dens;
220			inertieglobale(2,0)=e*dens;
221			inertieglobale(0,2)=e*dens;
222			inertieglobale(2,1)=d*dens;
223			inertieglobale(1,2)=d*dens;
224			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());
225			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());
226			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()));
227			m1=(-1.)*m1;
228			m2=(-1.)*m2;
229			m3=(-1.)*m3;
230			OT_MATRICE_3D change(m1,m2,m3);
231			inertiecdm=inertieglobale+change;
232			}
233		5