|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <strings.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};
|
|
|
|
// structure pour la longitude et la latitude.
|
|
typedef struct {
|
|
float latitude;
|
|
float longitude;
|
|
} Position ;
|
|
|
|
// initialisation des fonctions.
|
|
int trame_cmp(char* trame,char* type);
|
|
int decode_int (char c);
|
|
int decode_nombre(char * ch,int n);
|
|
float sexagesimal_to_float(char* value);
|
|
float lat_sexagesimal(char* trame);
|
|
float longitude_sexagesimal(char* trame);
|
|
int decode_trame (char*trame, Position *p);
|
|
|
|
|
|
|
|
|
|
//fonction comparant les trames
|
|
int trame_cmp(char* trame,char* type)
|
|
{
|
|
int i=1;
|
|
int comp=1; // comparateur
|
|
int end_comp=1; //permet de savoir quand arreter la comparaison
|
|
while (end_comp!='\0') // comparaison
|
|
{
|
|
if (trame[i]!=type[i-1])
|
|
{
|
|
comp=0;
|
|
}
|
|
i=i+1;
|
|
end_comp=type[i];
|
|
}
|
|
return comp;
|
|
}
|
|
|
|
//fonction qui retourne l'entier correspondant au caractere mis en argument. (le caract?re '1' retourne l'entier 1)
|
|
int decode_int (char c)
|
|
{
|
|
int return_var=0; // variable de retour
|
|
if ((c>=48)&&(c<=57))
|
|
{
|
|
return_var=c-48;
|
|
}
|
|
else
|
|
{
|
|
(return_var=-1);
|
|
}
|
|
return return_var;
|
|
}
|
|
|
|
//fonction retournant uniquement les n premier chiffres dans un nombre.
|
|
int decode_nombre(char * ch,int n)
|
|
{
|
|
int i=0;
|
|
int nbr_return=0;
|
|
while (i<n)
|
|
{
|
|
nbr_return = nbr_return*10 + decode_int(ch[i]);
|
|
i=i+1;
|
|
}
|
|
return nbr_return;
|
|
}
|
|
|
|
//fonction covertissant des sexagesimal (latitude ou longitude) en reel
|
|
float sexagesimal_to_float(char* value)
|
|
{
|
|
int i=0;
|
|
int j=0;
|
|
int val_entiere_taille = 0; // taille de la partie entiere de la valeur
|
|
int val_decimale_taille = 0; // taille de la partie decimal de la valeur
|
|
char val_entiere[10]={0}; //valeur entiere de la longitude, on reserve 6 cases par s?curite.
|
|
char val_decimal[10]={0}; //valeur decimale de la longitude, on reserve 6 cases par s?curite.
|
|
float sexages_value=0;
|
|
float float_val=0;
|
|
|
|
// on ne peux pas passer directement d'un caract?re avec des virgule ? un flottant, du coup on passe par deux cha?ne de caract?res
|
|
// intermediares pour avoir ce qui correspond ? la partie enti?re et ce qui correspond ? la partie decimale
|
|
|
|
while (value[i]!='.')
|
|
{
|
|
val_entiere[j]=value[i];
|
|
j++; // stock la partie entiere
|
|
i++;
|
|
}
|
|
val_entiere_taille = j;
|
|
|
|
j=0; //reinitialise j
|
|
i++; // on ne stock pas le point dans les 2 chaines
|
|
|
|
while (value[i]!='\0')
|
|
{
|
|
val_decimal[j]=value[i]; // stock la partie decimale
|
|
j++;
|
|
i++;
|
|
}
|
|
val_decimale_taille = j;
|
|
|
|
// stockage de la valeur sexagesimale
|
|
sexages_value = decode_nombre(val_entiere,val_entiere_taille) + 0.0001* decode_nombre(val_decimal,val_decimale_taille);
|
|
|
|
int float_deg=sexages_value/100;
|
|
float float_minutes=0;
|
|
|
|
float_minutes = (sexages_value-float_deg*100)/60;
|
|
float_val = float_deg + float_minutes;
|
|
|
|
return float_val;
|
|
}
|
|
|
|
//fonction convertissant la latitude et longitude en reels.
|
|
int decode_trame(char* trame,Position *p)
|
|
{
|
|
int i=0;
|
|
int j=0;
|
|
int nbr_virgule=0;
|
|
char lat[15]={0};
|
|
char longit[15]={0};
|
|
if (trame_cmp(trame,"GPGGA")==0)
|
|
{
|
|
return 0;
|
|
}
|
|
//calcul latitude
|
|
while (nbr_virgule<3) // on compte jusqu'a la troisieme virgule
|
|
{
|
|
while (nbr_virgule<2) // on compte jusqu'a la deuxieme virugle (troisieme champs)
|
|
{
|
|
if (trame[i]==',')
|
|
{
|
|
nbr_virgule = nbr_virgule+1;
|
|
}
|
|
i++;
|
|
}
|
|
|
|
lat[j]=trame[i];
|
|
j++;
|
|
i++;
|
|
if (trame[i]==',')
|
|
{
|
|
nbr_virgule = nbr_virgule+1;
|
|
}
|
|
|
|
}
|
|
|
|
p->latitude = sexagesimal_to_float(lat); // transformation en flottant
|
|
|
|
j=0; //reinitialise j
|
|
i++; // une it?ration de i pour avoir i!=','
|
|
|
|
// calcul longitude
|
|
while (nbr_virgule<5) // on compte jusqu'a la troisieme virgule
|
|
{
|
|
while (nbr_virgule<4) // on compte jusqu'a la deuxieme virugle (cinquieme champs)
|
|
{
|
|
if (trame[i]==',')
|
|
{
|
|
nbr_virgule = nbr_virgule+1;
|
|
}
|
|
i++;
|
|
}
|
|
|
|
longit[j]=trame[i];
|
|
j++;
|
|
i++;
|
|
if (trame[i]==',')
|
|
{
|
|
nbr_virgule = nbr_virgule+1;
|
|
}
|
|
|
|
}
|
|
|
|
p->longitude = sexagesimal_to_float(longit); // transformation en flottant
|
|
|
|
return 1;
|
|
}
|
|
|
|
//Fonction ? modifier !!!!!
|
|
void traitement(char * trame)
|
|
{
|
|
Position p;
|
|
static int cpt = 0;
|
|
cpt++;
|
|
if (decode_trame(trame,&p))
|
|
{
|
|
printf ("> %s\n",trame);
|
|
|
|
printf("latitude en reel : %f\n",p.latitude);
|
|
printf("longitude en reel : %f\n\n",p.longitude);
|
|
}
|
|
}
|
|
|
|
//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);
|
|
}
|
|
if (decode_int('0')!=0)
|
|
{
|
|
printf ("Erreur Test unitaire decode_int.\n");
|
|
exit(-1);
|
|
}
|
|
if (decode_int('1')!=1)
|
|
{
|
|
printf ("Erreur Test unitaire decode_int.\n");
|
|
exit(-1);
|
|
}
|
|
if (decode_int('2')!=2)
|
|
{
|
|
printf ("Erreur Test unitaire decode_int.\n");
|
|
exit(-1);
|
|
}
|
|
if (decode_int('3')!=3)
|
|
{
|
|
printf ("Erreur Test unitaire decode_int.\n");
|
|
exit(-1);
|
|
}
|
|
if (decode_int('4')!=4)
|
|
{
|
|
printf ("Erreur Test unitaire decode_int.\n");
|
|
exit(-1);
|
|
}
|
|
if (decode_int('5')!=5)
|
|
{
|
|
printf ("Erreur Test unitaire decode_int.\n");
|
|
exit(-1);
|
|
}
|
|
if (decode_int('6')!=6)
|
|
{
|
|
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('8')!=8)
|
|
{
|
|
printf ("Erreur Test unitaire decode_int.\n");
|
|
exit(-1);
|
|
}
|
|
if (decode_int('9')!=9)
|
|
{
|
|
printf ("Erreur Test unitaire decode_int.\n");
|
|
exit(-1);
|
|
}
|
|
if (decode_int('A')!=-1)
|
|
{
|
|
printf ("Erreur Test unitaire decode_int.\n");
|
|
exit(-1);
|
|
}
|
|
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);
|
|
}
|
|
if (decode_nombre("123",3)!=123)
|
|
{
|
|
printf ("Erreur Test unitaire decode_nombre.\n");
|
|
exit(-1);
|
|
}
|
|
if (decode_nombre("987654321",2)!=98)
|
|
{
|
|
printf ("Erreur Test unitaire decode_nombre.\n");
|
|
exit(-1);
|
|
}
|
|
if ((sexagesimal_to_float ("3723.2475")<=37.387458)||(sexagesimal_to_float ("3723.2475")>=37.387459))
|
|
{
|
|
printf ("Erreur Test unitaire sexagesimal_to_float.\n");
|
|
exit(-1);
|
|
}
|
|
if ((sexagesimal_to_float ("00306.6036")<=3.11006)||(sexagesimal_to_float ("00306.6036")>=3.11007))
|
|
{
|
|
printf ("Erreur Test unitaire sexagesimal_to_float.\n");
|
|
exit(-1);
|
|
}
|
|
}
|
|
|
|
// 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;
|
|
}
|