tpl_fonctions_generiques.h

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/
//####//------------------------------------------------------------
//####//------------------------------------------------------------
//####//
//####//       tpl_fonctions_generiques.h
//####//
//####//------------------------------------------------------------
//####//------------------------------------------------------------
//####//    COPYRIGHT 2000-2024
//####//  jeu 13 jun 2024 11:58:55 EDT
//####//------------------------------------------------------------
//####//------------------------------------------------------------
#ifndef _TPL_FONCTIONS_GENERIQUES_
#define _TPL_FONCTIONS_GENERIQUES_
 
#include <math.h>
 
template<class X> double get_angle_par_noeud(X noeud1,X noeud2,X noeud3,X noeud4,X noeud5,X noeud6)
    {
    X noeuda=NULL;
    X noeudb=NULL;
    X noeudc=NULL;
    X noeudd=NULL;
 
 
    if (!(noeud1==noeud4))
        if (!(noeud1==noeud5))
            if (!(noeud1==noeud6))
            {
                noeuda=noeud1;
                noeudb=noeud2;
                noeudc=noeud3;
            }
    if (!(noeud2==noeud4))
        if (!(noeud2==noeud5))
            if (!(noeud2==noeud6))
            {
                noeuda=noeud2;
                noeudb=noeud1;
                noeudc=noeud3;
            }
    if (!(noeud3==noeud4))
        if (!(noeud3==noeud5))
            if (!(noeud3==noeud6))
            {
                noeuda=noeud3;
                noeudb=noeud1;
                noeudc=noeud2;
            }
    if (noeuda==NULL) return 2*M_PI;
    if (!(noeud4==noeudb))
        if (!(noeud4==noeudc)) noeudd=noeud4;
    if (!(noeud5==noeudb))
        if (!(noeud5==noeudc)) noeudd=noeud5;
    if (!(noeud6==noeudb))
        if (!(noeud6==noeudc)) noeudd=noeud6;
 
    OT_VECTEUR_3D milieu(0.5*(noeudb->get_x()+noeudc->get_x()),0.5*(noeudb->get_y()+noeudc->get_y()),0.5*(noeudb->get_z()+noeudc->get_z()));
    OT_VECTEUR_3D bc(noeudc->get_x()-noeudb->get_x(),noeudc->get_y()-noeudb->get_y(),noeudc->get_z()-noeudb->get_z());
    bc.norme();
    double xyz[3];
    xyz[0]=noeuda->get_x();
    xyz[1]=noeuda->get_y();
    xyz[2]=noeuda->get_z();
    OT_VECTEUR_3D n1(xyz,milieu.get_xyz());
    n1.norme();
    OT_VECTEUR_3D n=bc&n1;
    n1=n&bc;
    n1.norme();
    xyz[0]=noeudd->get_x();
    xyz[1]=noeudd->get_y();
    xyz[2]=noeudd->get_z();
    OT_VECTEUR_3D n2(xyz,milieu.get_xyz());
    n2.norme();
    n=bc&n2;
    n2=n&bc;
    n2.norme();
 
    double ps=n1*n2;
    if (ps>1.) ps=1.;
    if (ps<-1.) ps=-1.;
    double angle=acos(ps);
    OT_VECTEUR_3D n1n2(noeud2->get_x()-noeud1->get_x(),noeud2->get_y()-noeud1->get_y(),noeud2->get_z()-noeud1->get_z());
    OT_VECTEUR_3D n1n3(noeud3->get_x()-noeud1->get_x(),noeud3->get_y()-noeud1->get_y(),noeud3->get_z()-noeud1->get_z());
    OT_VECTEUR_3D nbnd(noeudd->get_x()-noeudb->get_x(),noeudd->get_y()-noeudb->get_y(),noeudd->get_z()-noeudb->get_z());
    n=n1n2&n1n3;
    n.norme();
    nbnd.norme();
 
    ps=n*nbnd;
    if (ps<-0.0001) angle=2*M_PI-angle;
    return angle;
};
 
 
 
 
 
#endif