root/branch/Morales/sp4a12/main.c @ 208
| 1 | jalaffon | #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};
|
|||
| 3 | jalaffon | ||
| 198 | mamorales | // 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);
|
|||
| 48 | mamorales | //fonction comparant les trames
|
|
int trame_cmp(char* trame,char* type)
|
|||
{
|
|||
int i=1;
|
|||
| 80 | mamorales | int comp=1; // comparateur
|
|
int end_comp=1; //permet de savoir quand arreter la comparaison
|
|||
while (end_comp!='\0') // comparaison
|
|||
| 48 | mamorales | {
|
|
if (trame[i]!=type[i-1])
|
|||
{
|
|||
comp=0;
|
|||
}
|
|||
i=i+1;
|
|||
end_comp=type[i];
|
|||
}
|
|||
return comp;
|
|||
| 3 | jalaffon | }
|
|
| 57 | mamorales | ||
| 63 | mamorales | //fonction qui retourne l'entier correspondant au caractere mis en argument. (le caract?re '1' retourne l'entier 1)
|
|
int decode_int (char c)
|
|||
{
|
|||
| 80 | mamorales | int return_var=0; // variable de retour
|
|
| 63 | mamorales | if ((c>=48)&&(c<=57))
|
|
{
|
|||
| 80 | mamorales | return_var=c-48;
|
|
| 63 | mamorales | }
|
|
else
|
|||
{
|
|||
| 80 | mamorales | (return_var=-1);
|
|
| 63 | mamorales | }
|
|
| 80 | mamorales | return return_var;
|
|
| 63 | mamorales | }
|
|
| 80 | mamorales | //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;
|
|||
}
|
|||
| 63 | mamorales | ||
| 197 | mamorales | //fonction covertissant des sexagesimal (latitude ou longitude) en reel
|
|
| 198 | mamorales | float sexagesimal_to_float(char* value)
|
|
| 80 | mamorales | {
|
|
int i=0;
|
|||
int j=0;
|
|||
| 198 | mamorales | 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;
|
|||
| 80 | mamorales | ||
| 198 | mamorales | // 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
|
|||
| 197 | mamorales | ||
| 198 | mamorales | while (value[i]!='.')
|
|
| 80 | mamorales | {
|
|
| 198 | mamorales | val_entiere[j]=value[i];
|
|
| 197 | mamorales | j++; // stock la partie entiere
|
|
| 80 | mamorales | i++;
|
|
}
|
|||
| 197 | mamorales | val_entiere_taille = j;
|
|
| 198 | mamorales | ||
j=0; //reinitialise j
|
|||
i++; // on ne stock pas le point dans les 2 chaines
|
|||
while (value[i]!='\0')
|
|||
| 80 | mamorales | {
|
|
| 198 | mamorales | val_decimal[j]=value[i]; // stock la partie decimale
|
|
| 197 | mamorales | j++;
|
|
| 80 | mamorales | i++;
|
|
}
|
|||
| 197 | mamorales | val_decimale_taille = j;
|
|
| 80 | mamorales | ||
| 198 | mamorales | // stockage de la valeur sexagesimale
|
|
sexages_value = decode_nombre(val_entiere,val_entiere_taille) + 0.0001* decode_nombre(val_decimal,val_decimale_taille);
|
|||
| 197 | mamorales | ||
| 198 | mamorales | int float_deg=sexages_value/100;
|
|
float float_minutes=0;
|
|||
| 197 | mamorales | ||
| 198 | mamorales | float_minutes = (sexages_value-float_deg*100)/60;
|
|
float_val = float_deg + float_minutes;
|
|||
| 197 | mamorales | ||
| 198 | mamorales | return float_val;
|
|
| 80 | mamorales | }
|
|
| 198 | mamorales | //fonction convertissant la latitude et longitude en reels.
|
|
int decode_trame(char* trame,Position *p)
|
|||
| 80 | mamorales | {
|
|
int i=0;
|
|||
int j=0;
|
|||
int nbr_virgule=0;
|
|||
| 198 | mamorales | 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++;
|
|||
}
|
|||
| 80 | mamorales | ||
| 198 | mamorales | lat[j]=trame[i];
|
|
j++;
|
|||
i++;
|
|||
| 80 | mamorales | if (trame[i]==',')
|
|
{
|
|||
nbr_virgule = nbr_virgule+1;
|
|||
}
|
|||
| 198 | mamorales | ||
| 80 | mamorales | }
|
|
| 197 | mamorales | ||
| 198 | mamorales | 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
|
|||
| 80 | mamorales | {
|
|
| 198 | mamorales | 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];
|
|||
| 197 | mamorales | j++;
|
|
| 80 | mamorales | i++;
|
|
| 198 | mamorales | if (trame[i]==',')
|
|
{
|
|||
nbr_virgule = nbr_virgule+1;
|
|||
}
|
|||
| 80 | mamorales | }
|
|
| 198 | mamorales | p->longitude = sexagesimal_to_float(longit); // transformation en flottant
|
|
| 80 | mamorales | ||
| 198 | mamorales | return 1;
|
|
| 80 | mamorales | }
|
|
| 1 | jalaffon | ||
//Fonction ? modifier !!!!!
|
|||
void traitement(char * trame)
|
|||
| 46 | mamorales | {
|
|
| 198 | mamorales | Position p;
|
|
| 46 | mamorales | static int cpt = 0;
|
|
| 57 | mamorales | cpt++;
|
|
| 198 | mamorales | if (decode_trame(trame,&p))
|
|
| 57 | mamorales | {
|
|
printf ("> %s\n",trame);
|
|||
| 198 | mamorales | ||
printf("latitude en reel : %f\n",p.latitude);
|
|||
printf("longitude en reel : %f\n\n",p.longitude);
|
|||
| 57 | mamorales | }
|
|
| 1 | jalaffon | }
|
|
//Ajouter vos tests unitaires dans cette fonction.
|
|||
| 48 | mamorales | void tests_unitaires(void){
|
|
if (5!=5){
|
|||
| 1 | jalaffon | 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");
|
|||
| 63 | mamorales | exit(-1);
|
|
}
|
|||
| 80 | mamorales | if (decode_int('0')!=0)
|
|
| 63 | mamorales | {
|
|
printf ("Erreur Test unitaire decode_int.\n");
|
|||
exit(-1);
|
|||
| 80 | mamorales | }
|
|
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);
|
|||
| 48 | mamorales | }
|
|
| 198 | mamorales | if ((sexagesimal_to_float ("3723.2475")<=37.387458)||(sexagesimal_to_float ("3723.2475")>=37.387459))
|
|
| 80 | mamorales | {
|
|
printf ("Erreur Test unitaire sexagesimal_to_float.\n");
|
|||
exit(-1);
|
|||
| 198 | mamorales | }
|
|
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);
|
|||
}
|
|||
| 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);
|
|||
return 0;
|
|||
}
|