Projet

Général

Profil

Télécharger (6,53 ko) Statistiques
| Révision:

root/branch/jouanny2/sp4a12/main.c @ 449

#include <stdio.h>
#include <stdlib.h>
#include <strings.h>
#include "trame.h"

#define Rt 6400 /*rayon de la terre*/
//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 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;
}

int decode_nombre(char *ch, int i, int n) /* fonction qui permet de passer d'une chaine de caractere a un entier */
{
int res=0; /* initialisation du resultat=0 */

for (i; i<=n; i++)
{
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 */
{
float res_decode_Lat, res1, res2, res3;

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

res_decode_Lat = res1 + (res2 + res3/10000)/60; //conversion sexagesimal ? degr?s

if(trame[27]=='S') //identifier si la latitude est nord ou sud
{
res_decode_Lat = -res_decode_Lat;
}

return res_decode_Lat;
}


float decode_longitude(char *trame) /* fonction convertissant la cha?ne de caract?re contenant la longitude en nombre flottant et son test unitaire */
{
float res_decode_Lon, res1, res2, res3;

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
{
res_decode_Lon = -res_decode_Lon;
}

return res_decode_Lon;
}


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);
}

//Ajouter vos tests unitaires dans cette fonction.
void tests_unitaires(void){
Position pos;

if (5!=5){
printf ("Erreur Test unitaire basique.\n");
exit(-1);
}
/*if (trame_cmp("$GPGGA suite chaine","GPGGA")==0)
{
printf ("Erreur Test unitaire trame_cmp.\n");
exit(-1);
}
if (trame_cmp("$GPRMC suite chaine","GPGGA")==1){
printf ("Erreur Test unitaire trame_cmp.\n");
exit(-1);
}
if (trame_cmp("$GPRMC... ", "GPRMC" )==0){
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");
exit(-1);
}

exit(-1);
}
if (trame_cmp("$APRMC...", "GPGGA")==0){
printf ("Erreur Test unitaire trame_cmp.\n");
exit(-1);
}*/
/*if (decode_int("7")!=-1)
{
printf ("Erreur Test unitaire decode_int.\n");
exit(-1);
}*/
/*test_decode_nombre();*/
if (decode_latitude("$GPGGA,141914.00,4545.0000,N,00306.6036,E,1,05,3.4,499.3,M,,M,,*7D") != 45.75)
{
printf ("Erreur test unitaire decode_latitude\n");
exit(-1);
}
if (decode_longitude("$GPGGA,141914.00,4545.0000,N,00345.0000,E,1,05,3.4,499.3,M,,M,,*7D") != 3.75)
{
printf ("Erreur test unitaire decode_longitude\n");
exit(-1);
}
/*if (decode_position("$GPGGA,141914.00,4545.0000,N,00306.6036,E,1,05,3.4,499.3,M,,M,,*7D").Lon != 3.1100599765777588)
{
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);
}*/
}

void test_decode_nombre()
{
char t[5];
t[0] = '1'; t[1] = '2'; t[2] = '3'; t[3] = '4';/*initialisation de la trame test*/

if (decode_nombre(t,0,0) != 1)
{
printf ("Erreur test unitaire decode_nombre_1\n");
exit(-1);
}

if (decode_nombre(t,0,3) != 1234)
{
printf ("Erreur test unitaire decode_nombre_2\n");
exit(-1);
}
if (decode_nombre(t,0,3) != 1357)
{
printf ("Erreur test unitaire decode_nombre_3\n");
exit(-1);
}
}

//Fonction ? modifier !!!!!
void traitement(char * trame)
{
static int cpt=0;
Position pos;

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++;
}
}
// 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;
}
(2-2/5)