root/branch/jouanny2/sp4a12/main.c @ 449
| 1 | jalaffon | #include <stdio.h>
|
|
#include <stdlib.h>
|
|||
#include <strings.h>
|
|||
#include "trame.h"
|
|||
| 376 | hejouanny | ||
#define Rt 6400 /*rayon de la terre*/
|
|||
| 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",
|
|||
0};
|
|||
| 363 | hejouanny | ||
typedef struct{
|
|||
float Lat; /* latitude */
|
|||
float Lon; /* lontitude */
|
|||
} Position;
|
|||
int trame_cmp(char *trame, char *type)
|
|||
{
|
|||
int i,b=1;
|
|||
for (i=0;i<5;i++)
|
|||
{
|
|||
if (trame[i+1]!=type[i])
|
|||
{
|
|||
b=0;
|
|||
}
|
|||
}
|
|||
return b;
|
|||
}
|
|||
int decode_int(char *c)
|
|||
{
|
|||
int nb;
|
|||
if (c>=48 && c<=57)
|
|||
{
|
|||
nb=c-48;
|
|||
}
|
|||
else
|
|||
{
|
|||
nb=-1;
|
|||
}
|
|||
return nb;
|
|||
}
|
|||
| 376 | hejouanny | int decode_nombre(char *ch, int i, int n) /* fonction qui permet de passer d'une chaine de caractere a un entier */
|
|
| 363 | hejouanny | {
|
|
int res=0; /* initialisation du resultat=0 */
|
|||
| 376 | hejouanny | for (i; i<=n; i++)
|
|
| 363 | hejouanny | {
|
|
res=10*res + decode_int(ch[i]); /* permet de reconstituer le nombre terme a terme par puissance de 10 */
|
|||
}
|
|||
return res;
|
|||
}
|
|||
float decode_latitude(char *trame) /* fonction convertissant la cha?ne de caract?re contenant la latitude en nombre flottant et son test unitaire */
|
|||
{
|
|||
| 376 | hejouanny | float res_decode_Lat, res1, res2, res3;
|
|
| 363 | hejouanny | ||
| 376 | hejouanny | res1 = decode_nombre(trame,17,18); //retrouver les degr?s en sexagesimal dans la trame
|
|
res2 = decode_nombre(trame,19,20); //retrouver les minutes en sexagesimal dans la trame
|
|||
res3 = decode_nombre(trame,22,25); //retrouver les secondes en sexagesimal dans la trame
|
|||
| 363 | hejouanny | ||
| 376 | hejouanny | res_decode_Lat = res1 + (res2 + res3/10000)/60; //conversion sexagesimal ? degr?s
|
|
| 363 | hejouanny | ||
| 376 | hejouanny | if(trame[27]=='S') //identifier si la latitude est nord ou sud
|
|
{
|
|||
res_decode_Lat = -res_decode_Lat;
|
|||
}
|
|||
return res_decode_Lat;
|
|||
| 363 | hejouanny | }
|
|
| 376 | hejouanny | ||
| 363 | hejouanny | float decode_longitude(char *trame) /* fonction convertissant la cha?ne de caract?re contenant la longitude en nombre flottant et son test unitaire */
|
|
{
|
|||
| 376 | hejouanny | float res_decode_Lon, res1, res2, res3;
|
|
| 363 | hejouanny | ||
| 376 | hejouanny | res1 = decode_nombre(trame,30,31);
|
|
res2 = decode_nombre(trame,32,33);
|
|||
res3 = decode_nombre(trame,35,38);
|
|||
res_decode_Lon = res1 + (res2 + res3/10000)/60;
|
|||
if(trame[39]=='W') //identifier si la latitude est ouest ou est
|
|||
| 363 | hejouanny | {
|
|
| 376 | hejouanny | res_decode_Lon = -res_decode_Lon;
|
|
| 363 | hejouanny | }
|
|
| 376 | hejouanny | return res_decode_Lon;
|
|
| 363 | hejouanny | }
|
|
| 376 | hejouanny | ||
| 363 | hejouanny | Position decode_position(char *trame) /* fonction qui d?code indiff?remment une latitude ou une longitude */
|
|
{
|
|||
Position pos;
|
|||
pos.Lat = decode_latitude(trame);
|
|||
pos.Lon = decode_longitude(trame);
|
|||
return pos;
|
|||
}
|
|||
float decode_trame(char *trame)/*fonction qui affiche la latitude et la longitude*/
|
|||
{
|
|||
Position pos;
|
|||
decode_position(*trame);
|
|||
printf("%f", pos.Lat);
|
|||
printf("%f", pos.Lon);
|
|||
}
|
|||
| 1 | jalaffon | ||
//Ajouter vos tests unitaires dans cette fonction.
|
|||
| 363 | hejouanny | void tests_unitaires(void){
|
|
Position pos;
|
|||
| 1 | jalaffon | if (5!=5){
|
|
printf ("Erreur Test unitaire basique.\n");
|
|||
exit(-1);
|
|||
| 248 | hejouanny | }
|
|
| 260 | hejouanny | /*if (trame_cmp("$GPGGA suite chaine","GPGGA")==0)
|
|
| 248 | hejouanny | {
|
|
printf ("Erreur Test unitaire trame_cmp.\n");
|
|||
exit(-1);
|
|||
| 213 | jalaffon | }
|
|
| 260 | hejouanny | if (trame_cmp("$GPRMC suite chaine","GPGGA")==1){
|
|
| 248 | hejouanny | printf ("Erreur Test unitaire trame_cmp.\n");
|
|
exit(-1);
|
|||
}
|
|||
| 260 | hejouanny | if (trame_cmp("$GPRMC... ", "GPRMC" )==0){
|
|
| 363 | hejouanny | printf ("Erreur Test unitaire trame_cmp.\n"); if (decode_position("$GPGGA,141914.00,4545.0000,N,00306.6036,E,1,05,3.4,499.3,M,,M,,*7D").Lat != 45.75)
|
|
{
|
|||
printf ("Erreur test unitaire decode_longitude-2\n");
|
|||
| 248 | hejouanny | exit(-1);
|
|
}
|
|||
| 363 | hejouanny | ||
exit(-1);
|
|||
}
|
|||
| 260 | hejouanny | if (trame_cmp("$APRMC...", "GPGGA")==0){
|
|
| 248 | hejouanny | printf ("Erreur Test unitaire trame_cmp.\n");
|
|
exit(-1);
|
|||
| 263 | hejouanny | }*/
|
|
| 363 | hejouanny | /*if (decode_int("7")!=-1)
|
|
| 263 | hejouanny | {
|
|
printf ("Erreur Test unitaire decode_int.\n");
|
|||
exit(-1);
|
|||
| 376 | hejouanny | }*/
|
|
/*test_decode_nombre();*/
|
|||
| 363 | hejouanny | if (decode_latitude("$GPGGA,141914.00,4545.0000,N,00306.6036,E,1,05,3.4,499.3,M,,M,,*7D") != 45.75)
|
|
| 248 | hejouanny | {
|
|
| 363 | hejouanny | printf ("Erreur test unitaire decode_latitude\n");
|
|
exit(-1);
|
|||
| 248 | hejouanny | }
|
|
| 376 | hejouanny | if (decode_longitude("$GPGGA,141914.00,4545.0000,N,00345.0000,E,1,05,3.4,499.3,M,,M,,*7D") != 3.75)
|
|
| 363 | hejouanny | {
|
|
| 376 | hejouanny | printf ("Erreur test unitaire decode_longitude\n");
|
|
| 363 | hejouanny | exit(-1);
|
|
}
|
|||
| 376 | hejouanny | /*if (decode_position("$GPGGA,141914.00,4545.0000,N,00306.6036,E,1,05,3.4,499.3,M,,M,,*7D").Lon != 3.1100599765777588)
|
|
| 363 | hejouanny | {
|
|
printf ("Erreur test unitaire decode_longitude-1\n");
|
|||
exit(-1);
|
|||
}
|
|||
if (decode_position("$GPGGA,141914.00,4545.0000,N,00306.6036,E,1,05,3.4,499.3,M,,M,,*7D").Lat != 45.75)
|
|||
{
|
|||
printf ("Erreur test unitaire decode_longitude-2\n");
|
|||
exit(-1);
|
|||
}*/
|
|||
| 248 | hejouanny | }
|
|
| 263 | hejouanny | ||
| 363 | hejouanny | void test_decode_nombre()
|
|
| 263 | hejouanny | {
|
|
| 363 | hejouanny | char t[5];
|
|
| 376 | hejouanny | t[0] = '1'; t[1] = '2'; t[2] = '3'; t[3] = '4';/*initialisation de la trame test*/
|
|
| 263 | hejouanny | ||
| 376 | hejouanny | if (decode_nombre(t,0,0) != 1)
|
|
| 263 | hejouanny | {
|
|
| 363 | hejouanny | printf ("Erreur test unitaire decode_nombre_1\n");
|
|
exit(-1);
|
|||
| 263 | hejouanny | }
|
|
| 363 | hejouanny | ||
| 376 | hejouanny | if (decode_nombre(t,0,3) != 1234)
|
|
| 263 | hejouanny | {
|
|
| 363 | hejouanny | printf ("Erreur test unitaire decode_nombre_2\n");
|
|
exit(-1);
|
|||
| 263 | hejouanny | }
|
|
| 376 | hejouanny | if (decode_nombre(t,0,3) != 1357)
|
|
{
|
|||
printf ("Erreur test unitaire decode_nombre_3\n");
|
|||
exit(-1);
|
|||
}
|
|||
| 363 | hejouanny | }
|
|
| 263 | hejouanny | ||
| 376 | hejouanny | //Fonction ? modifier !!!!!
|
|
void traitement(char * trame)
|
|||
{
|
|||
static int cpt=0;
|
|||
Position pos;
|
|||
| 1 | jalaffon | ||
| 376 | hejouanny | if (trame_cmp(trame, "GPGGA")==1)
|
|
{
|
|||
printf("> %s", trame);
|
|||
/*decode_trame("$GPGGA,141914.00,4545.0000,N,00306.6036,E,1,05,3.4,499.3,M,,M,,*7D");*/
|
|||
decode_position(trame);
|
|||
printf("%f\n", pos.Lat);
|
|||
printf("%f\n\n", pos.Lon);
|
|||
cpt++;
|
|||
}
|
|||
}
|
|||
| 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;
|
|||
}
|