| 1 |
/*****************************************************************
|
| 2 |
|
| 3 |
eval_mindis_edge_edge.cpp Type:Func
|
| 4 |
|
| 5 |
Calcul la distance minimum entre deux edges
|
| 6 |
|
| 7 |
Date de creation : 2-2-1999 10 :25 :59
|
| 8 |
Derniere version : 2-2-1999 10 :25 :59
|
| 9 |
|
| 10 |
Vincent FRANCOIS
|
| 11 |
|
| 12 |
*****************************************************************/
|
| 13 |
|
| 14 |
|
| 15 |
|
| 16 |
|
| 17 |
|
| 18 |
/**************************/
|
| 19 |
/* include */
|
| 20 |
#include <stdio.h>
|
| 21 |
#include <string.h>
|
| 22 |
#include <math.h>
|
| 23 |
#include "struct.h"
|
| 24 |
#include "const.h"
|
| 25 |
#include "prototype.h"
|
| 26 |
|
| 27 |
/**************************/
|
| 28 |
/* variables globales */
|
| 29 |
extern struct s_acis *acis;
|
| 30 |
|
| 31 |
|
| 32 |
|
| 33 |
/**************************/
|
| 34 |
/* programme principal */
|
| 35 |
|
| 36 |
void eval_mindis_edge_edge(struct s_edge *edge1, struct s_edge *edge2,float *dis, float *par)
|
| 37 |
{
|
| 38 |
float g0,g1;
|
| 39 |
int ok;
|
| 40 |
float tm,eps,td,ta,lt,ttm,ttd,tta,ltt;
|
| 41 |
float t1,t2,tt1,tt2;
|
| 42 |
|
| 43 |
|
| 44 |
td=edge1->t1;
|
| 45 |
ta=edge1->t1+edge1->t2;
|
| 46 |
ttd=edge2->t1;
|
| 47 |
tta=edge2->t1+edge2->t2;
|
| 48 |
|
| 49 |
MINI(eps,0.0001*(ta-td),0.0001*(tta-ttd));
|
| 50 |
MAXI(lt,3.*eps,0.0001*(ta-td));
|
| 51 |
MAXI(ltt,3.*eps,0.0001*(tta-ttd));
|
| 52 |
ok=0;
|
| 53 |
do
|
| 54 |
{
|
| 55 |
tm=(td+ta)/2.;
|
| 56 |
ttm=(ttd+tta)/2.;
|
| 57 |
t1=tm-eps;
|
| 58 |
t2=tm+eps;
|
| 59 |
tt1=ttm-eps;
|
| 60 |
tt2=ttm+eps;
|
| 61 |
g0=eval_dis_edge_edge(edge1,t1,edge2,ttm,FONCTION);
|
| 62 |
g1=eval_dis_edge_edge(edge1,t2,edge2,ttm,FONCTION);
|
| 63 |
if (g0<g1) ta=t2;
|
| 64 |
else td=t1;
|
| 65 |
g0=eval_dis_edge_edge(edge1,tm,edge2,tt1,FONCTION);
|
| 66 |
g1=eval_dis_edge_edge(edge1,tm,edge2,tt2,FONCTION);
|
| 67 |
if (g0<g1) tta=tt2;
|
| 68 |
else ttd=tt1;
|
| 69 |
if ((ta-td<lt)&&(tta-ttd<ltt)) ok=1;
|
| 70 |
}
|
| 71 |
while (ok==0);
|
| 72 |
par[0]=(ta+td)/2.;
|
| 73 |
par[1]=(tta+ttd)/2.;
|
| 74 |
*dis=(float)sqrt((double)eval_dis_edge_edge(edge1,par[0],edge2,par[1],FONCTION));
|
| 75 |
}
|
