| 1 |
|
1 |
/*****************************************************************
|
| 2 |
|
|
|
| 3 |
|
|
eval_plane.c Type:Func
|
| 4 |
|
|
|
| 5 |
|
|
Calcul divers sur un plan
|
| 6 |
|
|
|
| 7 |
|
|
Date de creation : Wed Feb 5 17:24:48 1997
|
| 8 |
|
|
|
| 9 |
|
|
Derniere version : Tue Apr 22 11:42:58 1997
|
| 10 |
|
|
|
| 11 |
|
|
|
| 12 |
|
|
|
| 13 |
|
|
|
| 14 |
|
|
|
| 15 |
|
|
|
| 16 |
|
|
|
| 17 |
|
|
Vincent FRANCOIS
|
| 18 |
|
|
|
| 19 |
|
|
*****************************************************************/
|
| 20 |
|
|
|
| 21 |
|
|
|
| 22 |
|
|
|
| 23 |
|
|
|
| 24 |
|
|
|
| 25 |
|
|
/**************************/
|
| 26 |
|
|
/* include */
|
| 27 |
|
|
#include <stdio.h>
|
| 28 |
|
|
#include <string.h>
|
| 29 |
|
|
#include <math.h>
|
| 30 |
|
|
#include "struct.h"
|
| 31 |
|
|
#include "const.h"
|
| 32 |
|
|
#include "prototype.h"
|
| 33 |
|
|
|
| 34 |
|
|
/**************************/
|
| 35 |
|
|
/* variables globales */
|
| 36 |
|
|
|
| 37 |
|
|
|
| 38 |
|
|
|
| 39 |
|
|
/**************************/
|
| 40 |
|
|
/* programme principal */
|
| 41 |
|
|
|
| 42 |
|
|
float eval_plane(struct s_face *face,struct s_par_plane *param,float *u,float *v,int type,float *x,float *y,float *z)
|
| 43 |
|
|
{
|
| 44 |
|
|
int n1,n2;
|
| 45 |
|
|
float res,det,coord[3];
|
| 46 |
|
|
float dir1[3];
|
| 47 |
|
|
|
| 48 |
|
|
memcpy(dir1,param->dir1,3*sizeof(float));
|
| 49 |
|
|
if (face->sense==REVERSED)
|
| 50 |
|
|
{
|
| 51 |
|
|
dir1[0]=(-dir1[0]);
|
| 52 |
|
|
dir1[1]=(-dir1[1]);
|
| 53 |
|
|
dir1[2]=(-dir1[2]);
|
| 54 |
|
|
}
|
| 55 |
|
|
if (type==FONCTION)
|
| 56 |
|
|
{
|
| 57 |
|
|
*x=param->root[0]+(*u)*dir1[0]+(*v)*param->dir2[0];
|
| 58 |
|
|
*y=param->root[1]+(*u)*dir1[1]+(*v)*param->dir2[1];
|
| 59 |
|
|
*z=param->root[2]+(*u)*dir1[2]+(*v)*param->dir2[2];
|
| 60 |
|
|
}
|
| 61 |
|
|
if (type==DU)
|
| 62 |
|
|
{
|
| 63 |
|
|
*x=dir1[0];
|
| 64 |
|
|
*y=dir1[1];
|
| 65 |
|
|
*z=dir1[2];
|
| 66 |
|
|
}
|
| 67 |
|
|
if (type==DV)
|
| 68 |
|
|
{
|
| 69 |
|
|
*x=param->dir2[0];
|
| 70 |
|
|
*y=param->dir2[1];
|
| 71 |
|
|
*z=param->dir2[2];
|
| 72 |
|
|
}
|
| 73 |
|
|
if (type==INVERSE)
|
| 74 |
|
|
{
|
| 75 |
|
|
coord[0]=(*x)-param->root[0];
|
| 76 |
|
|
coord[1]=(*y)-param->root[1];
|
| 77 |
|
|
coord[2]=(*z)-param->root[2];;
|
| 78 |
|
|
det=DETER(dir1[0],dir1[1],param->dir2[0],param->dir2[1]);
|
| 79 |
|
|
if (!(EGAL(det,0.0,0.0001)))
|
| 80 |
|
|
{
|
| 81 |
|
|
n1=0;n2=1;
|
| 82 |
|
|
}
|
| 83 |
|
|
else
|
| 84 |
|
|
{
|
| 85 |
|
|
det=DETER(dir1[0],dir1[2],param->dir2[0],param->dir2[2]);
|
| 86 |
|
|
if (!(EGAL(det,0.0,0.0001)))
|
| 87 |
|
|
{
|
| 88 |
|
|
n1=0;n2=2;
|
| 89 |
|
|
}
|
| 90 |
|
|
else
|
| 91 |
|
|
{
|
| 92 |
|
|
n1=1;n2=2;
|
| 93 |
|
|
det=DETER(dir1[1],dir1[2],param->dir2[1],param->dir2[2]);
|
| 94 |
|
|
}
|
| 95 |
|
|
}
|
| 96 |
|
|
*u=(DETER(coord[n1],coord[n2],param->dir2[n1],param->dir2[n2]))/det;
|
| 97 |
|
|
*v=(DETER(dir1[n1],dir1[n2],coord[n1],coord[n2]))/det;
|
| 98 |
|
|
}
|
| 99 |
|
|
if (type==NORMAL)
|
| 100 |
|
|
{
|
| 101 |
|
|
*x=dir1[1]*param->dir2[2]-dir1[2]*param->dir2[1];
|
| 102 |
|
|
*y=dir1[2]*param->dir2[0]-dir1[0]*param->dir2[2];
|
| 103 |
|
|
*z=dir1[0]*param->dir2[1]-dir1[1]*param->dir2[0];
|
| 104 |
|
|
}
|
| 105 |
|
|
if (type==E) res=1.;
|
| 106 |
|
|
if (type==F) res=0.;
|
| 107 |
|
|
if (type==G) res=1.;
|
| 108 |
|
|
return(res);
|
| 109 |
|
|
}
|
