Projet

Général

Profil

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

root/branch/KIS/sp4a12/main.c @ 652

1 jalaffon
#include <stdio.h>
#include <stdlib.h>
648 mukis
#include <strings.h>
#include <math.h>
650 mukis
#include "trame.h"

typedef struct {
float latitude;
float longitude;
} Position ;
1 jalaffon
650 mukis
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};
3 jalaffon
184 mukis
int trame_cmp(char* trame,char* type)
{
int i = 0, a = 0;
for (i=0;i<5;i++)
{
if (trame[i+1] == type[i])
{
}

else if ((trame[i+1] == '\0') || (type[i] == '\0') || (trame[i+1] == ','))
{
a = trame[i] - type[i];
}

else
{
a = trame[i+1] - type[i];
}
}
if (a==0)
{
printf("Trame commencant par GPGGA :\n");
printf("%s\n",trame);
return 1;
}
else
{
return 0;
}
3 jalaffon
}
184 mukis
648 mukis
int decode_int(char ch)
184 mukis
{
648 mukis
int dec;
184 mukis
if(ch<='9' && ch>='0')
{
395 mukis
dec = ch-'0';
184 mukis
return dec;
}
else
{
return (-1);
}
}

int decode_nombre(char *ch, int n)
{
int i=0, res=0;

for (i=0; i<n; i++)
{
395 mukis
res = res*10 + decode_int(ch[i]);
184 mukis
}
return res;
}
414 mukis
368 mukis
float conversion_latitude (char *lat_c)
{
648 mukis
int i=0, k=2;
414 mukis
float lat_f=0;
368 mukis
648 mukis
for (i=0;i< 9;i++)
368 mukis
{
if (lat_c[i]<='9' && lat_c[i]>='0')
{
648 mukis
if (i<=1)
368 mukis
{
k--;
648 mukis
lat_f = lat_f + decode_int(lat_c[i])*powf(10,k);

368 mukis
}
else
{
648 mukis
lat_f = lat_f + decode_int(lat_c[i])/(6*powf(10,k));
368 mukis
k++;
}
}
else
{
continue;
}
}
return lat_f;
}

648 mukis
float conversion_longitude (char *long_c)
368 mukis
{
648 mukis
int i, k=3;
368 mukis
float long_f=0;

648 mukis
for (i=0;i<10;i++)
368 mukis
{
if (long_c[i]<='9' && long_c[i]>='0')
{
if (i<=2)
{
k--;
648 mukis
long_f = long_f + decode_int(long_c[i])*powf(10,k);
368 mukis
}
else
{
648 mukis
long_f = long_f + decode_int(long_c[i])/(6*powf(10,k));
368 mukis
k++;
}
}
else
{
continue;
}
}
return long_f;
648 mukis
}

float conversion_lat_long (char *c)
{
int i=0;

while (c[i] != '.')
{
i++;
}

if (i<=4)
{
conversion_latitude (c);
}
if (i>=5)
{
conversion_longitude (c);
}
}
650 mukis
int decode_trame(char *trame, Position *p)
{
int i=0, j=0, k=0;
char lat_c[10], long_c[11];

if(trame_cmp(trame,"GPGGA"))
{
for (i=0; i< '\0'; i++)
{
if (i>=17 && i<=25)
{
lat_c[j] = trame[i];
j++;
}

if (i>=29 && i<=38)
{
long_c[k] = trame[i];
k++;
}
}

Position p;
p.latitude = conversion_lat_long(lat_c);
p.longitude = conversion_lat_long(long_c);
}


return trame_cmp(trame,"GPGGA");
}
414 mukis
1 jalaffon
//Fonction ? modifier !!!!!
void traitement(char * trame)
146 mukis
{
184 mukis
static int cpt=0 ;
146 mukis
printf ("> %s\n",trame);
cpt++ ;
1 jalaffon
}

//Ajouter vos tests unitaires dans cette fonction.
184 mukis
void tests_unitaires(void)
{
if (5!=5){
printf ("Erreur Test unitaire basique.\n");
exit(-1);
}
if (trame_cmp("$GPGSV,3,2,10,15,03,077,,18,04,041,42,19,85,271,,20,08,214,*7C","GPGGA")!=0){
printf ("Erreur Test unitaire trame_cmp.\n");
exit(-1);
}
if (trame_cmp("$GPGSV,3,3,10,22,39,053,50,28,15,320,*7E","GPGGA")!=0){
printf ("Erreur Test unitaire trame_cmp.\n");
exit(-1);
}
if (trame_cmp("$GPRMC,141914.00,A,4545.6424,N,00306.6036,E,0.4,99.4,010206,,*0C", "GPGGA" )!=0){
printf ("Erreur Test unitaire trame_cmp.\n");
exit(-1);
}
if (trame_cmp("$GPGLL,4545.6424,N,00306.6036,E,141914.00,A*0E", "GPGGA")!=0){
printf ("Erreur Test unitaire trame_cmp.\n");
exit(-1);
}
if (trame_cmp("$GPGGA,141914.00,4545.0000,N,00306.6036,E,1,05,3.4,499.3,M,,M,,*7D", "GPGGA")!=1){
printf ("Erreur Test unitaire trame_cmp.\n");
exit(-1);
}
if (trame_cmp("$GPGSA,A,3,,03,,22,14,,01,,18,,,,3.9,3.4,1.9*39", "GPGGA")!=0){
printf ("Erreur Test unitaire trame_cmp.\n");
exit(-1);
}
if (trame_cmp("$GPVTG,99.4,T,,M,0.4,N,0.7,K*57", "GPGGA")!=0){
printf ("Erreur Test unitaire trame_cmp.\n");
exit(-1);
}
if (trame_cmp("$GPZDA,141914.00,01,02,2006,00,00*69", "GPGGA")!=0){
printf ("Erreur Test unitaire trame_cmp.\n");
exit(-1);
}
191 mukis
if (decode_int('A')!=(-1)){
184 mukis
printf ("Erreur Test unitaire decode_int.\n");
exit(-1);
}
191 mukis
if (decode_int('1')!=1){
printf ("Erreur Test unitaire decode_int.\n");
exit(-1);
}
414 mukis
if (decode_nombre("1345",2)!=13){
395 mukis
printf ("Erreur Test unitaire decode_nombre.\n");
191 mukis
exit(-1);
}
648 mukis
if ((conversion_lat_long("7501.2000") < (0.93*75.02)) || (conversion_lat_long("7501.2000") > (1.03*75.02))){
printf ("Erreur Test unitaire conversion lat_long.\n");
368 mukis
exit(-1);
}
650 mukis
if ((conversion_lat_long("10345.1234") < (0.93*103.752056)) || (conversion_lat_long("7501.2000") > (1.03*103.752056))){
printf ("Erreur Test unitaire conversion longitude.\n");
368 mukis
exit(-1);
648 mukis
}
650 mukis
if (decode_trame("$GPVTG,99.4,T,,M,0.4,N,0.7,K*57", "GPGGA")!=0){
printf ("Erreur Test unitaire decode_trame.\n");
648 mukis
exit(-1);
650 mukis
}
if (decode_trame("$GPGGA,141914.00,4545.0000,N,00306.6036,E,1,05,3.4,499.3,M,,M,,*7D", "GPGGA")!=1){
printf ("Erreur Test unitaire decode_trame.\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
184 mukis
char *trame;
1 jalaffon
printf ("Trames de tests du fichier gps.log\n");
184 mukis
1 jalaffon
while ((trame = trame_suivante()))
traitement(trame);

return 0;
184 mukis
}