mg_boucle.cpp

Aller à la documentation de ce fichier.

//####//------------------------------------------------------------
//####//------------------------------------------------------------
//####//  MAGiC
//####//  Jean Christophe Cuilliere et Vincent FRANCOIS
//####//  Departement de Genie Mecanique - UQTR
//####//------------------------------------------------------------
//####//  MAGIC est un projet de recherche de l equipe ERICCA
//####//  du departement de genie mecanique de l Universite du Quebec a Trois Rivieres
//####//  http://www.uqtr.ca/ericca
//####//  http://www.uqtr.ca/
//####//------------------------------------------------------------
//####//------------------------------------------------------------
//####//
//####//       mg_boucle.cpp
//####//
//####//------------------------------------------------------------
//####//------------------------------------------------------------
//####//    COPYRIGHT 2000-2024
//####//  jeu 13 jun 2024 11:58:55 EDT
//####//------------------------------------------------------------
//####//------------------------------------------------------------
 
 
#include "gestionversion.h"
#include "mg_boucle.h"
#include "ot_mathematique.h"
#include "mg_definition.h"
#include <math.h>
 
MG_BOUCLE::MG_BOUCLE(unsigned long num,class MG_FACE* mgface):MG_ELEMENT_COTOPOLOGIQUE(num),face(mgface),poutre(NULL)
{
}
 
 
MG_BOUCLE::MG_BOUCLE(class MG_FACE* mgface):MG_ELEMENT_COTOPOLOGIQUE(),face(mgface),poutre(NULL)
{
}
 
MG_BOUCLE::MG_BOUCLE(unsigned long num,class MG_POUTRE* mgpou):MG_ELEMENT_COTOPOLOGIQUE(num),face(NULL),poutre(mgpou)
{
}
 
 
MG_BOUCLE::MG_BOUCLE(class MG_POUTRE* mgpou):MG_ELEMENT_COTOPOLOGIQUE(),face(NULL),poutre(mgpou)
{
}
 
MG_BOUCLE::MG_BOUCLE(long unsigned int num): MG_ELEMENT_COTOPOLOGIQUE(num),face(NULL),poutre(NULL)
{
 
}
 
MG_BOUCLE::MG_BOUCLE():MG_ELEMENT_COTOPOLOGIQUE(),face(NULL),poutre(NULL)
{
 
}
 
MG_BOUCLE::MG_BOUCLE(MG_BOUCLE& mdd):MG_ELEMENT_COTOPOLOGIQUE(),face(mdd.face),lst_coarete(mdd.lst_coarete)
{
}
 
 
MG_BOUCLE::~MG_BOUCLE()
{
}
 
int MG_BOUCLE::get_type(void)
{
  return TYPE_ELEMENT_COTOPOLOGIQUE::BOUCLE;
}
 
 
void MG_BOUCLE::ajouter_mg_coarete(class MG_COARETE* mgcoarete)
{
    lst_coarete.insert(lst_coarete.end(),mgcoarete);
}
 
int MG_BOUCLE::get_nb_mg_coarete(void)
{
    return lst_coarete.size();
}
 
 
MG_COARETE* MG_BOUCLE::get_mg_coarete(int num)
{
    return lst_coarete[num];
}
 
void MG_BOUCLE::supprimer_mg_coarete(class MG_COARETE* mgcoarete)
{
    std::vector<MG_COARETE*>::iterator i;
    for (i=lst_coarete.begin();i!=lst_coarete.end();i++)
    {
        if ((*i)==mgcoarete)
        {
            lst_coarete.erase(i);
            return;
        }
    }
}
 
MG_FACE* MG_BOUCLE::get_mg_face(void)
{
    return face;
}
 
MG_COARETE* MG_BOUCLE::get_mg_coarete_suivante(MG_COARETE* coare)
{
    MG_COARETE* coaretesuivante=NULL;
    MG_SOMMET* mgsommet;
    if (coare->get_orientation()==MEME_SENS) mgsommet=coare->get_arete()->get_cosommet2()->get_sommet();
    else mgsommet=coare->get_arete()->get_cosommet1()->get_sommet();
    double xyz[3];
    mgsommet->get_point()->evaluer(xyz);
    int nb=lst_coarete.size();
    MG_COARETE* mgcoaretetmp=NULL;
    double angleref=0.;
    double angleref2=0.;
    int trouve=0;
    for (int i=0;i<nb;i++)
    {
        MG_COARETE* mgcoarete_suivante=lst_coarete[i];
        MG_SOMMET* mgsommet_suivant;
        if (mgcoarete_suivante->get_orientation()==MEME_SENS) mgsommet_suivant=mgcoarete_suivante->get_arete()->get_cosommet1()->get_sommet();
        else mgsommet_suivant=mgcoarete_suivante->get_arete()->get_cosommet2()->get_sommet();
        if (mgsommet==mgsommet_suivant)
        {
            if (trouve==0)
            {
                trouve=1;
                mgcoaretetmp=mgcoarete_suivante;
            }
            else
            {
                //angleref
                double uv[2];
                face->inverser(uv,xyz);
                double normal[3];
                face->calcul_normale_unitaire(uv,normal);
                double dir1[3];
                double dir2[3];
                MG_COSOMMET* mgcosommet;
                if (coare->get_orientation()==MEME_SENS) mgcosommet=coare->get_arete()->get_cosommet2();
                else mgcosommet=coare->get_arete()->get_cosommet1();
                coare->get_arete()->deriver(mgcosommet->get_t(),dir1);
                if (mgcoaretetmp->get_orientation()==MEME_SENS) mgcosommet=mgcoaretetmp->get_arete()->get_cosommet1();
                else mgcosommet=mgcoaretetmp->get_arete()->get_cosommet2();
                mgcoaretetmp->get_arete()->deriver(mgcosommet->get_t(),dir2);
                int sens1=coare->get_orientation();
                int sens2=mgcoaretetmp->get_orientation();
                OT_VECTEUR_3D vec1(-dir1[0]*sens1,-dir1[1]*sens1,-dir1[2]*sens1);
                OT_VECTEUR_3D vec2(dir2[0]*sens2,dir2[1]*sens2,dir2[2]*sens2);
                vec1.norme();
                vec2.norme();
                OT_VECTEUR_3D nor=normal&vec1;
                double cs=vec1*vec2;
                double sn=-1*(vec2*nor);
                angleref=acos(cs);
                if (sn<0) angleref=-angleref;
                if (angleref<0) angleref=angleref+2.*M_PI;
                if (coare->get_arete()==mgcoaretetmp->get_arete()) angleref=2*M_PI;
                if (angleref<1e-10)
                {
                    double dt=1e-3*(mgcoaretetmp->get_arete()->get_tmax()-mgcoaretetmp->get_arete()->get_tmin());
                    mgcoaretetmp->get_arete()->deriver(mgcosommet->get_t()+dt,dir2);
                    OT_VECTEUR_3D vec2(dir2[0]*sens2,dir2[1]*sens2,dir2[2]*sens2);
                    vec2.norme();
                    double cs=vec1*vec2;
                    double sn=-1*(vec2*nor);
                    angleref=acos(cs);
                    if (sn<0) angleref2=-angleref2;
                    if (angleref<0) angleref2=angleref2+2.*M_PI;
                }
                //angle
                if (coare->get_orientation()==MEME_SENS) mgcosommet=coare->get_arete()->get_cosommet2();
                else mgcosommet=coare->get_arete()->get_cosommet1();
                coare->get_arete()->deriver(mgcosommet->get_t(),dir1);
                if (mgcoarete_suivante->get_orientation()==MEME_SENS) mgcosommet=mgcoarete_suivante->get_arete()->get_cosommet1();
                else mgcosommet=mgcoarete_suivante->get_arete()->get_cosommet2();
                mgcoarete_suivante->get_arete()->deriver(mgcosommet->get_t(),dir2);
                sens1=coare->get_orientation();
                sens2=mgcoarete_suivante->get_orientation();
                vec1.change_x(-dir1[0]*sens1);
                vec1.change_y(-dir1[1]*sens1);
                vec1.change_z(-dir1[2]*sens1);
                vec2.change_x(dir2[0]*sens2);
                vec2.change_y(dir2[1]*sens2);
                vec2.change_z(dir2[2]*sens2);
                vec1.norme();
                vec2.norme();
                nor=normal&vec1;
                cs=vec1*vec2;
                sn=-1*(vec2*nor);
                double angle=acos(cs);
                if (sn<0) angle=-angle;
                if (angle<0) angle=angle+2.*M_PI;
                if (coare->get_arete()==mgcoarete_suivante->get_arete()) angle=2*M_PI;
                if (angle<angleref)
                {
                    angleref=angle;
                    mgcoaretetmp=mgcoarete_suivante;
                }
                else if ((angle<1e-10) && (angleref<1e-10))
                {
                    double dt=1e-3*(mgcoarete_suivante->get_arete()->get_tmax()-mgcoarete_suivante->get_arete()->get_tmin());
                    mgcoarete_suivante->get_arete()->deriver(mgcosommet->get_t()+dt,dir2);
                    OT_VECTEUR_3D vec2(dir2[0]*sens2,dir2[1]*sens2,dir2[2]*sens2);
                    vec2.norme();
                    double cs=vec1*vec2;
                    double sn=-1*(vec2*nor);
                    angle=acos(cs);
                    if (sn<0) angle=-angle;
                    if (angle<0) angle=angle+2.*M_PI;
                    if (angle<angleref2)
                        mgcoaretetmp=mgcoarete_suivante;
 
                }
 
            }
        }
    }
    coaretesuivante=mgcoaretetmp;
    return coaretesuivante;
}
 
MG_COARETE* MG_BOUCLE::get_mg_coarete_precedente(MG_COARETE* coare)
{
    MG_COARETE* coareteprecedente=NULL;
    MG_SOMMET* mgsommet;
    if (coare->get_orientation()==MEME_SENS) mgsommet=coare->get_arete()->get_cosommet1()->get_sommet();
    else mgsommet=coare->get_arete()->get_cosommet2()->get_sommet();
    double xyz[3];
    mgsommet->get_point()->evaluer(xyz);
    int nb=lst_coarete.size();
    MG_COARETE* mgcoaretetmp=NULL;
    double angleref=0.;
    double angleref2=0.;
    int trouve=0;
    for (int i=0;i<nb;i++)
    {
        MG_COARETE* mgcoarete_suivante=lst_coarete[i];
        MG_SOMMET* mgsommet_suivant;
        if (mgcoarete_suivante->get_orientation()==MEME_SENS) mgsommet_suivant=mgcoarete_suivante->get_arete()->get_cosommet2()->get_sommet();
        else mgsommet_suivant=mgcoarete_suivante->get_arete()->get_cosommet1()->get_sommet();
        if (mgsommet==mgsommet_suivant)
        {
            if (trouve==0)
            {
                trouve=1;
                mgcoaretetmp=mgcoarete_suivante;
            }
            else
            {
                //angleref
                double uv[2];
                face->inverser(uv,xyz);
                double normal[3];
                face->calcul_normale_unitaire(uv,normal);
                double dir1[3];
                double dir2[3];
                MG_COSOMMET* mgcosommet;
                if (coare->get_orientation()==MEME_SENS) mgcosommet=coare->get_arete()->get_cosommet1();
                else mgcosommet=coare->get_arete()->get_cosommet2();
                coare->get_arete()->deriver(mgcosommet->get_t(),dir1);
                if (mgcoaretetmp->get_orientation()==MEME_SENS) mgcosommet=mgcoaretetmp->get_arete()->get_cosommet2();
                else mgcosommet=mgcoaretetmp->get_arete()->get_cosommet1();
                mgcoaretetmp->get_arete()->deriver(mgcosommet->get_t(),dir2);
                int sens1=coare->get_orientation();
                int sens2=mgcoaretetmp->get_orientation();
                OT_VECTEUR_3D vec1(dir1[0]*sens1,dir1[1]*sens1,dir1[2]*sens1);
                OT_VECTEUR_3D vec2(-dir2[0]*sens2,-dir2[1]*sens2,-dir2[2]*sens2);
                vec1.norme();
                vec2.norme();
                OT_VECTEUR_3D nor=normal&vec1;
                double cs=vec1*vec2;
                double sn=-1*(vec2*nor);
                angleref=acos(cs);
                if (sn<0) angleref=-angleref;
                if (angleref<0) angleref=angleref+2.*M_PI;
                if (coare->get_arete()==mgcoaretetmp->get_arete()) angleref=2*M_PI;
                if (angleref<1e-10)
                {
                    double dt=1e-3*(mgcoaretetmp->get_arete()->get_tmax()-mgcoaretetmp->get_arete()->get_tmin());
                    mgcoaretetmp->get_arete()->deriver(mgcosommet->get_t()+dt,dir2);
                    OT_VECTEUR_3D vec2(-dir2[0]*sens2,-dir2[1]*sens2,-dir2[2]*sens2);
                    vec2.norme();
                    double cs=vec1*vec2;
                    double sn=-1*(vec2*nor);
                    angleref=acos(cs);
                    if (sn<0) angleref2=-angleref2;
                    if (angleref<0) angleref2=angleref2+2.*M_PI;
                }
                //angle
                if (coare->get_orientation()==MEME_SENS) mgcosommet=coare->get_arete()->get_cosommet1();
                else mgcosommet=coare->get_arete()->get_cosommet2();
                coare->get_arete()->deriver(mgcosommet->get_t(),dir1);
                if (mgcoarete_suivante->get_orientation()==MEME_SENS) mgcosommet=mgcoarete_suivante->get_arete()->get_cosommet2();
                else mgcosommet=mgcoarete_suivante->get_arete()->get_cosommet1();
                mgcoarete_suivante->get_arete()->deriver(mgcosommet->get_t(),dir2);
                sens1=coare->get_orientation();
                sens2=mgcoarete_suivante->get_orientation();
                vec1.change_x(dir1[0]*sens1);
                vec1.change_y(dir1[1]*sens1);
                vec1.change_z(dir1[2]*sens1);
                vec2.change_x(-dir2[0]*sens2);
                vec2.change_y(-dir2[1]*sens2);
                vec2.change_z(-dir2[2]*sens2);
                vec1.norme();
                vec2.norme();
                nor=normal&vec1;
                cs=vec1*vec2;
                sn=-1*(vec2*nor);
                double angle=acos(cs);
                if (sn<0) angle=-angle;
                if (angle<0) angle=angle+2.*M_PI;
                if (coare->get_arete()==mgcoarete_suivante->get_arete()) angle=2*M_PI;
                if (angle<angleref)
                {
                    angleref=angle;
                    mgcoaretetmp=mgcoarete_suivante;
                }
                else if ((angle<1e-10) && (angleref<1e-10))
                {
                    double dt=1e-3*(mgcoarete_suivante->get_arete()->get_tmax()-mgcoarete_suivante->get_arete()->get_tmin());
                    mgcoarete_suivante->get_arete()->deriver(mgcosommet->get_t()+dt,dir2);
                    OT_VECTEUR_3D vec2(-dir2[0]*sens2,-dir2[1]*sens2,-dir2[2]*sens2);
                    vec2.norme();
                    double cs=vec1*vec2;
                    double sn=-1*(vec2*nor);
                    angle=acos(cs);
                    if (sn<0) angle=-angle;
                    if (angle<0) angle=angle+2.*M_PI;
                    if (angle<angleref2)
                        mgcoaretetmp=mgcoarete_suivante;
 
                }
 
            }
        }
    }
    coareteprecedente=mgcoaretetmp;
    return coareteprecedente;
}
 
void MG_BOUCLE::enregistrer(std::ostream& o,double version)
{
    if (face!=NULL) o << "%" << get_id() << "=BOUCLE($"<< face->get_id() << ",(";
    if (poutre!=NULL) o << "%" << get_id() << "=BOUCLE($"<< poutre->get_id() << ",(";
    for (unsigned int i=0;i<lst_coarete.size();i++)
    {
        o << "$" << lst_coarete[i]->get_id();
        if (i!=lst_coarete.size()-1) o << ",";
        else o << ")";
    }
    o << ");" << std::endl;
}