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:	283
Committed:	Tue Sep 13 21:11:20 2011 UTC (13 years, 8 months ago) by francois
File size:	7536 byte(s)
Log Message:	structure de l'écriture
#	User	Rev	Content
1	francois	283	//------------------------------------------------------------
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			// mg_volume.cpp
16			//
17			//------------------------------------------------------------
18			//------------------------------------------------------------
19			// COPYRIGHT 2000
20			// Version du 02/03/2006 ? 11H22
21			//------------------------------------------------------------
22			//------------------------------------------------------------
23
24
25			#include "gestionversion.h"
26			#include "mg_volume.h"
27			#include "ot_mathematique.h"
28			#include "mg_maillage.h"
29			#include "vct_volume.h"
30			//#include "message.h"
31
32			MG_VOLUME::MG_VOLUME(std::string idori,unsigned long num):MG_ELEMENT_TOPOLOGIQUE(num,idori),num_materiau(-1),vect(NULL)
33			{
34			}
35
36			MG_VOLUME::MG_VOLUME(std::string idori):MG_ELEMENT_TOPOLOGIQUE(idori),num_materiau(-1),vect(NULL)
37			{
38			}
39
40			MG_VOLUME::MG_VOLUME(MG_VOLUME& mdd):MG_ELEMENT_TOPOLOGIQUE(mdd),lst_coquille(mdd.lst_coquille),vect(mdd.vect)
41			{
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			VCT& MG_VOLUME::get_vectorisation(void)
82			{
83			//VCT* p=NULL;
84			//return *p;
85			if (vect==NULL) vect=new VCT_VOLUME(this);
86			return *vect;
87			}
88			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
104
105			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 << ",";
112			else o << ")";
113			}
114			int nb=get_nb_ccf();
115			o << "," << num_materiau << "," << nb;
116			if (nb!=0)
117			{
118			o << ",(";
119			for (int i=0;i<nb;i++)
120			{
121			char nom[3];
122			get_type_ccf(i,nom);
123			o << "(" << nom << "," << get_valeur_ccf(i) << ")";
124			if (i!=nb-1) o << "," ;
125			}
126			o << ")";
127			}
128			o << ");" << std::endl;
129			}
130
131			void MG_VOLUME::change_num_materiau(int num)
132			{
133			num_materiau=num;
134			}
135
136			int MG_VOLUME::get_num_materiau(void)
137			{
138			return num_materiau;
139			}
140
141			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)
142			{
143			double vol=0.;
144			double xg=0.;
145			double yg=0.;
146			double zg=0.;
147			double a=0.;
148			double b=0.;
149			double c=0.;
150			double d=0.;
151			double e=0.;
152			double f=0.;
153			int nbcoquille=get_nb_mg_coquille();
154			for (int i=0;i<nbcoquille;i++)
155			{
156			MG_COQUILLE* coq=get_mg_coquille(i);
157			int nbface=coq->get_nb_mg_coface();
158			for (int j=0;j<nbface;j++)
159			{
160			MG_COFACE* coface=coq->get_mg_coface(j);
161			MG_FACE* face=coface->get_face();
162			TPL_SET<MG_ELEMENT_MAILLAGE*>::ITERATEUR it;
163			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))
164			{
165			if (mai->get_mg_triangleid(tri->get_id())==NULL) continue;
166			MG_NOEUD* noeud1=tri->get_noeud1();
167			MG_NOEUD* noeud2=tri->get_noeud2();
168			MG_NOEUD* noeud3=tri->get_noeud3();
169			double *xyz1=noeud1->get_coord();
170			double *xyz2=noeud2->get_coord();
171			double *xyz3=noeud3->get_coord();
172			OT_VECTEUR_3D vec1(xyz1,xyz2);
173			OT_VECTEUR_3D vec2(xyz1,xyz3);
174			OT_VECTEUR_3D n=vec1&vec2;
175			double detj=n.get_longueur();
176			n.norme();
177			n=-1.coface->get_orientation()n;
178			for (int k=0;k<3;k++)
179			{
180			double xsi=1./6.;
181			double eta=1./6.;
182			double wi=1./6.;
183			if (k==1) xsi=2./3.;
184			if (k==2) eta=2./3.;
185			double x=(1-xsi-eta)xyz1[0]+xsixyz2[0]+eta*xyz3[0];
186			double y=(1-xsi-eta)xyz1[1]+xsixyz2[1]+eta*xyz3[1];
187			double z=(1-xsi-eta)xyz1[2]+xsixyz2[2]+eta*xyz3[2];
188			OT_VECTEUR_3D psi1(x,0,0);
189			OT_VECTEUR_3D psi2(0.5xx,0,0);
190			OT_VECTEUR_3D psi3(0,0.5yy,0);
191			OT_VECTEUR_3D psi4(0,0,0.5zz);
192			OT_VECTEUR_3D psi5(0,yyy/3.,zzz/3.);
193			OT_VECTEUR_3D psi6(xxx/3.,0,zzz/3.);
194			OT_VECTEUR_3D psi7(xxx/3.,yyy/3.,0);
195			OT_VECTEUR_3D psi8(0.,yyz/2.,0);
196			OT_VECTEUR_3D psi9(xxz/2.,0.,0);
197			OT_VECTEUR_3D psi10(xxy/2.,0,0);
198			vol=vol+detjwi(psi1*n);
199			xg=xg+widetj(psi2*n);
200			yg=yg+widetj(psi3*n);
201			zg=zg+widetj(psi4*n);
202			a=a+widetj(psi5*n);
203			b=b+widetj(psi6*n);
204			c=c+widetj(psi7*n);
205			d=d+widetj(psi8*n);
206			e=e+widetj(psi9*n);
207			f=f+widetj(psi10*n);
208			}
209			}
210			}
211			}
212			volume=vol;
213			cdm.change_x(xg/volume);
214			cdm.change_y(yg/volume);
215			cdm.change_z(zg/volume);
216			inertieglobale(0,0)=a*dens;
217			inertieglobale(1,1)=b*dens;
218			inertieglobale(2,2)=c*dens;
219			inertieglobale(1,0)=f*dens;
220			inertieglobale(0,1)=f*dens;
221			inertieglobale(2,0)=e*dens;
222			inertieglobale(0,2)=e*dens;
223			inertieglobale(2,1)=d*dens;
224			inertieglobale(1,2)=d*dens;
225			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());
226			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());
227			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()));
228			m1=(-1.)*m1;
229			m2=(-1.)*m2;
230			m3=(-1.)*m3;
231			OT_MATRICE_3D change(m1,m2,m3);
232			inertiecdm=inertieglobale+change;
233			}
234