step/src/stcircle.cpp

//####//------------------------------------------------------------
//####//------------------------------------------------------------
//####//  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/
//####//------------------------------------------------------------
//####//------------------------------------------------------------
//####//
//####//       stcircle.cpp
//####//
//####//------------------------------------------------------------
//####//------------------------------------------------------------
//####//    COPYRIGHT 2000-2024
//####//  jeu 13 jun 2024 11:53:59 EDT
//####//------------------------------------------------------------
//####//------------------------------------------------------------


#include "stcircle.h"
#include "st_gestionnaire.h"
#include "constantegeo.h"

#include <math.h>


ST_CIRCLE::ST_CIRCLE(long LigneCourante,std::string idori,long axis2,double ray):ST_COURBE(LigneCourante,idori),id_axis2_placement_3d(axis2),rayon(ray)
{
}

ST_CIRCLE::ST_CIRCLE(double *xyz,double *nor,double ray):ST_COURBE(),rayon(ray)
{
    initialiser(xyz,nor);
}


long ST_CIRCLE::get_id_axis2_placement_3d(void)
{
    return id_axis2_placement_3d;
}

double ST_CIRCLE::get_rayon(void)
{
    return rayon;
}

void  ST_CIRCLE::evaluer(double t,double *xyz)
{
    OT_VECTEUR_3D local(rayon*cos(t),rayon*sin(t),0.);
    OT_VECTEUR_3D global=origine+repere*local;
    xyz[0]=global.get_x();
    xyz[1]=global.get_y();
    xyz[2]=global.get_z();
}
void  ST_CIRCLE::deriver(double t,double *dxyz)
{
    OT_VECTEUR_3D local(-rayon*sin(t),rayon*cos(t),0.);
    OT_VECTEUR_3D global=repere*local;
    dxyz[0]=global.get_x();
    dxyz[1]=global.get_y();
    dxyz[2]=global.get_z();
}
void  ST_CIRCLE::deriver_seconde(double t,double *ddxyz,double* dxyz ,double* xyz )
{
    OT_VECTEUR_3D local(-rayon*cos(t),-rayon*sin(t),0.);
    OT_VECTEUR_3D global=repere*local;
    ddxyz[0]=global.get_x();
    ddxyz[1]=global.get_y();
    ddxyz[2]=global.get_z();
    if (dxyz!=NULL) deriver(t,dxyz);
    if (xyz!=NULL) evaluer(t,xyz);
}
void  ST_CIRCLE::inverser(double& t,double *xyz,double precision)
{
    double sign;
    double valeur;
    OT_VECTEUR_3D global(xyz[0],xyz[1],xyz[2]);
    OT_MATRICE_3D transpose_repere;
    repere.transpose(transpose_repere);
    OT_VECTEUR_3D vecteur=transpose_repere*(global-origine);
    valeur=vecteur.get_x()/rayon;
    if (valeur>1) valeur=1;
    if (valeur<-1) valeur=-1;
    t=acos(valeur);
    sign=vecteur.get_y()/rayon;
    if (sign<-0.000001) t= 2.*M_PI-t;
}

double  ST_CIRCLE::get_tmin()
{
    return 0.;
}
double  ST_CIRCLE::get_tmax()
{
    return 2.*M_PI;
}
double ST_CIRCLE::get_longueur(double t1,double t2,double precis)
{
    return rayon*(t2-t1);
}
int ST_CIRCLE::est_periodique(void)
{
    return 1;
}

double ST_CIRCLE::get_periode(void)
{
    return 2.*M_PI;
}


void ST_CIRCLE::initialiser(ST_GESTIONNAIRE *gest)
{
    ST_AXIS2_PLACEMENT_3D* axe=gest->lst_axis2_placement_3d.getid(id_axis2_placement_3d);
    ST_DIRECTION* dirz=gest->lst_direction.getid(axe->get_id_direction1());
    ST_DIRECTION* dirx=gest->lst_direction.getid(axe->get_id_direction2());
    ST_POINT* point=gest->lst_point.getid(axe->get_id_point());
    double xyz[3];
    point->evaluer(xyz);
    double *dirzval=dirz->get_direction();
    double *dirxval=NULL;
    if (dirx!=NULL) dirxval=dirx->get_direction();
    initialiser(xyz,dirzval,dirxval);
}

void ST_CIRCLE::initialiser(double *xyz,double *dirz,double *dirx)
{
    origine.change_x(xyz[0]);
    origine.change_y(xyz[1]);
    origine.change_z(xyz[2]);
    OT_VECTEUR_3D z(dirz[0],dirz[1],dirz[2]);
    z.norme();
    double vectmp[3];
    if (dirx==NULL)
    {
        vectmp[0]=1.;
        if (!(OPERATEUR::egal(z.get_z(),0.,0.0000001)))
        {
            vectmp[1]=0;
            vectmp[2]=-vectmp[0]*z.get_x()/z.get_z();
        }
        else if (!(OPERATEUR::egal(z.get_y(),0.,0.0000001)))
        {
            vectmp[2]=0;
            vectmp[1]=-vectmp[0]*z.get_x()/z.get_y();
        }
        else
        {
            vectmp[0]=0.;
            vectmp[1]=1.;
            vectmp[2]=0.;
        }

        dirx=vectmp;
    }
    OT_VECTEUR_3D x(dirx[0],dirx[1],dirx[2]);
    x.norme();
    OT_VECTEUR_3D y=z&x;
    repere.change_vecteur1(x);
    repere.change_vecteur2(y);
    repere.change_vecteur3(z);
}

int ST_CIRCLE::get_type_geometrique(TPL_LISTE_ENTITE<double> &param)
{
    param.ajouter(origine.get_x());
    param.ajouter(origine.get_y());
    param.ajouter(origine.get_z());
    param.ajouter(repere.get_vecteur1().get_x());
    param.ajouter(repere.get_vecteur1().get_y());
    param.ajouter(repere.get_vecteur1().get_z());
    param.ajouter(repere.get_vecteur3().get_x());
    param.ajouter(repere.get_vecteur3().get_y());
    param.ajouter(repere.get_vecteur3().get_z());
    param.ajouter(rayon);
    return GEOMETRIE::CONST::Co_CIRCLE;
}


void ST_CIRCLE::get_param_NURBS(int& indx_premier_ptctr,TPL_LISTE_ENTITE<double> &param)
{
    double xyz[3];
    param.ajouter(1);


    param.ajouter(4);
    param.ajouter(0);


    param.ajouter(7);
    param.ajouter(0);


    param.ajouter(0);
    param.ajouter(0);
    param.ajouter(0);
    param.ajouter(0.25);
    param.ajouter(0.5);
    param.ajouter(0.5);
    param.ajouter(0.75);
    param.ajouter(1);
    param.ajouter(1);
    param.ajouter(1);


    OT_VECTEUR_3D loc(rayon,0,0);
    OT_VECTEUR_3D glob=origine+repere*loc;

    xyz[0]=glob.get_x();
    xyz[1]=glob.get_y();
    xyz[2]=glob.get_z();

    param.ajouter(xyz[0]);
    param.ajouter(xyz[1]);
    param.ajouter(xyz[2]);
    param.ajouter(1);


    loc.change_y(rayon);
    glob=origine+repere*loc;

    xyz[0]=glob.get_x();
    xyz[1]=glob.get_y();
    xyz[2]=glob.get_z();

    param.ajouter(xyz[0]);
    param.ajouter(xyz[1]);
    param.ajouter(xyz[2]);
    param.ajouter(0.5);


    loc.change_x(-rayon);
    glob=origine+repere*loc;


    xyz[0]=glob.get_x();
    xyz[1]=glob.get_y();
    xyz[2]=glob.get_z();

    param.ajouter(xyz[0]);
    param.ajouter(xyz[1]);
    param.ajouter(xyz[2]);
    param.ajouter(0.5);


    loc.change_y(0);

    glob=origine+repere*loc;

    xyz[0]=glob.get_x();
    xyz[1]=glob.get_y();
    xyz[2]=glob.get_z();

    param.ajouter(xyz[0]);
    param.ajouter(xyz[1]);
    param.ajouter(xyz[2]);
    param.ajouter(1);


    loc.change_y(-rayon);

    glob=origine+repere*loc;


    xyz[0]=glob.get_x();
    xyz[1]=glob.get_y();
    xyz[2]=glob.get_z();

    param.ajouter(xyz[0]);
    param.ajouter(xyz[1]);
    param.ajouter(xyz[2]);
    param.ajouter(0.5);


    loc.change_x(rayon);

    glob=origine+repere*loc;


    xyz[0]=glob.get_x();
    xyz[1]=glob.get_y();
    xyz[2]=glob.get_z();

    param.ajouter(xyz[0]);
    param.ajouter(xyz[1]);
    param.ajouter(xyz[2]);
    param.ajouter(0.5);


    loc.change_y(0);

    glob=origine+repere*loc;

    xyz[0]=glob.get_x();
    xyz[1]=glob.get_y();
    xyz[2]=glob.get_z();

    param.ajouter(xyz[0]);
    param.ajouter(xyz[1]);
    param.ajouter(xyz[2]);
    param.ajouter(1);

    indx_premier_ptctr=15;

}


void ST_CIRCLE::est_util(ST_GESTIONNAIRE* gest)
{
    util=true;
    ST_AXIS2_PLACEMENT_3D *axe=gest->lst_axis2_placement_3d.getid(id_axis2_placement_3d);
    axe->est_util(gest);
}

Revision:	1156
Committed:	Thu Jun 13 22:02:48 2024 UTC (14 months ago) by francois
File size:	7587 byte(s)
Log Message:	compatibilité Ubuntu 22.04 Suppression des refeences à Windows Ajout d'une banière
#	User	Rev	Content
1	francois	1156	//####//------------------------------------------------------------
2			//####//------------------------------------------------------------
3			//####// MAGiC
4			//####// Jean Christophe Cuilliere et Vincent FRANCOIS
5			//####// Departement de Genie Mecanique - UQTR
6			//####//------------------------------------------------------------
7			//####// MAGIC est un projet de recherche de l equipe ERICCA
8			//####// du departement de genie mecanique de l Universite du Quebec a Trois Rivieres
9			//####// http://www.uqtr.ca/ericca
10			//####// http://www.uqtr.ca/
11			//####//------------------------------------------------------------
12			//####//------------------------------------------------------------
13			//####//
14			//####// stcircle.cpp
15			//####//
16			//####//------------------------------------------------------------
17			//####//------------------------------------------------------------
18			//####// COPYRIGHT 2000-2024
19			//####// jeu 13 jun 2024 11:53:59 EDT
20			//####//------------------------------------------------------------
21			//####//------------------------------------------------------------
22	francois	283
23
24
25			#include "stcircle.h"
26			#include "st_gestionnaire.h"
27			#include "constantegeo.h"
28
29			#include <math.h>
30
31
32
33
34
35			ST_CIRCLE::ST_CIRCLE(long LigneCourante,std::string idori,long axis2,double ray):ST_COURBE(LigneCourante,idori),id_axis2_placement_3d(axis2),rayon(ray)
36			{
37			}
38
39			ST_CIRCLE::ST_CIRCLE(double xyz,double nor,double ray):ST_COURBE(),rayon(ray)
40			{
41			initialiser(xyz,nor);
42			}
43
44
45			long ST_CIRCLE::get_id_axis2_placement_3d(void)
46			{
47			return id_axis2_placement_3d;
48			}
49
50			double ST_CIRCLE::get_rayon(void)
51			{
52			return rayon;
53			}
54
55			void ST_CIRCLE::evaluer(double t,double *xyz)
56			{
57			OT_VECTEUR_3D local(rayoncos(t),rayonsin(t),0.);
58			OT_VECTEUR_3D global=origine+repere*local;
59			xyz[0]=global.get_x();
60			xyz[1]=global.get_y();
61			xyz[2]=global.get_z();
62			}
63			void ST_CIRCLE::deriver(double t,double *dxyz)
64			{
65			OT_VECTEUR_3D local(-rayonsin(t),rayoncos(t),0.);
66			OT_VECTEUR_3D global=repere*local;
67			dxyz[0]=global.get_x();
68			dxyz[1]=global.get_y();
69			dxyz[2]=global.get_z();
70			}
71			void ST_CIRCLE::deriver_seconde(double t,double ddxyz,double dxyz ,double* xyz )
72			{
73			OT_VECTEUR_3D local(-rayoncos(t),-rayonsin(t),0.);
74			OT_VECTEUR_3D global=repere*local;
75			ddxyz[0]=global.get_x();
76			ddxyz[1]=global.get_y();
77			ddxyz[2]=global.get_z();
78			if (dxyz!=NULL) deriver(t,dxyz);
79			if (xyz!=NULL) evaluer(t,xyz);
80			}
81			void ST_CIRCLE::inverser(double& t,double *xyz,double precision)
82			{
83			double sign;
84			double valeur;
85			OT_VECTEUR_3D global(xyz[0],xyz[1],xyz[2]);
86			OT_MATRICE_3D transpose_repere;
87			repere.transpose(transpose_repere);
88			OT_VECTEUR_3D vecteur=transpose_repere*(global-origine);
89			valeur=vecteur.get_x()/rayon;
90			if (valeur>1) valeur=1;
91			if (valeur<-1) valeur=-1;
92			t=acos(valeur);
93			sign=vecteur.get_y()/rayon;
94			if (sign<-0.000001) t= 2.*M_PI-t;
95			}
96
97			double ST_CIRCLE::get_tmin()
98			{
99			return 0.;
100			}
101			double ST_CIRCLE::get_tmax()
102			{
103			return 2.*M_PI;
104			}
105			double ST_CIRCLE::get_longueur(double t1,double t2,double precis)
106			{
107			return rayon*(t2-t1);
108			}
109			int ST_CIRCLE::est_periodique(void)
110			{
111			return 1;
112			}
113
114			double ST_CIRCLE::get_periode(void)
115			{
116			return 2.*M_PI;
117			}
118
119
120			void ST_CIRCLE::initialiser(ST_GESTIONNAIRE *gest)
121			{
122			ST_AXIS2_PLACEMENT_3D* axe=gest->lst_axis2_placement_3d.getid(id_axis2_placement_3d);
123			ST_DIRECTION* dirz=gest->lst_direction.getid(axe->get_id_direction1());
124			ST_DIRECTION* dirx=gest->lst_direction.getid(axe->get_id_direction2());
125			ST_POINT* point=gest->lst_point.getid(axe->get_id_point());
126			double xyz[3];
127			point->evaluer(xyz);
128			double *dirzval=dirz->get_direction();
129			double *dirxval=NULL;
130			if (dirx!=NULL) dirxval=dirx->get_direction();
131			initialiser(xyz,dirzval,dirxval);
132			}
133
134			void ST_CIRCLE::initialiser(double xyz,double dirz,double *dirx)
135			{
136			origine.change_x(xyz[0]);
137			origine.change_y(xyz[1]);
138			origine.change_z(xyz[2]);
139			OT_VECTEUR_3D z(dirz[0],dirz[1],dirz[2]);
140			z.norme();
141			double vectmp[3];
142			if (dirx==NULL)
143			{
144			vectmp[0]=1.;
145			if (!(OPERATEUR::egal(z.get_z(),0.,0.0000001)))
146			{
147			vectmp[1]=0;
148			vectmp[2]=-vectmp[0]*z.get_x()/z.get_z();
149			}
150			else if (!(OPERATEUR::egal(z.get_y(),0.,0.0000001)))
151			{
152			vectmp[2]=0;
153			vectmp[1]=-vectmp[0]*z.get_x()/z.get_y();
154			}
155			else
156			{
157			vectmp[0]=0.;
158			vectmp[1]=1.;
159			vectmp[2]=0.;
160			}
161
162			dirx=vectmp;
163			}
164			OT_VECTEUR_3D x(dirx[0],dirx[1],dirx[2]);
165			x.norme();
166			OT_VECTEUR_3D y=z&x;
167			repere.change_vecteur1(x);
168			repere.change_vecteur2(y);
169			repere.change_vecteur3(z);
170			}
171
172			int ST_CIRCLE::get_type_geometrique(TPL_LISTE_ENTITE<double> &param)
173			{
174			param.ajouter(origine.get_x());
175			param.ajouter(origine.get_y());
176			param.ajouter(origine.get_z());
177			param.ajouter(repere.get_vecteur1().get_x());
178			param.ajouter(repere.get_vecteur1().get_y());
179			param.ajouter(repere.get_vecteur1().get_z());
180			param.ajouter(repere.get_vecteur3().get_x());
181			param.ajouter(repere.get_vecteur3().get_y());
182			param.ajouter(repere.get_vecteur3().get_z());
183			param.ajouter(rayon);
184	francois	1149	return GEOMETRIE::CONST::Co_CIRCLE;
185	francois	283	}
186
187
188
189			void ST_CIRCLE::get_param_NURBS(int& indx_premier_ptctr,TPL_LISTE_ENTITE<double> &param)
190			{
191			double xyz[3];
192			param.ajouter(1);
193
194
195			param.ajouter(4);
196			param.ajouter(0);
197
198
199			param.ajouter(7);
200			param.ajouter(0);
201
202
203			param.ajouter(0);
204			param.ajouter(0);
205			param.ajouter(0);
206			param.ajouter(0.25);
207			param.ajouter(0.5);
208			param.ajouter(0.5);
209			param.ajouter(0.75);
210			param.ajouter(1);
211			param.ajouter(1);
212			param.ajouter(1);
213
214
215			OT_VECTEUR_3D loc(rayon,0,0);
216			OT_VECTEUR_3D glob=origine+repere*loc;
217
218			xyz[0]=glob.get_x();
219			xyz[1]=glob.get_y();
220			xyz[2]=glob.get_z();
221
222			param.ajouter(xyz[0]);
223			param.ajouter(xyz[1]);
224			param.ajouter(xyz[2]);
225			param.ajouter(1);
226
227
228			loc.change_y(rayon);
229			glob=origine+repere*loc;
230
231			xyz[0]=glob.get_x();
232			xyz[1]=glob.get_y();
233			xyz[2]=glob.get_z();
234
235			param.ajouter(xyz[0]);
236			param.ajouter(xyz[1]);
237			param.ajouter(xyz[2]);
238			param.ajouter(0.5);
239
240
241			loc.change_x(-rayon);
242			glob=origine+repere*loc;
243
244
245			xyz[0]=glob.get_x();
246			xyz[1]=glob.get_y();
247			xyz[2]=glob.get_z();
248
249			param.ajouter(xyz[0]);
250			param.ajouter(xyz[1]);
251			param.ajouter(xyz[2]);
252			param.ajouter(0.5);
253
254
255			loc.change_y(0);
256
257			glob=origine+repere*loc;
258
259			xyz[0]=glob.get_x();
260			xyz[1]=glob.get_y();
261			xyz[2]=glob.get_z();
262
263			param.ajouter(xyz[0]);
264			param.ajouter(xyz[1]);
265			param.ajouter(xyz[2]);
266			param.ajouter(1);
267
268
269
270
271			loc.change_y(-rayon);
272
273			glob=origine+repere*loc;
274
275
276			xyz[0]=glob.get_x();
277			xyz[1]=glob.get_y();
278			xyz[2]=glob.get_z();
279
280			param.ajouter(xyz[0]);
281			param.ajouter(xyz[1]);
282			param.ajouter(xyz[2]);
283			param.ajouter(0.5);
284
285
286			loc.change_x(rayon);
287
288			glob=origine+repere*loc;
289
290
291			xyz[0]=glob.get_x();
292			xyz[1]=glob.get_y();
293			xyz[2]=glob.get_z();
294
295			param.ajouter(xyz[0]);
296			param.ajouter(xyz[1]);
297			param.ajouter(xyz[2]);
298			param.ajouter(0.5);
299
300
301			loc.change_y(0);
302
303			glob=origine+repere*loc;
304
305			xyz[0]=glob.get_x();
306			xyz[1]=glob.get_y();
307			xyz[2]=glob.get_z();
308
309			param.ajouter(xyz[0]);
310			param.ajouter(xyz[1]);
311			param.ajouter(xyz[2]);
312			param.ajouter(1);
313
314			indx_premier_ptctr=15;
315
316			}
317
318
319
320			void ST_CIRCLE::est_util(ST_GESTIONNAIRE* gest)
321			{
322			util=true;
323			ST_AXIS2_PLACEMENT_3D *axe=gest->lst_axis2_placement_3d.getid(id_axis2_placement_3d);
324			axe->est_util(gest);
325			}
326