root/branch/faye_awasemou/sp4a12/main.c @ 399
1 | jalaffon | #include <stdio.h>
|
|
#include <stdlib.h>
|
|||
#include <strings.h>
|
|||
40 | asfaye1 | #include "trame.h"
|
|
1 | jalaffon | ||
210 | asfaye1 | ||
1 | jalaffon | //Trames de tests ? modifier si n?cessaire.
|
|
char * trames[]= {"$GPGSV,3,2,10,15,03,077,,18,04,041,42,19,85,271,,20,08,214,*7C",
|
|||
"$GPGSV,3,3,10,22,39,053,50,28,15,320,*7E",
|
|||
"$GPRMC,141914.00,A,4545.6424,N,00306.6036,E,0.4,99.4,010206,,*0C",
|
|||
"$GPGLL,4545.6424,N,00306.6036,E,141914.00,A*0E",
|
|||
"$GPGGA,141914.00,4545.0000,N,00306.6036,E,1,05,3.4,499.3,M,,M,,*7D",
|
|||
"$GPGSA,A,3,,03,,22,14,,01,,18,,,,3.9,3.4,1.9*39",
|
|||
"$GPVTG,99.4,T,,M,0.4,N,0.7,K*57",
|
|||
"$GPZDA,141914.00,01,02,2006,00,00*69",
|
|||
40 | asfaye1 | 0};
|
|
394 | asfaye1 | //fonction qui permet de savoir si la trame commence par la chaine de caractere type(GPGGA)
|
|
int trame_cmp(char* trame, char* type) //prise en paramete de la trame envoy?e et du type
|
|||
40 | asfaye1 | {
|
|
394 | asfaye1 | int i;//variable permettant de faire l'iteration du tableau de caractere trame et type(on parcoure l'int?gralit? du tableau)
|
|
int ok;//variable qui permet de retourner si la trame commence par le bon format(cad GPGGA) ou non
|
|||
40 | asfaye1 | ok=0|1;
|
|
394 | asfaye1 | for (i=0;i<4;i++)// on tient en compte des 5 caracteres du debut de la trame car ce sont eux qui permettent de caract?riser le bon format de la trame
|
|
40 | asfaye1 | {
|
|
394 | asfaye1 | if (trame[i+1]==type[i])//on compare la trame recu et le type (GPGGA) en ignorant le caractere $ du debut de la trame
|
|
40 | asfaye1 | {
|
|
394 | asfaye1 | ok=1; //ok prend la valeur 1 si la trame commence par le bon format 0 sinon
|
|
40 | asfaye1 | ||
}else
|
|||
{
|
|||
394 | asfaye1 | ok=0; //0 sinon
|
|
40 | asfaye1 | }
|
|
}
|
|||
394 | asfaye1 | return ok;// on retourne resultat de ok pour connaitre si la trame a le bon format ou non(je dis le bon format car ici ce sont les trames commencant par GPGGA qui nous interessent)
|
|
40 | asfaye1 | }
|
|
394 | asfaye1 | ||
//fonction qui permet de renvoyer la valeur d?cimale associ?e ? un caract?re donn? en param?tre
|
|||
int decode_int(char c) //prise en parametre d'un caractere c
|
|||
40 | asfaye1 | {
|
|
394 | asfaye1 | int Vdecimal; //valeur en decimal du caractere pass? en parametre
|
|
if ( c <= '9' && c >='0' ) //comparaison pour savoir si le parametre recu est compris entre 0 et 9
|
|||
40 | asfaye1 | {
|
|
394 | asfaye1 | Vdecimal =c-48; //affectation(methode permettant de donner la valeur en decimal du caractere)
|
|
40 | asfaye1 | ||
}else
|
|||
{
|
|||
394 | asfaye1 | Vdecimal=-1; //si le caractere pass? en parametre n'est pas compris entre 0 et9 on renvoie -1
|
|
40 | asfaye1 | ||
}
|
|||
394 | asfaye1 | return Vdecimal; //on retourne la valeur decimal du caractere
|
|
210 | asfaye1 | }
|
|
394 | asfaye1 | ||
//fonction qui permet de renvoyer la valeur d?cimale des n premiers caract?res de la cha?ne ch
|
|||
210 | asfaye1 | int decode_nombre(char* ch, int n )
|
|
{
|
|||
394 | asfaye1 | int i,s=0; //i=variable permettant de faire l'iteration du tableau de caractere ch(on parcoure tout le tableau en incrementant la valeur de i qui est initialis? a 0 pour un tableau)
|
|
//s variable somme initialis?e a 0 permettant de recuperer le nombre n de caractere qu'on veut recuperer sur une chaine de caractere ch
|
|||
for(i=0;i<n;i++)//la boucle est execut?e de 0 a n fois
|
|||
210 | asfaye1 | {
|
|
394 | asfaye1 | s=s*10 + decode_int(ch[i]);// on fait la somme des valeurs decimales apres avoir calculer la valeur d?cimale associ?e au caract?re en utilisant la fonction decode_int
|
|
40 | asfaye1 | ||
210 | asfaye1 | }
|
|
return s;
|
|||
}
|
|||
//declaration de la structure position contenant la latitude et la longitude
|
|||
typedef struct {
|
|||
float latitude;
|
|||
float longitude;
|
|||
394 | asfaye1 | } Position ;
|
|
210 | asfaye1 | ||
// fonction qui convertit la latitude en un nombre flottant
|
|||
386 | asfaye1 | float conversionLatitude(char* latitude)
|
|
210 | asfaye1 | {
|
|
386 | asfaye1 | //exemple latitude=3723.2475--> 37valDegre, 23Min_Entiere, (0.2475=2475*0.0001)2475MinDecimal donc 37,387458=37+(23+2475*0.0001)/60
|
|
int valDegre,MinEntiere,MinDecimal; //declaration des variables permettant de recuperer les valeurs en degre,minutes entieres et minutes decimales de la latitude
|
|||
float resultatConversion ;
|
|||
valDegre=decode_nombre(latitude,2); //recuperer la valeur degre de la latitude
|
|||
MinEntiere=decode_nombre(&latitude[2],2); //recuperer la valeur minute entiere de la latitude
|
|||
394 | asfaye1 | MinDecimal=decode_nombre(&latitude[5],4); //recuperer la valeur minute decimal de la latitude
|
|
resultatConversion=valDegre+((MinEntiere+MinDecimal*0.0001)/60);// operation de calcul du resultat du conversion de la latitude en valeur reelle
|
|||
return resultatConversion;//on renvoie la valeur du resultat de la convertion
|
|||
386 | asfaye1 | }
|
|
210 | asfaye1 | ||
282 | asfaye1 | ||
386 | asfaye1 | ||
// fonction qui convertit la longitude en un nombre flottant
|
|||
float conversionLongitude(char* longitude)
|
|||
{
|
|||
//exemple longitude =00306.6036,E signifie 3valDegre 06=MinEntiere , MinDecimal=6036' de longitude Est, soit 3,11006?
|
|||
int valDegre, MinEntiere,MinDecimal; //declaration des variables permettant de recuperer les valeurs en degre,minutes entieres et minutes decimales de la longitude
|
|||
float resultatConversion;
|
|||
valDegre=decode_nombre(longitude,3); //recuperer la valeur degre de la longitude
|
|||
MinEntiere=decode_nombre(&longitude[3],2); //recuperer la valeur minute entiere de la longitude
|
|||
394 | asfaye1 | MinDecimal=decode_nombre(&longitude[6],4); //recuperer la valeur minute decimal de la longitude
|
|
386 | asfaye1 | resultatConversion=valDegre +((MinEntiere+MinDecimal*0.0001)/60);// resultat de la conversion de la longitude en valeur reelle
|
|
394 | asfaye1 | return resultatConversion;//on renvoie la valeur du resultat de la convertion
|
|
210 | asfaye1 | }
|
|
386 | asfaye1 | // fonction qui convertit la latitude ou la longitude en flottant
|
|
float fonctionGenerique(char* chaine)
|
|||
{
|
|||
float resultatConversion; // resultat de la conversion de la longitude ou la latitude en valeur reelle
|
|||
if(chaine[4]=='.') //comparaison pour connaitre si la 4ieme variable de la chaine est un point comme le montre cet exemple 3723.2475
|
|||
{
|
|||
394 | asfaye1 | resultatConversion=conversionLatitude(chaine);// appel de la fonction qui permet de faire la conversion en flottant de la latitute; le resultat de la conversion est mis dans la variable resutatConversion
|
|
386 | asfaye1 | }
|
|
else
|
|||
if(chaine[5]=='.') //comparaison pour connaitre si la 5ieme variable de la chaine est un point comme le montre cet exemple 00306.6036
|
|||
{
|
|||
394 | asfaye1 | resultatConversion=conversionLongitude(chaine);// appel de la fonction qui permet de faire la conversion en flottant de la longitute; le resultat de la conversion est mis dans la variable resutatConversion
|
|
386 | asfaye1 | }
|
|
210 | asfaye1 | ||
394 | asfaye1 | return resultatConversion;//on renvoie la valeur du resultat de la convertion de la latitude ou de la longitude
|
|
386 | asfaye1 | }
|
|
210 | asfaye1 | ||
394 | asfaye1 | ||
386 | asfaye1 | // fonction qui permet de savoir si les trames sont au bon format "GPGGA" en renvoyant 1 et d'afficher la position cad la latitude et la longitude
|
|
394 | asfaye1 | int decode_trame(char* trame,Position * position)
|
|
386 | asfaye1 | {
|
|
//exempletrame="$GPGGA,141914.00,4545.0000,N,00306.6036,E,1,05,3.4,499.3,M,,M,,*7D",
|
|||
394 | asfaye1 | if (trame_cmp(trame,"GPGGA")) //on utilise la fonction trame_cmp pour savoir si la trame a le bon format GPGGA
|
|
386 | asfaye1 | {
|
|
394 | asfaye1 | (*position).latitude=conversionLatitude(trame+17);//on recupere la position en latitude en acccedant au champ de la latitude dans la trame
|
|
(*position).longitude=conversionLongitude(trame+29);//on recupere la position en longitude en acccedant au champ de la longitude dans la trame
|
|||
return 1;//on retourne 1 pour montrer qu'on a le trame type GPGGA et qu'on a recuper? la position en latitude et longitude
|
|||
386 | asfaye1 | }
|
|
394 | asfaye1 | return 0;//on retourne 0 sinon, la trame est ignor?e
|
|
386 | asfaye1 | }
|
|
399 | asfaye1 | //fonction qui permet de calculer la distance en deux points P1 et P2 en connaissant leurs latitudes et longitudes
|
|
float calcul_distance(Position P1, Position P2)
|
|||
394 | asfaye1 | {
|
|
399 | asfaye1 | float distance;//variable contenant la distance calcul?e entre ces deux points
|
|
distance=(40000/360)*sqrt(pow((P2.latitude-P1.latitude),2))+ (pow((P2.longitude-P1.longitude),2));//40000(perimetre de la terre)/360(degr?)=111km ->1?=111km sur terre
|
|||
return distance; //on revoie la valeur du la distance calcul?e
|
|||
210 | asfaye1 | ||
394 | asfaye1 | }
|
|
210 | asfaye1 | ||
399 | asfaye1 | //fonction qui calcule la vitesse correspondant au parcours de la distance entre deux points P1 et P2
|
|
float calcul_vitesse(Position P1, Position P2)// on prend en parametre les positions des deux points en latitude et longitude
|
|||
394 | asfaye1 | {
|
|
399 | asfaye1 | float vitesse;//Variable contenant la vitesse resultante entre les deux points
|
|
vitesse=3600*calcul_distance(P1,P2);//on affecte a la vitesse la methode de calcul correspondante cad vitesse =distance /temps en faisant appel a la fonction calcul_distance sachant que le temps cest 1s on a directement la vitesse en km/s donc on miltiplie par 3600 pour avoir la vitesse km/heure vu que 1h=3600s
|
|||
return vitesse; //on revoie la valeur du la vistesse calcul?e
|
|||
394 | asfaye1 | }
|
|
210 | asfaye1 | ||
399 | asfaye1 | // declaration d'une stucture permettant de decrire une zone renseignant la position et la vitesse limite associ?e
|
|
typedef struct {
|
|||
Position rpos;
|
|||
float vitmax;
|
|||
} Zone ;
|
|||
210 | asfaye1 | ||
399 | asfaye1 | //cr?ation d'une table de zone dangereuse
|
|
Zone zones[] = {
|
|||
{{44.7887762, -3.012}, 50}, /* Descripteur de la premi?re zone */
|
|||
{{44.7891220, -3,013}, 70},
|
|||
{{45.7891220, 3,013}, 90},
|
|||
394 | asfaye1 | ||
399 | asfaye1 | };
|
|
//fonction qui calcule la distance ? la plus proche zone
|
|||
int distance_a_la_proche_zone(Position p, Zone r[],int nb_zones, float *d)
|
|||
210 | asfaye1 | {
|
|
399 | asfaye1 | }
|
|
1 | jalaffon | //Fonction ? modifier !!!!!
|
|
void traitement(char * trame)
|
|||
19 | asfaye1 | {
|
|
static int cpt=0;
|
|||
cpt++;
|
|||
210 | asfaye1 | return 0;
|
|
}
|
|||
19 | asfaye1 | ||
210 | asfaye1 | ||
1 | jalaffon | ||
210 | asfaye1 | ||
1 | jalaffon | //Ajouter vos tests unitaires dans cette fonction.
|
|
386 | asfaye1 | void tests_unitaires(void)
|
|
{
|
|||
394 | asfaye1 | if (5!=5){
|
|
//test unutaire basique
|
|||
386 | asfaye1 | printf ("Erreur Test unitaire basique.\n");
|
|
exit(-1);
|
|||
394 | asfaye1 | }
|
|
//tests unutaires de la fonction trame_cmp
|
|||
386 | asfaye1 | if (trame_cmp("$GPGGA suite chaine","GPGGA")!=1){
|
|
printf ("Erreur Test unitaire trame_cmp.\n");
|
|||
exit(-1);
|
|||
}
|
|||
if (trame_cmp("$GPRMC suite chaine","GPGGA")!=0){
|
|||
printf ("Erreur Test unitaire trame_cmp.\n");
|
|||
exit(-1);
|
|||
}
|
|||
if (trame_cmp("$GPRMC... ", "GPRMC" )!=1){
|
|||
printf ("Erreur Test unitaire trame_cmp.\n");
|
|||
exit(-1);
|
|||
}
|
|||
if (trame_cmp("$APRMC...", "GPGGA")!=0){
|
|||
printf ("Erreur Test unitaire trame_cmp.\n");
|
|||
exit(-1);
|
|||
}
|
|||
394 | asfaye1 | //tests unutaires de la fonction decode_int
|
|
386 | asfaye1 | ||
if (decode_int('0')!=0){
|
|||
printf ("Erreur Test unitaire decode_int.\n");
|
|||
exit(-1);
|
|||
}
|
|||
if (decode_int('7')!=7){
|
|||
printf ("Erreur Test unitaire decode_int.\n");
|
|||
exit(-1);
|
|||
}
|
|||
if (decode_int('A')!=-1){
|
|||
printf ("Erreur Test unitaire decode_int.\n");
|
|||
exit(-1);
|
|||
}
|
|||
394 | asfaye1 | //tests unutaires de la fonction decode_nombre
|
|
386 | asfaye1 | if (decode_nombre("7541",2)!=75){
|
|
printf ("Erreur Test unitaire decode_nombre.\n");
|
|||
exit(-1);
|
|||
}
|
|||
if (decode_nombre("7541",3)!=754){
|
|||
printf ("Erreur Test unitaire decode_nombre.\n");
|
|||
exit(-1);
|
|||
}
|
|||
394 | asfaye1 | //tests unutaires de la fonction conversionLatitude
|
|
386 | asfaye1 | ||
394 | asfaye1 | if (conversionLatitude("3723.2475")-37,38745833 > 0.0001){
|
|
386 | asfaye1 | printf ("Erreur Test unitaire conversion Latitude.\n");
|
|
210 | asfaye1 | exit(-1);
|
|
386 | asfaye1 | }
|
|
if (conversionLatitude("4545.0000")-45.7500 > 0.0001){
|
|||
printf ("Erreur Test unitaire conversion Latitude.\n");
|
|||
210 | asfaye1 | exit(-1);
|
|
386 | asfaye1 | }
|
|
394 | asfaye1 | //tests unutaires de la fonction conversionLongitude
|
|
386 | asfaye1 | if (conversionLongitude("00306.6039")- 3.110065 > 0.0001){
|
|
printf ("Erreur Test unitaire conversion Longitude.\n");
|
|||
210 | asfaye1 | exit(-1);
|
|
386 | asfaye1 | }
|
|
if (conversionLongitude("00306.6036")- 3.11006 > 0.0001){
|
|||
printf ("Erreur Test unitaire conversion Longitude.\n");
|
|||
210 | asfaye1 | exit(-1);
|
|
386 | asfaye1 | }
|
|
399 | asfaye1 | /* //tests unutaires de la fonction decode_trame
|
|
if (decode_trame("00306.6036")- 3.11006 > 0.0001){
|
|||
printf ("Erreur Test unitaire decode_trame.\n");
|
|||
exit(-1);
|
|||
}
|
|||
//tests unutaires de la fonction calcul_distance
|
|||
if (calcul_distance("00306.6036")- 3.11006 > 0.0001){
|
|||
printf ("Erreur Test unitaire calcul_distance.\n");
|
|||
exit(-1);
|
|||
}
|
|||
//tests unutaires de la fonction calcul_vitesse
|
|||
if (calcul_vitesse("00306.6036")- 3.11006 > 0.0001){
|
|||
printf ("Erreur Test unitaire calcul_vitesse.\n");
|
|||
exit(-1);
|
|||
}
|
|||
//tests unutaires de la fonction calcul_distance_a_la_proche_zone
|
|||
if (conversionLongitude("00306.6036")- 3.11006 > 0.0001){
|
|||
printf ("Erreur Test unitaire calcul_distance_a_la_proche_zone.\n");
|
|||
exit(-1);
|
|||
}*/
|
|||
}
|
|||
1 | jalaffon | ||
386 | asfaye1 | ||
1 | jalaffon | // Ne pas modifier cette fonction
|
|
int main(int argc,char ** argv)
|
|||
{
|
|||
tests_unitaires();
|
|||
// Affichage des trames definies dans la table trames.
|
|||
printf ("Trames de tests tableau trames:\n");
|
|||
int i=0;
|
|||
while (trames[i])
|
|||
traitement(trames[i++]);
|
|||
if (!trame_init())
|
|||
exit(-1);
|
|||
// Affichage des trames du fichier gps.log
|
|||
char *trame;
|
|||
printf ("Trames de tests du fichier gps.log\n");
|
|||
while ((trame = trame_suivante()))
|
|||
traitement(trame);
|
|||
40 | asfaye1 | return 0;
|
|
1 | jalaffon | }
|