|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <strings.h>
|
|
#include <math.h>
|
|
#include "trame.h"
|
|
|
|
/* 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",
|
|
0};
|
|
|
|
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*/
|
|
|
|
|
|
|
|
int trame_cmp(char* trame,char* type){
|
|
|
|
int i,ok=0, taille=0;
|
|
while (type[taille]!='\0') /* Determination de la taille de la chaine identif (GP...)*/
|
|
{
|
|
taille++;
|
|
}
|
|
for (i=0; i<taille; i++ )
|
|
{
|
|
if (trame[i+1]==type[i]) /* compare les chaines de caract?res ?l?ments par ?lement */
|
|
{
|
|
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*/
|
|
}
|
|
}
|
|
return ok; /* la fonction renvois la valeur 1 si la trame commence par la chaine de caret?re identif et 0 sinon */
|
|
}
|
|
|
|
|
|
int decode_int (char c){
|
|
|
|
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 */
|
|
{
|
|
a=c-'0'; /* conversion de caract?re en valeur d?cimale*/
|
|
}
|
|
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.*/
|
|
}
|
|
|
|
return a; /* retourne -1 si le caract?re n'est pas entre 0 et 9. sinon retourne la valeur d?cimale.*/
|
|
}
|
|
|
|
int decode_nombre(char *ch, int n)
|
|
{
|
|
|
|
int i,res;
|
|
res = decode_int(ch[0]);
|
|
for (i=1; i<n; i++)
|
|
{
|
|
res = decode_int(ch[i])+res*10;
|
|
}
|
|
return res;
|
|
}
|
|
|
|
|
|
/* Fonction ? modifier !!!!!*/
|
|
|
|
void traitement(char* trame)
|
|
{
|
|
|
|
static int cpt=0;
|
|
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);}
|
|
|
|
}
|
|
|
|
void test_decode_int(void)
|
|
{
|
|
if (decode_int('5')!=5) /* si la valeur retourn? par la fonction decode_int est ?gale -1 alors en affiche l'erreur */
|
|
printf("Erreur ecriture fonction decode_int\n");
|
|
}
|
|
|
|
/* fonction servant de test unitaire pour la validation de la fonction decode_nombre*/
|
|
|
|
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);
|
|
}
|
|
}
|
|
|
|
|
|
|
|
|
|
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.*/
|
|
|
|
lat_flot = degre + minutes_flot; /* La somme du degr? et de la valeur minute en flottant donne la valeur de notre latitude*/
|
|
|
|
return lat_flot;
|
|
|
|
}
|
|
|
|
|
|
float longitude_flottant(char *longitude){
|
|
|
|
/* 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*/
|
|
|
|
return lon_flot;
|
|
|
|
}
|
|
|
|
|
|
|
|
void test_latitude_flottant (void){
|
|
|
|
/* On utilisera l'exemple explicit? dans le support de TP*/
|
|
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");
|
|
exit(-1);
|
|
}
|
|
}
|
|
|
|
|
|
|
|
void test_longitude_flottant(void){
|
|
|
|
/*On utilisera l'exemple explicit? dans le support de TP*/
|
|
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);
|
|
}
|
|
}
|
|
|
|
|
|
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);
|
|
}
|
|
|
|
|
|
}
|
|
|
|
|
|
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);
|
|
}
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/*Ajouter vos tests unitaires dans cette fonction.*/
|
|
|
|
void tests_unitaires(void){
|
|
|
|
if (5!=5){
|
|
printf ("Erreur Test unitaire basique.\n");
|
|
exit(-1);
|
|
}
|
|
|
|
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);
|
|
}
|
|
|
|
|
|
test_decode_int(); /*appel de la fonction test decode int pour le test unitaire sur la conversion en decimale*/
|
|
|
|
test_decode_nombre(); /*appel de la fonction test decode nombre pour le test unitaire sur la conversion en nombre*/
|
|
|
|
test_latitude_flottant (); /*appel de la fonction test latitude pour le test unitaire sur la conversion de la lattitude en flotant*/
|
|
|
|
test_longitude_flottant(); /*appel de la fonction test longitude pour le test unitaire sur la conversion de la longitude en flotant*/
|
|
|
|
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*/
|
|
|
|
test_decode_trame();
|
|
}
|
|
|
|
|
|
|
|
/* 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);
|
|
|
|
return 0;
|
|
}
|