Projet

Général

Profil

Télécharger (7,01 ko) Statistiques
| Révision:

root/branch/GUIFO/sp4a12/main.c @ 651

#include <stdio.h>
#include <stdlib.h>
#include <strings.h>
#include "trame.h"
#include "math.h"
#define k 111120
#define N 200
#define rads 0.01745329252
#define t 1/6
#define h 1/60

//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 latitude;
float longitude;
} Position ;

//Comparaison des trames pour savoir si la trame est du bon type
int trame_cmp(char* trame,char* type)
{
int i=0,d=1;

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


if(trame[i+1]!=type[i] )
{

d=0;
}

i++;
}

return d;

}
//Conversion d'un caract?re en decimal
int decode_int(char c)
{
int d;
if(c>='0'&& c<='9')
{
d=c-48;
}
else
{
d=-1;
}
return d;
}
//Renvoi la valeur decimal des n premiers caract?res entr?e en param?tre
int decode_nombre(char *c, int n)
{
int i,valeur=0;
for(i=0;i<n;i++){
valeur+=decode_int(c[i])*pow(10,n-1-i);
}
return valeur;
}
//Conversion de la latitude et longitude en degree floatant
float conversion(char *c)
{
int i=0;
float deg_lat,deg_long;
float test;
while(c[i]!='\0'){

i++;
}
if(i==9){
deg_lat=decode_nombre(c,2);

deg_lat+=(c[2]-'0')*0.16666666666666;
deg_lat+=(c[3]-'0')*0.016666666666666;
for(i=5;i<9;i++){
deg_lat+=((c[i]-'0')*pow(10,3-i))/6;
}
return deg_lat;
}
if(i==10){

deg_long=decode_nombre(c,3);
deg_long+=(c[3]-'0')*0.166666666666666;
deg_long+=(c[4]-'0')*0.0166666666666666;
for(i=6;i<10;i++){
deg_long+=((c[i]-'0')*pow(10,4-i))*0.166666666666666;
}
return deg_long;
}

}


//Decodage d'une trame
void decode_trame(char *trame, Position* p)
{
int i,j,d;
char lat[]={'0','0','0','0','0','0','0','0','0','\0'},lon[]={'0','0','0','0','0','0','0','0','0','0','\0'},indx_lat[]={'0','\0'},indx_lon[]={'0','\0'};


if(trame_cmp(trame,"GPGGA")==1){
d=1;
for (i=0; i<9; i++){
lat[i]=trame[i+17];
}
for (j=0; j<10;j++){
lon[j]=trame[j+29];
}
indx_lat[0]=trame[27];
indx_lon[0]=trame[40];
(*p).latitude= conversion(lat);
(*p).longitude=conversion(lon);

if(indx_lat[0]=='S'){
(*p).latitude=-(*p).latitude;
}

if(indx_lon[0]=='W'){
(*p).longitude=-(*p).longitude;

}
}
else{
d=0;

}
printf("\nTrames: %s", trame);
printf("\nLatitude: %2.7f", (*p).latitude);
printf("\nLongitude: %2.7f", (*p).longitude);

}
//Test pour d?coder la latitude et la longitude des trames "$GPGGA" en degr? d?cimaux

//Fonction qui calcule la distance entre deux positions
float calcul_distance(Position p1,Position p2){
float x,a,y,z,distance,b;
a=(p2.longitude-p1.longitude);
b=(p1.latitude+p2.latitude)/2;
x=a*cos(b*rads);
y=p2.latitude-p1.latitude;
z=sqrt((x*x)+(y*y));
distance=k*z;
return distance;

}

//Fonction qui calcule la vitesse du vehicule par seconde
/*float calcule_vitesse(Position p1, Position p2){

float distance,vitesse;
distance=calcul_distance(Position p1, Position p2);
vitesse=3.6*distance;
return vitesse;*

}*/
//Fonction ? modifier !!!!!
void traitement(char * trame)
{
Position p;
int d;
static int cpt=0 ;
cpt++ ;
if (trame_cmp(trame,"GPGGA")==1)
{
decode_trame(trame,&p);


}

}

//Ajouter vos tests unitaires dans cette fonction.
//test unitaire decode_int
void test_decode_int(void){
if (decode_int('0')!=0){
printf ("Erreur Test unitaire basique decode int.\n");
exit(-1);
}
if (decode_int('1')!=1){
printf ("Erreur Test unitaire basique decode int.\n");
exit(-1);
}
if (decode_int('2')!=2){
printf ("Erreur Test unitaire basique decode int.\n");
exit(-1);
}
if (decode_int('3')!=3){
printf ("Erreur Test unitaire basique decode int.\n");
exit(-1);
}
if (decode_int('4')!=4){
printf ("Erreur Test unitaire basique decode int.\n");
exit(-1);
}
if (decode_int('5')!=5){
printf ("Erreur Test unitaire basique decode int.\n");
exit(-1);
}
if (decode_int('A')!=-1){
printf ("Erreur Test unitaire basique decode int.\n");
exit(-1);
}
}
//Test unitaire decode_nombre
void test_decode_nombre(void){

if (decode_nombre("632",2)!=63){
printf ("Erreur Test unitaire basique decode nombre1.\n");
exit(-1);
}
if (decode_nombre("400",2)!=40){
printf ("Erreur Test unitaire basique decode nombre2.\n");
exit(-1);
}
if (decode_nombre("1204",3)!=120){
printf ("Erreur Test unitaire basique decode nombre3.\n");
exit(-1);
}
if (decode_nombre("10",1)!=1){
printf ("Erreur Test unitaire basique decode nombre4.\n");
exit(-1);
}
if (decode_nombre("7865",3)!=786){
printf ("Erreur Test unitaire basique decode nombre5.\n");
exit(-1);
}


}
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_cmp.\n");
exit(-1);//Fin
}
test_decode_int();
test_decode_nombre();
}



// 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 ("\nTrames de tests du fichier gps.log\n");
while ((trame = trame_suivante()))
traitement(trame);

return 0;
}
(2-2/5)