Download 17 - Lirmm
Transcript
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
if ( loca [ i ]. nb_sauts > loc2 . nb_sauts )
loca [ i ]= loc2 ;
else if (( loca [ i ]. nb_sauts == loc2 .
nb_sauts ) && ( loca [ i ]. epsilon > loc2 .
epsilon ) ) loca [ i ]= loc2 ;
else if (( loca [ i ]. id_ancre == -1) &&( test
==0) ) { test = 1; loca [ i ]= loc2 ; loc2 . z = i
;}
if ( test == 1) { // dans ce cas , mise a
jour effectuee
if ( compt < mote ) compt ++;
// si epsilon local > seuil2 = >
estimation encore necessaire
if ( psi >= rho ) {
call Leds . yellowToggle () ;
faireDisque ( loc2 .x , loc2 .y , 0 , loc2 .
nb_sauts * PORTEE ) ;
}
// si epsilon local < seuil1 = > ancre
estimee moyennement bonne
if ( psi < psi2 ) {
// while (( psi < psi2 ) &&( psi2 > rho ) )
//{ psi2 = psi2 * delta ;}
oc2 . id_ancre = TOS_LOCAL_ADDRESS ;
loc2 . x = Ex ;
loc2 . y = Ey ;
loc2 . epsilon = psi ;
loc2 . nb_sauts = 0;
loc1 = loc2 ;
post SendData () ;
call Leds . greenToggle () ;
}
// si epsilon < rho = > ancre estimee
bonne = > diffusion (1 fois )
if ( psi <= rho ) {
call Leds . redOn () ;
localisee = TRUE ;
loc2 . id_ancre = TOS_LOCAL_ADDRESS ;
loc2 . x = Ex ; loc2 . y = Ey ;
loc2 . epsilon = psi ; loc2 . nb_sauts = 0;
loc1 = loc2 ;
post SendData () ;
} }
} }
return msg ; }
28