Révision 300
Ajouté par Guillaume DAVID il y a presque 3 ans
| branch/david_guillaume/sp4a12/main.c | ||
|---|---|---|
|
#include <stdlib.h>
|
||
|
#include <strings.h>
|
||
|
#include "trame.h"
|
||
|
|
||
|
typedef struct position{
|
||
|
float Lat;
|
||
|
float Long;
|
||
|
} position;
|
||
|
|
||
|
//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",
|
||
|
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",
|
||
| ... | ... | |
|
"$GPZDA,141914.00,01,02,2006,00,00*69",
|
||
|
0};
|
||
|
|
||
|
//Fonction ? modifier !!!!!
|
||
|
//Fonction ? modifier !!!!!
|
||
|
void traitement(char * trame){
|
||
|
static int cpt=0;
|
||
|
cpt++;
|
||
| ... | ... | |
|
return resDecodeLong;
|
||
|
}
|
||
|
|
||
|
float decode_position(char *trame,int axe){
|
||
|
//axe==1 si longitude
|
||
|
//axe==0 si latitude
|
||
|
int i;
|
||
|
int d; //decalage ft de l'axe a decoder
|
||
|
char minute[5];
|
||
|
float degrePos;
|
||
|
float minPos;
|
||
|
float resDecodePos;
|
||
|
position decode_position(char *trame){
|
||
|
position p;
|
||
|
|
||
|
if(axe==1) d=29;
|
||
|
else if(axe==0) d=17-1;
|
||
|
p.Lat=decode_latitude(trame);
|
||
|
p.Long=decode_longitude(trame);
|
||
|
|
||
|
for(i=0;i<4;i++){
|
||
|
minute[i]=trame[i+d+6];
|
||
|
}
|
||
|
return p ;
|
||
|
}
|
||
|
|
||
|
degrePos=100*axe*decode_int(trame[d])+10*decode_int(trame[d+1])+decode_int(trame[d+2]);
|
||
|
minPos=10*decode_int(trame[d+3])+decode_int(trame[d+4])+0.0001*decode_nombre(minute,4);
|
||
|
position decode_trame(char *trame){
|
||
|
position pos;
|
||
|
pos.Lat=0;
|
||
|
pos.Long=0;
|
||
|
|
||
|
resDecodePos=degrePos+minPos/60;
|
||
|
if(trame_cmp(trame,"GPGGA")==1){
|
||
|
pos=decode_position(trame);
|
||
|
}
|
||
|
|
||
|
return resDecodePos;
|
||
|
return pos;
|
||
|
}
|
||
|
|
||
|
|
||
|
//Ajouter vos tests unitaires dans cette fonction.
|
||
|
void tests_unitaires(void){
|
||
| ... | ... | |
|
|
||
|
test_decode_longitude();
|
||
|
|
||
|
test_decode_position();
|
||
|
test_decode_position();
|
||
|
|
||
|
test_decode_trame();
|
||
|
}
|
||
|
|
||
|
void test_decode_int(void){
|
||
| ... | ... | |
|
}
|
||
|
|
||
|
void test_decode_position(void){
|
||
|
if(decode_position("$GPGGA,141914.00,4545.0000,N,00306.6036,E,1,05,3.4,499.3,M,,M,,*7D",1)!=3.1100599765777588){
|
||
|
if(decode_position("$GPGGA,141914.00,4545.0000,N,00306.6036,E,1,05,3.4,499.3,M,,M,,*7D").Long!=3.1100599765777588){
|
||
|
printf("Erreur test unitaire decode_position1\n");
|
||
|
exit(-1);
|
||
|
}
|
||
|
if(decode_position("$GPGGA,141914.00,4545.0000,N,00306.6036,E,1,05,3.4,499.3,M,,M,,*7D",0)!=45.75){
|
||
|
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_position2\n");
|
||
|
exit(-1);
|
||
|
}
|
||
|
if(decode_position("$GPGGA,141914.00,4545.0000,N,12412.6012,E,1,05,3.4,499.3,M,,M,,*7D",1)!=124.21002197265625){
|
||
|
if(decode_position("$GPGGA,141914.00,4545.0000,N,12412.6012,E,1,05,3.4,499.3,M,,M,,*7D").Long!=124.21002197265625){
|
||
|
printf("Erreur test unitaire decode_position3\n");
|
||
|
exit(-1);
|
||
|
}
|
||
|
if(decode_position("$GPGGA,141914.00,2734.0060,N,00306.6036,E,1,05,3.4,499.3,M,,M,,*7D",0)!=27.566766738891602){
|
||
|
if(decode_position("$GPGGA,141914.00,2734.0060,N,00306.6036,E,1,05,3.4,499.3,M,,M,,*7D").Lat!=27.566766738891602){
|
||
|
printf("Erreur test unitaire decode_position4\n");
|
||
|
exit(-1);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
void test_decode_trame(void){
|
||
|
if(decode_trame(trames[0]).Lat!=0){
|
||
|
printf("Erreur test decode trame1\n");
|
||
|
exit(-1);
|
||
|
}
|
||
|
if(decode_trame(trames[0]).Long!=0){
|
||
|
printf("Erreur test decode trame2\n");
|
||
|
exit(-1);
|
||
|
}
|
||
|
if(decode_trame(trames[4]).Lat!=45.75){
|
||
|
printf("Erreur test decode trame3\n");
|
||
|
exit(-1);
|
||
|
}
|
||
|
if(decode_trame(trames[4]).Long!=3.1100599765777588){
|
||
|
printf("Erreur test decode trame4\n");
|
||
|
exit(-1);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
// Ne pas modifier cette fonction
|
||
|
int main(int argc,char ** argv)
|
||
Formats disponibles : Unified diff
decode_trame et tests