Projet

Général

Profil

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

root/branch/Guer/sp4a12/main.c @ 697

1 jalaffon
#include <stdio.h>
#include <stdlib.h>
#include <strings.h>
#include "trame.h"
127 yoguer
#include <math.h>
460 yoguer
572 yoguer
571 yoguer
typedef struct position
{
long latitude;
long longitude;
}position;
572 yoguer
646 yoguer
typedef struct
{
position rpos;
float vitmax;
} Zone;

Zone zones[2] = {{{26873220, -1807200}, 50}, {{26873460, -1807800}, 70}};

127 yoguer
//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};
109 yoguer
127 yoguer
572 yoguer
long decode_long(char c)
109 yoguer
{
572 yoguer
long a=0;
109 yoguer
if(c>=48 && c<=57) //v?rifie que le caract?re est entre 0 et 9 compris
{
258 yoguer
a=c-48; //donne la valeur en d?cimal du code ascii
109 yoguer
}
else
{
a=-1; //renvoie -1 si autres caract?res que 0 ? 9
}
return a;
}

3 jalaffon
572 yoguer
long decode_nombre(char *ch,long n)
127 yoguer
{
572 yoguer
long tab[n],i,retour=0,memoire=0;
101 yoguer
127 yoguer
for(i=0;i<n;i++)
{
572 yoguer
tab[i]=decode_long(ch[i]);
229 yoguer
if(tab[i]!= -1)
{
258 yoguer
retour=(retour*10)+tab[i];
274 yoguer
memoire++;
229 yoguer
}
127 yoguer
}
274 yoguer
if((ch[memoire+2]=='S')||(ch[memoire+2]=='W'))
{
retour=retour*(-1);
}

127 yoguer
return retour;
}


572 yoguer
long conversion_sexa(char *latitude_longitude)
127 yoguer
{
572 yoguer
//float resultat;
long resultVF=0,reste;
127 yoguer
572 yoguer
long tram=decode_nombre(latitude_longitude,12);
409 yoguer
572 yoguer
/* long degres=(tram/1000000); //on travailler en virgule flottante
409 yoguer
reste=(tram-(degres*1000000));
reste=(reste/10000);
resultat=(degres+(reste/60));*/

572 yoguer
long degres=(tram/1000000);
274 yoguer
reste=(tram-(degres*1000000));
572 yoguer
resultVF=(degres*600000+reste); //on travail en 1/10000('/?)
//On calcule un K pour passer en rad qui vaut 2.907718*10^-8
274 yoguer
409 yoguer
return resultVF;
127 yoguer
}


572 yoguer
long trame_cmp(char * trame, char * type)
101 yoguer
{
572 yoguer
long i=0, validation=0, j=0;
101 yoguer
while(type[i]!='\0') //permet de connaitre la taille de la chaine
{
i++;
}

for(j=0;j<i;j++)
{
if(trame[j+1]==type[j]) //v?rifie si chaque caract?res sont ?gaux
{
validation=1;
}
else
{
validation=0;
j=i; //permet de pas recommencer une v?rif si un caract?re n'est pas retrouv?
}
}
return validation;
102 yoguer
printf("%d\n", validation);
3 jalaffon
}
102 yoguer
409 yoguer
571 yoguer
void traitement_trame(char *trame, position *p1)
409 yoguer
{
646 yoguer
p1->latitude=conversion_sexa(&trame[17]);
p1->longitude=conversion_sexa(&trame[29]);
409 yoguer
572 yoguer
printf("> %s\n",trame);
460 yoguer
}


572 yoguer
long calcul_vitesse(position *p1, position *p2)
460 yoguer
{
646 yoguer
long distance, vitesse;
524 yoguer
571 yoguer
if((p2->latitude!=p1->latitude) || (p2->longitude!=p1->longitude))
460 yoguer
{
571 yoguer
distance=sqrt((p1->latitude - p2->latitude)*(p1->latitude - p2->latitude)+(p1->longitude - p2->longitude)*(p1->longitude - p2->longitude));
523 yoguer
vitesse=distance*0.1852507138; //rayon de la terre * kradian = 0.1852507138 (vitesse en m/s)
460 yoguer
vitesse=vitesse*3.6; //vitesse en km/h, 3.6=3600s/1000m

646 yoguer
printf("vitesse=%ld\n",vitesse);
printf("dist=%ld\n",distance);
460 yoguer
571 yoguer
printf("latitude=%d\n",p1->latitude);
printf("longitude=%d\n",p1->longitude);
printf("memolat=%d\n",p2->latitude);
printf("memolong=%d\n",p2->longitude);
409 yoguer
}
646 yoguer
p2->latitude = p1->latitude;
p2->longitude = p1->longitude;
409 yoguer
}

1 jalaffon
//Fonction ? modifier !!!!!
void traitement(char * trame)
96 yoguer
{
572 yoguer
static long cpt=0;
102 yoguer
cpt++ ;

646 yoguer
static position p1,p2;
460 yoguer
if (trame_cmp(trame,"GPGGA")==1)
{
571 yoguer
traitement_trame(trame,&p1);
calcul_vitesse(&p1,&p2);
460 yoguer
}
1 jalaffon
}
127 yoguer
1 jalaffon
127 yoguer
//**************************************************************************************************************************************************************************

101 yoguer
1 jalaffon
// Ne pas modifier cette fonction
646 yoguer
long main(int argc,char ** argv)
1 jalaffon
{

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;
}
101 yoguer

109 yoguer
//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")==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");
exit(-1);
}
if (trame_cmp("$APRMC...", "GPGGA")==1){
printf ("Erreur Test unitaire trame_cmp.\n");
exit(-1);
}

572 yoguer
test_decode_long(); //test la fonction decode_long
127 yoguer
test_decode_nombre(); //test la fonction decode_nombre
274 yoguer
test_conversion_latitude_longitude(); //test la fonction conversion_char_latitude
109 yoguer
}


572 yoguer
void test_decode_long(void)
109 yoguer
{
char i;

for(i=0;i<10;i++)
{
572 yoguer
if (decode_long('0'+i)==i);
109 yoguer
{
printf("GOOD pour le caractere: %hd\n",i); //test si la fonction renvoie bien la bonne valeur d?cimal
}
}

572 yoguer
if(decode_long('A')==-1)
109 yoguer
{
127 yoguer
printf("GOOD pour le caractere A\n\n"); //test si la fonction renvoie -1 pour le caract?re A
109 yoguer
}
}
127 yoguer

void test_decode_nombre(void)
{
char *ch;
572 yoguer
long n;
127 yoguer
ch="246500";
n=3;
if(decode_nombre(ch,n)==246);
{
printf("decode nombre=%hd pour ch=%s et n=%d\n",decode_nombre(ch,n),ch,n);
}

ch="28600";
n=4;
if(decode_nombre(ch,n)==246);
{
printf("decode nombre=%hd pour ch=%s et n=%d\n\n",decode_nombre(ch,n),ch,n);
}
}


274 yoguer
void test_conversion_latitude_longitude(void)
193 yoguer
{
409 yoguer
char *trame_latitude_longitude;
trame_latitude_longitude="35723.2475,W";
572 yoguer
long retour;
127 yoguer
409 yoguer
retour=conversion_sexa(trame_latitude_longitude);
460 yoguer
//printf("retour=%ld",retour);
193 yoguer
}