fct_generateur_echantillonage_estimation.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/
//####//------------------------------------------------------------
//####//------------------------------------------------------------
//####//
//####//       fct_generateur_echantillonage_estimation.cpp
//####//
//####//------------------------------------------------------------
//####//------------------------------------------------------------
//####//    COPYRIGHT 2000-2024
//####//  jeu 13 jun 2024 11:58:53 EDT
//####//------------------------------------------------------------
//####//------------------------------------------------------------
 
 
#include "gestionversion.h"
 
 
 
#include <math.h>
#include "fct_generateur_echantillonage_estimation.h"
#include "mg_gestionnaire.h"
#include "ct_face.h"
#include "ct_point.h"
 
 
 
 
FCT_GENERATEUR_ECHANTILLONAGE_ESTIMATION::FCT_GENERATEUR_ECHANTILLONAGE_ESTIMATION(double ecart,double ind1,double ind2):FCT_GENERATEUR_3D<4>(),zonezoom(ind1),zonetrans(ind2),dng(ecart),pas_echantillon(20),pas_estimation(20)
{
}
 
FCT_GENERATEUR_ECHANTILLONAGE_ESTIMATION::~FCT_GENERATEUR_ECHANTILLONAGE_ESTIMATION()
{
}
 
 
void FCT_GENERATEUR_ECHANTILLONAGE_ESTIMATION::estimation(void)
{
    BOITE_3D boite(xmin,ymin,zmin,xmax,ymax,zmax);
    double xc=boite.get_xcentre();
    double yc=boite.get_ycentre();
    double zc=boite.get_zcentre();
    double rayonx=1.125*(boite.get_xmax()-xc);
    double rayony=1.125*(boite.get_ymax()-yc);
    double rayonz=1.125*(boite.get_zmax()-zc);
    xmin=xc-rayonx;
    ymin=yc-rayony;
    zmin=zc-rayonz;
    xmax=xc+rayonx;
    ymax=yc+rayony;
    zmax=zc+rayonz;
    boite.reinit(xmin,ymin,zmin,xmax,ymax,zmax);
    grille.initialiser(boite.get_xmin(),boite.get_ymin(),boite.get_zmin(),boite.get_xmax(),boite.get_ymax(),boite.get_zmax(),pas_estimation,pas_estimation,pas_estimation);
    int nb_point=lstpoint.get_nb();
    for (int i=0;i<nb_point;i++)
        grille.inserer(lstpoint.get(i));
    double *tabxyz=new double[(pas_estimation+1)*(pas_estimation+1)*(pas_estimation+1)*4];
#define tabxyz(a,b,c,d)      (*(tabxyz+((((a)*(pas_estimation+1)+(b))*(pas_estimation+1)+(c))*4+(d))))
    double valmax=-1e308;
    for (int i=0;i<pas_estimation+1;i++)
        for (int j=0;j<pas_estimation+1;j++)
            for (int k=0;k<pas_estimation+1;k++)
            {
                double x=xmin+1.0*i/pas_estimation*(xmax-xmin);
                double y=ymin+1.0*j/pas_estimation*(ymax-ymin);
                double z=zmin+1.0*k/pas_estimation*(zmax-zmin);
                tabxyz(i,j,k,0)=estimer(x,y,z);
                if (i!=pas_estimation-1) tabxyz(i,j,k,1)=(estimer(x+1e-6,y,z)-tabxyz(i,j,k,0))/1e-6;
                else tabxyz(i,j,k,1)=(estimer(x-1e-6,y,z)-tabxyz(i,j,k,0))/1e-6;
                if (j!=pas_estimation-1) tabxyz(i,j,k,2)=(estimer(x,y+1e-6,z)-tabxyz(i,j,k,0))/1e-6;
                else tabxyz(i,j,k,2)=(estimer(x,y-1e-6,z)-tabxyz(i,j,k,0))/1e-6;
                if (k!=pas_estimation-1) tabxyz(i,j,k,3)=(estimer(x,y,z+1e-6)-tabxyz(i,j,k,0))/1e-6;
                else tabxyz(i,j,k,3)=(estimer(x,y,z-1e-6)-tabxyz(i,j,k,0))/1e-6;
                if (tabxyz(i,j,k,0)>valmax)
                {
                    DOUBLEN<4> ecart(&(tabxyz(i,j,k,0)));
                    valeurmax=ecart;
                    valmax=tabxyz(i,j,k,0);
                }
            }
#undef tabxyz
#define tabxyz(a,b,c)      (tabxyz+((((a)*(pas_estimation+1)+(b))*(pas_estimation+1)+(c))*4))
    for (int i=0;i<pas_estimation;i++)
        for (int j=0;j<pas_estimation;j++)
            for (int k=0;k<pas_estimation;k++)
            {
                TPL_CELLULE_GRILLE_INFO<CT_POINT<1> *,DOUBLEN<4> > *cell=grille.get_cellule(i,j,k);
                DOUBLEN<4> ecart0(tabxyz(i,j,k));
                cell->change_info(0,ecart0);
                DOUBLEN<4> ecart1(tabxyz(i+1,j,k));
                cell->change_info(1,ecart1);
                DOUBLEN<4> ecart2(tabxyz(i+1,j+1,k));
                cell->change_info(2,ecart2);
                DOUBLEN<4> ecart3(tabxyz(i,j+1,k));
                cell->change_info(3,ecart3);
                DOUBLEN<4> ecart4(tabxyz(i,j,k+1));
                cell->change_info(4,ecart4);
                DOUBLEN<4> ecart5(tabxyz(i+1,j,k+1));
                cell->change_info(5,ecart5);
                DOUBLEN<4> ecart6(tabxyz(i+1,j+1,k+1));
                cell->change_info(6,ecart6);
                DOUBLEN<4> ecart7(tabxyz(i,j+1,k+1));
                cell->change_info(7,ecart7);
            }
#undef tabxyz
    legende[0]="F(x,y,z)";
    legende[1]="dF/dx";
    legende[2]="dF/dy";
    legende[3]="dF/dz";
    delete [] tabxyz;
    for (int i=0;i<nb_point;i++)
    {
        CT_POINT<1> *pt=lstpoint.get(i);
        delete pt;
    }
 
 
}
 
 
double FCT_GENERATEUR_ECHANTILLONAGE_ESTIMATION::estimer(double x,double y,double z)
{
    TPL_MAP_ENTITE<CT_POINT<1> *>  lst_cellule;
    grille.rechercher(x,y,z,1e-10,lst_cellule);
    int nb_zone=lst_cellule.get_nb();
    double rmin=1;
    double nume=0.;
    double deno=0.;
    int nb_terme=0;
    double delta=0.;
    double F=0.;
    double r=0.;
 
    for (int i=0;i<nb_zone;i++)
    {
        CT_POINT<1>* pt=lst_cellule.get(i);
        BOITE_3D btpt(x,y,z,x,y,z);
        if (pt->get_boite_3D()*btpt)
        {
         
            double xyz[3];
            pt->evaluer(xyz);
            double dist=(x-xyz[0])*(x-xyz[0])+(y-xyz[1])*(y-xyz[1])+(z-xyz[2])*(z-xyz[2]);
            dist=sqrt(dist);
            DOUBLEN<1> ecart=pt->get_valeur();
            double dnn=ecart.get_valeur(0);
            if (OPERATEUR::egal(dist,0.,1e-10)) return dnn;
            delta=0.5*(pt->get_boite_3D().get_xmax()-pt->get_boite_3D().get_xmin()); // Attention n�cessite des boites cubiques! dx=dy=dz
            if (dist<delta)
            {
                r=dist/delta;
                F=pt->get_fonction_influence(r);
                nume=nume+dnn*F;
                deno=deno+F;
                nb_terme++;
                if (r<rmin) rmin=r;
            }
        }
    }
    if (nb_terme==0) return dng;
 
    F=rmin;
    nume=nume+dng*zonetrans*nb_terme*F;
    deno=deno+zonetrans*nb_terme*F;
 
    return nume/deno;
}
 
double FCT_GENERATEUR_ECHANTILLONAGE_ESTIMATION::estimer(double x,double y,double z, double crb)
{
    TPL_MAP_ENTITE<CT_POINT<1> *>  lst_cellule;
    grille.rechercher(x,y,z,1e-10,lst_cellule);
    int nb_zone=lst_cellule.get_nb();
    double rmin=1;
    double nume=0.;
    double deno=0.;
    int nb_terme=0;
    double delta=0.;
    double F=0.;
    double r=0.;
    for (int i=0;i<nb_zone;i++)
    {
        CT_POINT<1>* pt=lst_cellule.get(i);
        BOITE_3D btpt(x,y,z,x,y,z);
        if (pt->get_boite_3D()*btpt)
        {
            double xyz[3];
            pt->evaluer(xyz);
            double dist=(x-xyz[0])*(x-xyz[0])+(y-xyz[1])*(y-xyz[1])+(z-xyz[2])*(z-xyz[2]);
            dist=sqrt(dist);
            DOUBLEN<1> ecart=pt->get_valeur();
            double dnn=ecart.get_valeur(0);
            if (OPERATEUR::egal(dist,0.,1e-10)) return dnn;
            delta=0.5*(pt->get_boite_3D().get_xmax()-pt->get_boite_3D().get_xmin()); // Attention n�cessite des boites cubiques! dx=dy=dz
            if (dist<delta)
            {
                r=dist/delta;
                F=pt->get_fonction_influence(r,crb);
                nume=nume+dnn*F;
                deno=deno+F;
                nb_terme++;
                if (r<rmin) rmin=r;
            }
        }
    }
    if (nb_terme==0) return dng;
 
    F=rmin;
    nume=nume+dng*zonetrans*nb_terme*F;
    deno=deno+zonetrans*nb_terme*F;
 
    return nume/deno;
}