Révision 705
Ajouté par anclaud il y a presque 4 ans
main.c | ||
---|---|---|
}
|
||
|
||
|
||
float conversion_gen (char * chaine){ //Cette fonction convertie soit une latitude soit une longitude en d?cimal (float)
|
||
int compteur = 0;
|
||
while (chaine[compteur]!='\0'){
|
||
compteur++;
|
||
}
|
||
|
||
if (compteur == 9){
|
||
return conv_latitude(chaine);
|
||
}
|
||
else if(compteur==10){
|
||
return conv_longitude(chaine);
|
||
}
|
||
else{
|
||
return 1000.0;
|
||
}
|
||
}
|
||
|
||
// Fonction test unitaire latitude
|
||
void test_conversion(void)
|
||
{
|
||
... | ... | |
}
|
||
latitude[j] = '\0'; //On ferme bien la chaine
|
||
longitude[k] = '\0';
|
||
position_trame.latitude = conversion(latitude);
|
||
position_trame.longitude = conversion(longitude); //On stocke la latitude et la longitude convertie dans structure position.
|
||
position_trame.latitude = conv_latitude(latitude);
|
||
position_trame.longitude = conv_longitude(longitude); //On stocke la latitude et la longitude convertie dans structure position.
|
||
return position_trame;
|
||
}
|
||
}
|
||
|
||
|
||
float calcule_distance(Position position_trame1, Position position_trame2){
|
||
//On utilise la formule en connaissant le rayon de la terre.
|
||
float x = (position_trame2.longitude - position_trame1.longitude) * cos( (position_trame1.latitude + position_trame2.latitude) / 2);
|
||
... | ... | |
float d = k * z;
|
||
return d;
|
||
}
|
||
|
||
float calcule_vitesse(Position position_trame1, Position position_trame2){
|
||
// On doit calculer la distance :
|
||
float d;
|
||
d = calcule_distance(position_trame1, position_trame2);
|
||
|
||
//On a la distance, on calcule la vitesse;
|
||
float v = d * 3600;
|
||
return v;
|
||
... | ... | |
}
|
||
return i;
|
||
}
|
||
|
||
}
|
||
|
||
// Ne pas modifier cette fonction
|
||
int main(int argc,char ** argv)
|
||
... | ... | |
}
|
||
|
||
|
||
/*
|
||
float conv_lat(char * latitude){ //La fonction convertie la latitude en sexa en degr?.
|
||
float val = decode_nombre(latitude,4);
|
||
float res = 0;
|
||
for (int i = 5; i < 9;i++){
|
||
val += (decode_int(latitude[i]))*pow(10,-i+4); //On replace chaque chiffre au bonne endroit (unit?, dizaine ...).
|
||
}
|
||
res = (int)(val/100);
|
||
res += (val - res*100)/60;
|
||
return res;}
|
||
|
||
float conv_long(char * longitude){ //La fonction convertie la longitude en sexa en degr?.
|
||
float val = decode_nombre(longitude,5);
|
||
float res = 0;
|
||
for (int i = 6; i < 10;i++){
|
||
val += (decode_int(longitude[i]))*pow(10,-i+5);
|
||
}
|
||
res = (int)(val/100);
|
||
res += (val - res*100)/60;
|
||
return res;}
|
||
|
||
float conversion(char * chaine){ //Cette fonction convertie soit une latitude soit une longitude en degr?.
|
||
int cpt = 0;
|
||
while (chaine[cpt]!='\0'){
|
||
cpt++;
|
||
}
|
||
if (cpt == 9){
|
||
return conv_lat(chaine);
|
||
}
|
||
else if(cpt==10){
|
||
return conv_long(chaine);
|
||
}
|
||
else{
|
||
return 1000.0;
|
||
}
|
||
}
|
||
|
||
typedef struct {
|
||
float latitude;
|
||
float longitude;
|
||
} Position;
|
||
|
||
int decode_trame(char * trame, Position *p){
|
||
char longi[10];
|
||
char lati[9];
|
||
int cpt = 0;
|
||
int i = 0;
|
||
int j = 0;
|
||
int y = 0;
|
||
if (trame_cmp(trame,"GPGGA")==1){
|
||
while (trame[i] != '\0'){
|
||
if (trame[i] == ','){ //On compte le nombre de virgule.
|
||
cpt += 1;
|
||
i ++;
|
||
}
|
||
if (cpt == 2) { //On regarde si le nombre de virgule correspond ? 2, ie la latitude
|
||
lati[j] = trame[i]; //On stocke caract?re par caract?re pour isoler la latitude afin de la convertir.
|
||
j ++;
|
||
}
|
||
if (cpt == 4) { //On regarde si le nombre de virgule correspond ? 4, ie la longitude
|
||
longi[y] = trame[i]; //On stocke caract?re par caract?re pour isoler la longitude afin de la convertir.
|
||
y ++;
|
||
}
|
||
i ++;
|
||
}
|
||
p->latitude = conv_lat(lati);
|
||
p->longitude = conv_long(longi); //On stocke la latitude et la longitude convertie dans structure position.
|
||
return 1;
|
||
}
|
||
return 0;
|
||
}
|
||
#define PI 3.14159
|
||
float calcule_distance(Position p_1, Position p_2){
|
||
float rayon = 6378.14; //Rayon de la Terre (km).
|
||
float DistAng = 0;
|
||
DistAng = (PI/180)*acos((sin(p_1.latitude)*sin(p_2.latitude)+cos(p_1.latitude)*cos(p_2.latitude)*cos(p_2.longitude-p_1.longitude))); //Calcul distance angulaire
|
||
return DistAng*rayon; //On renvoi le calcul de la distance : D (km) = DistanceAngulaire*R.
|
||
}
|
||
|
||
float calcule_vitesse(Position p_1, Position p_2){
|
||
return calcule_distance(p_1,p_2)*3600; //On calcul la vitesse avec la formule v=d/t avec t=1s.
|
||
}
|
||
|
||
typedef struct{
|
||
Position rpos;
|
||
float vitmax;
|
||
} Zone;
|
||
|
||
Zone zones[] = {
|
||
{{44.7887762, -3.012}, 50},
|
||
{{44.7891220, -3.013}, 70},
|
||
};
|
||
|
||
int distance_a_la_plus_poche_zone(Position p, Zone r[], int nb_zones, float *d){
|
||
int index = 0;
|
||
float distance = calcule_distance(p, r[0].rpos); //On initialise une distance pour pouvoir ensuite la comparer et chercher le minimum.
|
||
for (int i = 1; i<nb_zones; i++){ //On parcours la table de zone dangereuse.
|
||
if (calcule_distance(p,r[i].rpos) < distance){
|
||
index = i;
|
||
distance = calcule_distance(p,r[i].rpos);
|
||
}
|
||
}
|
||
*d = distance;
|
||
return index;
|
||
}
|
||
*/
|
||
|
||
|
Formats disponibles : Unified diff
Avancées et correction sur fonction séance 12a