Projet

Général

Profil

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

root/branch/CLAUD/sp4a12/main.c @ 371

#include <stdio.h>
#include <stdlib.h>
#include <strings.h>
#include "trame.h"
#include <math.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};

// Fonction trame_cmp
int trame_cmp(char * trame, char * type)
{
int i = 0, j = 0, resultat = 1;

while(type[i] != '\0')
{
i++;
}

while(j<i)
{
if (trame[j+1] != type[j])
{
resultat = 0;
}
j++;
}
return resultat;
}

//Fonction ? modifier !!!!!
void traitement(char * trame)
{
static int cpt = 0;
cpt++;
if (trame_cmp(trame,"GPGGA"))
{
printf ("> %s\n",trame);
}
}

//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_cmp4.\n");
exit(-1);
}
// Appel de la fonction de tests pour decode_int()
test_decode_int();

// Appel de la fonction de tests pour decode_nombre()
test_decode_nombre();

// Appel de la fonction de tests pour conv_latitude()
test_conv_latitude();
}

int decode_int(char c) // Fonction permettant de transformer un code ASCII en d?cimal
{
int res;
if (c >= 48 && c <= 57)
{
res = c - 48;
}
else
{
res = -1;
}
return res;
}

// Fonction de tests unitaires pour la fonction decode_int
void test_decode_int(void)
{
if(decode_int('0') != 0)
{
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('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_int('C') != (-1))
{
printf ("Erreur Test unitaire decode_int.\n");
exit(-1);
}
}

// Fonction decode_nombre
int decode_nombre (char * ch, int n)
{
int i, res = 0;
for (i=0;i<n;i++)
{
res = res*10 + decode_int(ch[i]);
}
return res;
}

// Fonction de tests unitaire
void test_decode_nombre(void)
{
if (decode_nombre("987654321",3) != 987)
{
printf ("Erreur Test unitaire decode_nombre.\n");
exit(-1);
}

if (decode_nombre("7541",2) != 75)
{
printf ("Erreur Test unitaire decode_nombre.\n");
exit(-1);
}
}

// Fonction latitude : (format ddmm.mmmm)

float conv_latitude(char* lat_sexa)
{
float lat_dec=0;
int degres_lat = 0;
int i;

degres_lat = decode_nombre(lat_sexa,4);
for (i=5;i<9;i++)
{
degres_lat += (decode_int(lat_sexa[i]))*pow(10,-i+4);
}
lat_dec = (int) (degres_lat/100);
lat_dec += (degres_lat-lat_dec*100)/60;
return lat_dec;
}


// Fonction longitude : (format dddmm.mmmm)

float conv_longitude (char* long_sexa)
{
float long_dec=0;
int degres_long = 0;
int i;

degres_long = decode_nombre(long_sexa,5);
for (i=6;i<10;i++)
{
degres_long += (decode_int(long_sexa[i]))*pow(10,-i+5);
}
long_dec = (int) (degres_long/100);
long_dec += (degres_long-long_dec*100)/60;
return long_dec;
}


// Fonction test unitaire latitude
void test_conv_latitude(void)
{
int res_lat = 0;
res_lat = conv_latitude("3723.2475");
printf("%d \n", res_lat);
}

float Conversion_gen (char * chaine){ //Cette fonction convertie soit une latitude soit une longitude en degr?.
int cpt = 0;
while (chaine[cpt]!='\0'){
cpt++;
}

if (cpt == 9){
return conv_latitude(chaine);
}
else if(cpt==10){
return conv_longitude(chaine);
}
else{
return 1000.0;
}
}

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


/*
float decode_nombre (char * trame) {
int i=0;
int j=0,memoire=0;
long res3=0;
char tab[9];
long res4=0;
while (i<10)
{
if (decode_int(trame[i])!=(-1))
{
tab [j]=decode_int(trame[i]);
res3 = res310+tab[j];
memoire++;
}
i++;
j++;
}
/ while (i<12)
{
if (decode_int(trame[i]=='S'))
{

res4 = res3 - (2*res3);
printf("%d\n",res4);
}
else
{
res4 = res3;
}
i++;
} /

switch(trame[memoire+2])
{
case 'S' :
res3 = res3(-1);
break;
case 'W' :
res3 = res3(-1);
break;
}



return res3;

}
float Conversion_sexagesimale(long nb_sexa)
{
float result=0, result_min=0;
int degres=0;

degres=nb_sexa/1000000;
result_min=(nb_sexa-(degres1000000));
result_min=(reste/10000);
result=(degres+(reste/60));

return result;
}

*/
(2-2/5)