c言語復号GPS-実装編
8566 ワード
自分のこの数日の努力を通じてついにGPSデータをすべて復号して、私のログを見た人も長い間期待していたと信じて、資源は分かち合ってこそ、進歩を得ることができます;ネット上で直接インタフェースを呼び出すことに対して异なっているのはCの方向から问题を解决して问题を更にはっきりさせることができて、本设计のチップは连星のCC 550-BGモジュールを采用して、大多数のチップの性能を満たして、システムはLINUXシステムの下で実现して、ttyS 0ノードを选んで、异なる口実によって、シリアルラインはRS-232を选んで、みんなもある程度理解していることを信じて、详しく私のコードを见てください、ここで私はGPRMCフォーマットのコードだけを解析しました.他のいくつかのフォーマットのコード解析も同様に解析することができます.read_data()関数のstrncmp()のarray配列は名前を変えることができて、彼をSwitchフォーマットの復号セレクタに書くことができて、良いくだらない話は多く言わないで、私のコードを貼ります!
#include <stdio.h> /* */
#include <stdlib.h> /* */
#include <unistd.h> /*Unix */
#include <sys/types.h>
#include <sys/stat.h>
#include <errno.h>
#include <string.h>
#include <fcntl.h>
#include <termios.h>
//#define dev "/dev/ttyS0"
#define BUFF_SIZE 512
#define MAX_COM_NUM 3
int SectionID=0,i=0;
struct data
{
char GPS_time[20]; //UTC
char GPS_sv; //
char GPS_wd[12]; //
char GPS_jd[12]; //
//char GPS_warn; //
char GPS_speed[5]; //
char GPS_date[8]; //UTC
}GPS_DATA;
int set_com_config(int fd,int baud_rate,int data_bits,char parity,int stop_bits)
{
struct termios new_cfg,old_cfg;
int speed;
// ， ，
if(tcgetattr(fd,&old_cfg)!=0)
{
perror("tcgetattr");
return -1;
}
tcflush(fd, TCIOFLUSH);
new_cfg=old_cfg;
cfmakeraw(&new_cfg);//
new_cfg.c_cflag&=~CSIZE;
//
switch(baud_rate)
{
case 2400:
{
speed = B2400;
break;
}
case 4800:
{
speed = B4800;
break;
}
case 9600:
{
speed = B9600;
break;
}
case 19200:
{
speed = B19200;
break;
}
case 38400:
{
speed = B38400;
break;
}
case 115200:
{
speed = B115200;
break;
}
}
cfsetispeed(&new_cfg,speed);
cfsetospeed(&new_cfg,speed);
//
switch(data_bits)
{
case 7:
{
new_cfg.c_cflag|=CS7;
break;
}
case 8:
{
new_cfg.c_cflag|=CS8;
break;
}
}
//
switch(stop_bits)
{
case 1:
{
new_cfg.c_cflag &=~CSTOPB;
break;
}
case 2:
{
new_cfg.c_cflag |=CSTOPB;
break;
}
}
//
switch(parity)
{
case 'o':
case 'O':
{
new_cfg.c_cflag|=(PARODD|PARENB);
new_cfg.c_iflag|=(INPCK |ISTRIP);
break;
}
case 'e':
case 'E':
{
new_cfg.c_cflag |=PARENB;
new_cfg.c_cflag &=~PARODD;
new_cfg.c_iflag |=(INPCK | ISTRIP);
break;
}
case 's':
case 'S':
{
new_cfg.c_cflag &=~PARENB;
new_cfg.c_cflag &=~CSTOPB;
break;
}
case 'n':
case 'N':
{
new_cfg.c_cflag &=~PARENB;
new_cfg.c_iflag &=~INPCK;
break;
}
}
new_cfg.c_cc[VTIME] =10;
new_cfg.c_cc[VMIN] =5;
//
tcflush(fd,TCIFLUSH);
if((tcsetattr(fd,TCSANOW,&new_cfg))!=0)
{
perror("tcsetattr");
return -1;
}
return 0;
}
//
int open_port(int com_port)
{
int fd;
#if (COM_TYPE == GNR_COM) //
char* dev[] = {"/dev/ttyS0","/dev/ttyS1","/dev/ttyS2"};
#else// USB
char* dev[] = {"/dev/ttyUSB0","/dev/ttyUSB1","/dev/ttyUSB2"};
#endif
if((com_port<0)||(com_port > MAX_COM_NUM))
{
return -1;
}
//
if((fd=open(dev[com_port-1],O_RDWR|O_NOCTTY|O_NDELAY))<0)
{
perror("open serial port");
return -1;
}
//
if(fcntl(fd,F_SETFL,0) <0 )
{
perror("fcntl F_SETFL
");
return -1;
}
//
if(isatty(STDIN_FILENO)==0)
{
perror("standard input is not a terminal device");
}
return fd;
}
void print_info(void)
{
// ，
printf("Now the receive time is %s
",GPS_DATA.GPS_time);
printf("The star is %c 3
",GPS_DATA.GPS_sv);
printf("The earth latitude is :%s
",GPS_DATA.GPS_wd);
printf("The earth longitude is :%s
",GPS_DATA.GPS_jd);
printf("The train speed is:%s km/h
",GPS_DATA.GPS_speed);
printf("The date is:%s
",GPS_DATA.GPS_date);
}
void GPS_resolve_GPRMC(char data)
{
//$GPRMC,092427.604,V,4002.1531,N,11618.3097,E,0.000,0.00,280812,,E,N*08
if(data==',')
{
++SectionID;
i=0;
}
else
{
switch(SectionID)
{
case 1://02:48:13
GPS_DATA.GPS_time[i++]=data;
if(i==2 || i==5)
{
GPS_DATA.GPS_time[i++]=':';
}
GPS_DATA.GPS_time[8]='\0';
break;
case 2:
if(data=='A')
GPS_DATA.GPS_sv='>';
else
GPS_DATA.GPS_sv='<';
break;
case 3://3158.4608
GPS_DATA.GPS_wd[++i]=data;
GPS_DATA.GPS_wd[12]='\0';
break;
case 4:
if(data=='N')
GPS_DATA.GPS_wd[0]='N';
else if(data=='S')
GPS_DATA.GPS_wd[0]='S';
break;
case 5://11848.3737,E
GPS_DATA.GPS_jd[++i]=data;
GPS_DATA.GPS_jd[12]='\0';
break;
case 6:
if(data=='E')
GPS_DATA.GPS_jd[0]='E';
else if(data=='W')
GPS_DATA.GPS_jd[0]='W';
break;
case 7://10.05
GPS_DATA.GPS_speed[i++]=data;
GPS_DATA.GPS_speed[4]='\0';
break;
case 9://15-07-06 -> 06-07-15
GPS_DATA.GPS_date[i++]=data;
if(i==2 || i==5)
{
GPS_DATA.GPS_date[i++]='-';
}
GPS_DATA.GPS_date[8]='\0';
break;
}
}
}
void read_data(int fd)
{
char buffer[BUFF_SIZE],dest[1024];
char array[10]="$GPRMC";
int res,i=0,j=0,k;
int data=1,len=0;
memset(dest,0,sizeof(dest));
do
{
memset(buffer,0,sizeof(buffer));
//$GPRMC,024813.640,A,3158.4608,N,11848.3737,E,10.05,324.27,150706,,,A*50
if(res=read(fd,buffer,1)>0)
{
// ， （$GPRMC,024），res ， ；
strcat(dest,buffer);
if(buffer[0]=='
')
{
i=0;
if(strncmp(dest,array,6)==0)
{
printf("%s",dest);
len=strlen(dest);
for(k=0;k<len;k++)
{
GPS_resolve_GPRMC(dest[k]);
}
SectionID=0;
print_info();
}
bzero(dest,sizeof(dest));
}
}
}while(1);
close(fd);
}
int main(int argc,char*argv[])
{
int fd=0;
int HOST_COM_PORT=1;
fd=open_port(HOST_COM_PORT);
if(fd<0)
{
perror("open fail!");
}
printf("open sucess!
");
if((set_com_config(fd,9600,8,'N',1))<0)
{
perror("set_com_config fail!
");
}
printf("The received worlds are:
");
read_data(fd);
return 0;
}