#include<stdlib.h>
#include<stdio.h>
#include<string.h>
#include<sys/types.h>
#include<errno.h>
#include<sys/stat.h>
#include<fcntl.h>
#include<unistd.h>
#include<termios.h>
int opendev();
void set_speed(int fd);
int set_Parity(int fd,int databits,int stopbits,int parity);
void main()
{
int fd,i, count=0;
char tempbuf[1024];
char buf[1024]; int LENGTH=1024;
char shijian_shi[2];
char shijian_feng[2];
char shijian_miao[6];
char weidu_du[2];
char weidu_feng[7];
char jingdu_du[3];
char jingdu_feng[7];
char shudu[5];
char fangweijiao[5];
char shijian_nian[2];
char shijian_yue[2];
char shijian_ri[2];
char cipianjiao[5];
char cipianjiaofangxiang[1];
int nByteRead;
int j,checksum=0,a,b;char xiaoyan1,xiaoyan2;
while(1)
{
fd = opendev();
if (fd==-1)
{printf("error");}
else
{
set_speed(fd);
if(set_Parity(fd,8,1,'N') == -1)
{
printf("Set Parity Error\n");
}
// while(1)
// {
count=0;
while(1)
{
if((nByteRead = read(fd,tempbuf,LENGTH))>0)
{
memcpy(&buf[count],tempbuf,nByteRead);count=nByteRead++;
}
if(count==512)
{
buf[count+1]='\0';break;
}
}
// }
}
close(fd);
if(nByteRead>0)
{ for(i=0;i<LENGTH-77;i++)
{
if((buf[i]=='$')&&(buf[i+3]=='R')&&(buf[i+4]=='M')&&(buf[i+5]=='C'))
{
/*for(j=i+1;j<=i+72;j++)
{checksum=checksum^buf[j];}
a=checksum/16;
b=checksum%16;
if(a<10) xiaoyan1=a+'0';else xiaoyan1=a+'A'-10;
if(b<10) xiaoyan2=b+'0';else xiaoyan2=b+'A'-10;
if(buf[i+74]==xiaoyan1&&buf[i+75]==xiaoyan2)*/
//{
shijian_shi[0]=buf[i+7];shijian_shi[1]=buf[i+8];
shijian_feng[0]=buf[i+9];shijian_feng[1]=buf[i+10];
shijian_miao[0]=buf[i+11];shijian_miao[1]=buf[i+12];shijian_miao[2]='.';
shijian_miao[3]=buf[i+14];shijian_miao[4]=buf[i+15];shijian_miao[5]=buf[i+16];
weidu_du[0]=buf[i+20];weidu_du[1]=buf[i+21];
weidu_feng[0]=buf[i+22];weidu_feng[1]=buf[i+23];weidu_feng[2]='.';weidu_feng[3]=buf[i+25];
weidu_feng[4]=buf[i+26];weidu_feng[5]=buf[i+27];weidu_feng[6]=buf[i+28];
jingdu_du[0]=buf[i+32];jingdu_du[1]=buf[i+33];jingdu_du[2]=buf[i+34];
jingdu_feng[0]=buf[i+35];jingdu_feng[1]=buf[i+36];jingdu_feng[2]='.';jingdu_feng[3]=buf[i+38];
jingdu_feng[4]=buf[i+39];jingdu_feng[5]=buf[i+40];jingdu_feng[6]=buf[i+41];
shudu[0]=buf[i+45];shudu[1]=buf[i+46];shudu[2]=buf[i+47];
shudu[3]='.';shudu[4]=buf[i+49];
fangweijiao[0]=buf[i+51];fangweijiao[1]=buf[i+52];fangweijiao[2]=buf[i+53];
fangweijiao[3]='.';fangweijiao[4]=buf[i+55];
shijian_ri[0]=buf[i+57];shijian_ri[1]=buf[i+58];
shijian_yue[0]=buf[i+59];shijian_yue[1]=buf[i+60];
shijian_nian[0]=buf[i+61];shijian_nian[1]=buf[i+62];
cipianjiao[0]=buf[i+64];cipianjiao[1]=buf[i+65];cipianjiao[2]=buf[i+66];
cipianjiao[3]='.';cipianjiao[4]=buf[i+68];
cipianjiaofangxiang[0]=buf[i+70];
//}
}
break; }
}
pthread_exit(NULL); }
}
int opendev()
{
int fd = open("/dev/ttyS0", O_RDWR|O_NOCTTY|O_NDELAY);
if (-1 == fd)
{
perror("Can't Open Serial Port");
return -1;
}
else
return fd;
}
void set_speed(int fd)
{
int status;
struct termios Opt;
tcgetattr(fd, &Opt);
tcflush(fd,TCIOFLUSH);
cfsetispeed(&Opt,B9600);
cfsetospeed(&Opt,B9600);
status=tcsetattr(fd, TCSANOW, &Opt);
if (status != 0)
{
perror("tcsetattr fd");
return;
}
tcflush(fd,TCIOFLUSH);
}
int set_Parity(int fd,int databits,int stopbits,int parity)
{
struct termios options;
if (tcgetattr( fd,&options) != 0)
{
perror("SetupSerial 1");
return(-1);
}
options.c_cflag &= ~CSIZE;
options.c_lflag &= ~(ICANON | ECHO | ECHOE | ISIG); /*Input*/
options.c_oflag &= ~OPOST; /*Output*/
switch (databits)
{
case 7:
options.c_cflag |= CS7;
break;
case 8:
options.c_cflag |= CS8;
break;
default:
fprintf(stderr,"Unsupported data size\n"); return (-1);
}
switch (parity)
{
case 'n':
case 'N':
options.c_cflag &= ~PARENB; /* Clear parity enable */
options.c_iflag &= ~INPCK; /* Enable parity checking */
break;
case 'o':
case 'O':
options.c_cflag |= (PARODD | PARENB);
options.c_iflag |= INPCK; /* Disnable parity checking */
break;
case 'e':
case 'E':
options.c_cflag |= PARENB; /* Enable parity */
options.c_cflag &= ~PARODD;
options.c_iflag |= INPCK; /* Disnable parity checking */
break;
case 'S':
case 's': /*as no parity*/
options.c_cflag &= ~PARENB;
options.c_cflag &= ~CSTOPB;break;
default:
fprintf(stderr,"Unsupported parity\n");
return (-1);
}
switch (stopbits)
{
case 1:
options.c_cflag &= ~CSTOPB;
break;
case 2:
options.c_cflag |= CSTOPB;
break;
default:
fprintf(stderr,"Unsupported stop bits\n");
return (-1);
}
/* Set input parity option */
if (parity != 'n')
options.c_iflag |= INPCK;
tcflush(fd,TCIFLUSH);
options.c_cc[VTIME] = 0;
options.c_cc[VMIN] = 20;
if (tcsetattr(fd,TCSANOW,&options) != 0)
{
perror("SetupSerial 3");
return (-1);
}
return(1);
}
评论0