root/branch/MBADINGA/sp4a12/main.c @ 658
| 1 | jalaffon | #include <stdio.h>
|
|
#include <stdlib.h>
|
|||
| 263 | dgmbadinga | #include <strings.h>
|
|
#include <math.h>
|
|||
| 1 | jalaffon | #include "trame.h"
|
|
| 98 | dgmbadinga | /* Trames de tests ? modifier si n?cessaire.*/
|
|
| 1 | jalaffon | 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",
|
|||
0};
|
|||
| 3 | jalaffon | ||
| 658 | dgmbadinga | typedef struct{
|
|
float latitude; /* La structure qui d?finira les varuables de type position avec comme param?tres la latitude et la longitude*/
|
|||
float longitude;
|
|||
} position;
|
|||
position position0; /* Variable qui va servir ? mettre en oeuvre le test unitaire*/
|
|||
position p_1,p_2; /*Variables de type position qui vont servir ? d?finir les fonction de calcul de distance et de vitesse*/
|
|||
| 260 | dgmbadinga | int trame_cmp(char* trame,char* type){
|
|
| 116 | dgmbadinga | ||
int i,ok=0, taille=0;
|
|||
| 260 | dgmbadinga | while (type[taille]!='\0') /* Determination de la taille de la chaine identif (GP...)*/
|
|
| 116 | dgmbadinga | {
|
|
taille++;
|
|||
}
|
|||
for (i=0; i<taille; i++ )
|
|||
{
|
|||
| 260 | dgmbadinga | if (trame[i+1]==type[i]) /* compare les chaines de caract?res ?l?ments par ?lement */
|
|
| 116 | dgmbadinga | {
|
|
ok=1; /* si ?galit? ok = 1 */
|
|||
}
|
|||
else
|
|||
{
|
|||
ok=0; /* si il sont diff?rent ok = 0 */
|
|||
i=taille; /* nous permettra de sortir de la boucle on arrete la comparaison*/
|
|||
}
|
|||
}
|
|||
| 124 | dgmbadinga | return ok; /* la fonction renvois la valeur 1 si la trame commence par la chaine de caret?re identif et 0 sinon */
|
|
| 3 | jalaffon | }
|
|
| 260 | dgmbadinga | ||
| 263 | dgmbadinga | ||
| 260 | dgmbadinga | int decode_int (char c){
|
|
| 263 | dgmbadinga | int a=0; /* initialisation de la variable test de notre fonction (la valeur retourn? de type entier) */
|
|
if (c>=48 && c<=57) /*test de condition sur la valeur d?cimale du caract?re passer en param?tre */
|
|||
| 260 | dgmbadinga | {
|
|
| 657 | dgmbadinga | a=c-'0'; /* conversion de caract?re en valeur d?cimale*/
|
|
| 260 | dgmbadinga | }
|
|
| 263 | dgmbadinga | else
|
|
{
|
|||
a=-1; /* si notre caract?re ne poss?de pas une valeur en hexad?cimale comprise entre 48 et 57 notre variable test passe ? -1.*/
|
|||
}
|
|||
| 260 | dgmbadinga | ||
| 263 | dgmbadinga | return a; /* retourne -1 si le caract?re n'est pas entre 0 et 9. sinon retourne la valeur d?cimale.*/
|
|
| 260 | dgmbadinga | }
|
|
| 263 | dgmbadinga | ||
| 657 | dgmbadinga | int decode_nombre(char *ch, int n)
|
|
| 264 | dgmbadinga | {
|
|
| 657 | dgmbadinga | ||
| 271 | dgmbadinga | int i,res;
|
|
res = decode_int(ch[0]);
|
|||
| 657 | dgmbadinga | for (i=1; i<n; i++)
|
|
| 264 | dgmbadinga | {
|
|
| 271 | dgmbadinga | res = decode_int(ch[i])+res*10;
|
|
| 264 | dgmbadinga | }
|
|
return res;
|
|||
}
|
|||
| 271 | dgmbadinga | ||
| 1 | jalaffon | ||
| 98 | dgmbadinga | /* Fonction ? modifier !!!!!*/
|
|
| 657 | dgmbadinga | void traitement(char* trame)
|
|
| 98 | dgmbadinga | {
|
|
| 124 | dgmbadinga | ||
| 98 | dgmbadinga | static int cpt=0;
|
|
| 124 | dgmbadinga | cpt++;
|
|
if(trame_cmp(trame, "GPGGA")==1) /* on cherche GPGGA dans la chaine de caract?re trame si on le trouve on affiche la trame et cela pour toutes les trames*/
|
|||
{printf ("> %s\n",trame);}
|
|||
| 1 | jalaffon | }
|
|
| 263 | dgmbadinga | ||
void test_decode_int(void)
|
|||
{
|
|||
| 657 | dgmbadinga | if (decode_int('5')!=5) /* si la valeur retourn? par la fonction decode_int est ?gale -1 alors en affiche l'erreur */
|
|
| 263 | dgmbadinga | printf("Erreur ecriture fonction decode_int\n");
|
|
}
|
|||
| 264 | dgmbadinga | /* fonction servant de test unitaire pour la validation de la fonction decode_nombre*/
|
|
| 263 | dgmbadinga | ||
| 264 | dgmbadinga | void test_decode_nombre(void)
|
|
{
|
|||
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);
|
|||
}
|
|||
}
|
|||
| 265 | dgmbadinga | ||
| 657 | dgmbadinga | ||
float latitude_flottant(char *latitude){/*fonction conversion lattitude en flottant*/
|
|||
float lat_flot; /* On d?finit notre resultat de latitude en flottant et celui de la valeur en minutes*/
|
|||
float minutes_flot;
|
|||
int degre;/* La valeur enti?re du degr? de notre latitude*/
|
|||
int i,j;
|
|||
float resultat_pe_minute;
|
|||
float resultat_pd_minute;
|
|||
char p_entiere_minute[2];
|
|||
char p_decimal_minute[4];
|
|||
degre = decode_nombre(latitude,2);/* On ne r?cup?re que les 2 premier chiffres de la latitude pour d?finir le degr?*/
|
|||
for (i=0;i<2;i++)
|
|||
{
|
|||
p_entiere_minute[i]=latitude[2+i]; /*affectation des caracteres de longi sauf les 3 premiers*/
|
|||
}
|
|||
for (j=0;j<4;j++)
|
|||
{
|
|||
p_decimal_minute[j]=latitude[5+j]; /*affectation des 4 derniers caracteres de longi ? pd_min*/
|
|||
}
|
|||
resultat_pe_minute = decode_nombre(p_entiere_minute,2); /*donne la valeur en d?cimal des 2 premiers caract?res*/
|
|||
resultat_pd_minute = decode_nombre(p_decimal_minute,4); /*donne la valeur en d?cimal des 4 premiers caract?res*/
|
|||
minutes_flot = resultat_pe_minute/60 + ( resultat_pd_minute/600000); /* La valeur en minute est retranscrite en flottant en la divisant par 60 qui correspond ? 1 degr?, elle doit ?tre inf?rieure ? 1*/
|
|||
/* pour la partie decimal les 600000 carespondent a 10^-4*1/60. car on a normalement 0.2475 d'apr?s le test unitaire.*/
|
|||
| 265 | dgmbadinga | lat_flot = degre + minutes_flot; /* La somme du degr? et de la valeur minute en flottant donne la valeur de notre latitude*/
|
|
| 271 | dgmbadinga | return lat_flot;
|
|
| 265 | dgmbadinga | }
|
|
| 271 | dgmbadinga | ||
| 657 | dgmbadinga | float longitude_flottant(char *longitude){
|
|
| 271 | dgmbadinga | ||
| 657 | dgmbadinga | /* On d?finit notre resultat de longitude en flottant comme celui de la valeur en minutes*/
|
|
float lon_flot, minutes_flot;
|
|||
/* La valeur enti?re du degr? de notre longitude*/
|
|||
int degre;
|
|||
int i,j;
|
|||
float resultat_pe_minute;
|
|||
float resultat_pd_minute;
|
|||
char p_entiere_minute[2];
|
|||
char p_decimal_minute[4];
|
|||
/* On ne r?cup?re que les 2 premiers chiffres de les 3 premiers chiffres pour d?finir le degr?*/
|
|||
degre = decode_nombre(longitude,3);
|
|||
for (i=0;i<2;i++)
|
|||
{
|
|||
p_entiere_minute[i]=longitude[3+i]; /*affectation des caracteres de longi sauf les 3 premiers*/
|
|||
}
|
|||
for (j=0;j<4;j++)
|
|||
{
|
|||
p_decimal_minute[j]=longitude[6+j]; /*affectation des 4 derniers caracteres de longi ? pd_min*/
|
|||
}
|
|||
resultat_pe_minute = decode_nombre(p_entiere_minute,2); /*donne la valeur en d?cimal des 2 premiers caract?res*/
|
|||
resultat_pd_minute = decode_nombre(p_decimal_minute,4); /*donne la valeur en d?cimal des 4 premiers caract?res*/
|
|||
minutes_flot = resultat_pe_minute/60 + ( resultat_pd_minute/600000); /* La valeur en minute est retranscrite en flottant en la divisant par 60 qui correspond ? 1 degr?, elle doit ?tre inf?rieure ? 1*/
|
|||
lon_flot = degre + minutes_flot;/* La somme du degr? et de la valeur minute en flottant donne la valeur de notre longitude*/
|
|||
| 271 | dgmbadinga | return lon_flot;
|
|
}
|
|||
| 657 | dgmbadinga | ||
| 271 | dgmbadinga | void test_latitude_flottant (void){
|
|
/* On utilisera l'exemple explicit? dans le support de TP*/
|
|||
| 657 | dgmbadinga | if ((latitude_flottant("3723.2475")- 37.387458) > 0.0001){ /* 37.3874580- 37.3874580 = 0 si cette condition n'est pas v?rifier alors la fonction n'est pas correcte.*/
|
|
printf("Erreur calcul latitude\n");
|
|||
| 271 | dgmbadinga | exit(-1);
|
|
}
|
|||
}
|
|||
| 657 | dgmbadinga | ||
| 271 | dgmbadinga | void test_longitude_flottant(void){
|
|
| 657 | dgmbadinga | ||
| 271 | dgmbadinga | /*On utilisera l'exemple explicit? dans le support de TP*/
|
|
| 657 | dgmbadinga | if ((longitude_flottant("00306.6036")-3.110060) > 0.0001){ /* 3.110060 - 3.110060=0 si cette condition n'est pas v?rifier alors la fonction n'est pas correcte.*/
|
|
printf("Erreur calcul longitude\n");
|
|||
exit(-1);
|
|||
| 271 | dgmbadinga | }
|
|
}
|
|||
| 657 | dgmbadinga | ||
float lat_long_generique (char * ch){
|
|||
float Res;
|
|||
if(ch[4]== '.'){/* Il s'agit alors d'une latitude comme dans l'exemple 3723.2475,N*/
|
|||
Res=latitude_flottant(ch);
|
|||
}
|
|||
if(ch[5]=='.'){// Il s'agit alors d'une longitude comme dans l'exemple 00306.6036,E
|
|||
Res=longitude_flottant(ch);
|
|||
}
|
|||
return Res;
|
|||
}
|
|||
void test_fonction_generique(void){
|
|||
if(lat_long_generique("4545.0484")-45.75080 > 0.0001){ // Calcul pr?alable fait ? la main avec ue donn?e d'une trame GPGGA
|
|||
printf("Erreur calcul longitude.1\n");
|
|||
exit(-1);
|
|||
}
|
|||
else if(lat_long_generique("3723.2475")-37.387458 > 0.0001){
|
|||
printf("Erreur calcul longitude.2\n");
|
|||
exit(-1);
|
|||
}
|
|||
if(lat_long_generique("00306.6037")-3.110006 > 0.0001){ // Calcul pr?alable fait ? la main avec ue donn?e d'une trame GPGGA
|
|||
printf("Erreur calcul lattitude.1\n");
|
|||
exit(-1);
|
|||
}
|
|||
else if(lat_long_generique("00306.6036")-3.110060 > 0.0001){
|
|||
printf("Erreur calcul lattitude.2\n");
|
|||
exit(-1);
|
|||
}
|
|||
}
|
|||
| 658 | dgmbadinga | int decode_trame(char * trame, position p){ /*Avec cette fonction extrait uniquement les trames GPGGA et surtout on extrait la lattitude et la longitude*/
|
|
int i; /* Il nous ervira ? parcourir la trame */
|
|||
char ch[40];/* Il nous faut au moins 40 espaces pour r?cup?rer ce qui nous est n?cessaire dans la trame*/
|
|||
char lat[9]; /*Pour r?cup?rer les donn?es de la latitude et de la longitude on les stocke dans deux tableaux*/
|
|||
char lon[9];
|
|||
if(trame_cmp(trame,"GPGGA")){
|
|||
for(i=0;i<39;i++){
|
|||
ch[i]=trame[i];
|
|||
}
|
|||
for(i=0;i<8;i++){
|
|||
lat[i]=trame[17+i]; /* on r?cup?re les valeurs en sexag?simal des latitudes et longitude*/
|
|||
lon[i]=trame[29+i];
|
|||
p.latitude=latitude_flottant(lat); /* Ces valeurs sont ensuite converties pour en d?terminer la position*/
|
|||
p.longitude=longitude_flottant(lon);
|
|||
}
|
|||
return 1;
|
|||
}
|
|||
return 0;
|
|||
}
|
|||
void test_decode_trame(void){ /* Dans le fichier gps.log on peut choisir 4 trames diff?rentes et en d?duire la r?ponse de la trame*/
|
|||
if(decode_trame("$GPGSV,3,2,10,15,03,077,,18,04,041,42,19,85,271,,20,08,214,*7C", position0)!=0){
|
|||
printf("Erreur conception fonction decode_trame");
|
|||
exit(-1);
|
|||
}
|
|||
if(decode_trame("$GPGGA,141914.00,4545.0000,N,00306.6036,E,1,05,3.4,499.3,M,,M,,*79", position0)!=1){
|
|||
printf("Erreur conception fonction decode_trame");
|
|||
}
|
|||
if(decode_trame("$GPGLL,4545.6424,N,00306.6036,E,141914.00,A*0E", position0)!=0){
|
|||
printf("Erreur conception fonction decode_trame");
|
|||
}
|
|||
if(decode_trame("$GPGSA,A,3,,03,,22,14,,01,,18,,,,3.9,3.4,1.9*39", position0)!=0){
|
|||
printf("Erreur conception fonction decode_trame");
|
|||
exit(-1);
|
|||
}
|
|||
}
|
|||
| 1 | jalaffon | ||
| 98 | dgmbadinga | /*Ajouter vos tests unitaires dans cette fonction.*/
|
|
| 657 | dgmbadinga | void tests_unitaires(void){
|
|
| 1 | jalaffon | if (5!=5){
|
|
printf ("Erreur Test unitaire basique.\n");
|
|||
exit(-1);
|
|||
| 116 | dgmbadinga | }
|
|
| 117 | dgmbadinga | if (trame_cmp("$GPGGA suite chaine","GPGGA")!=1){
|
|
| 1 | jalaffon | 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);
|
|||
| 263 | dgmbadinga | }
|
|
| 264 | dgmbadinga | ||
| 657 | dgmbadinga | test_decode_int(); /*appel de la fonction test decode int pour le test unitaire sur la conversion en decimale*/
|
|
| 271 | dgmbadinga | ||
| 657 | dgmbadinga | test_decode_nombre(); /*appel de la fonction test decode nombre pour le test unitaire sur la conversion en nombre*/
|
|
| 271 | dgmbadinga | ||
| 657 | dgmbadinga | test_latitude_flottant (); /*appel de la fonction test latitude pour le test unitaire sur la conversion de la lattitude en flotant*/
|
|
| 271 | dgmbadinga | ||
| 657 | dgmbadinga | test_longitude_flottant(); /*appel de la fonction test longitude pour le test unitaire sur la conversion de la longitude en flotant*/
|
|
| 271 | dgmbadinga | ||
| 657 | dgmbadinga | test_fonction_generique(); /*appel de la fonction test fonction generique pour le test unitaire sur la conversion de la longitude et la latitude en flotant*/
|
|
| 658 | dgmbadinga | ||
test_decode_trame();
|
|||
| 1 | jalaffon | }
|
|
| 260 | dgmbadinga | ||
| 1 | jalaffon | ||
| 98 | dgmbadinga | /* Ne pas modifier cette fonction*/
|
|
| 1 | jalaffon | int main(int argc,char ** argv)
|
|
{
|
|||
tests_unitaires();
|
|||
| 98 | dgmbadinga | /* Affichage des trames definies dans la table trames.*/
|
|
| 1 | jalaffon | printf ("Trames de tests tableau trames:\n");
|
|
int i=0;
|
|||
while (trames[i])
|
|||
traitement(trames[i++]);
|
|||
if (!trame_init())
|
|||
exit(-1);
|
|||
| 98 | dgmbadinga | /* Affichage des trames du fichier gps.log*/
|
|
| 1 | jalaffon | char *trame;
|
|
printf ("Trames de tests du fichier gps.log\n");
|
|||
while ((trame = trame_suivante()))
|
|||
traitement(trame);
|
|||
return 0;
|
|||
}
|