blob: ee14405da3e30fcfc89acc0a8d845715a1c827f5 [file] [log] [blame]
#include <stdio.h>
#include <string.h>
#include <stdlib.h>
#include <signal.h>
#include <sys/types.h>
#include <sys/socket.h>
#include <unistd.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <string.h>
#include <errno.h>
#include <sys/socket.h>
#include <sys/ioctl.h>
#include <net/if.h>
#include <net/if_arp.h>
#include <netinet/in.h>
#include <linux/sockios.h>
//#include <cfg_api.h>
#include <termios.h>
#include <sys/prctl.h>
#include <pthread.h>
#include <assert.h>
#include <sys/select.h>
#define UART_DEV "/dev/ttyS0"
#define ONE_LEN 4095
typedef unsigned int uint32_t;
typedef unsigned char uint8_t;
int uart_fd_0 = -1;
int uart_fd_1 = -1;
int times = 0;
int tlen = 0;
uint8_t dbuf[2100000];
static const uint8_t crc_table[] =
{
0x00,0x31,0x62,0x53,0xc4,0xf5,0xa6,0x97,0xb9,0x88,0xdb,0xea,0x7d,0x4c,0x1f,0x2e,
0x43,0x72,0x21,0x10,0x87,0xb6,0xe5,0xd4,0xfa,0xcb,0x98,0xa9,0x3e,0x0f,0x5c,0x6d,
0x86,0xb7,0xe4,0xd5,0x42,0x73,0x20,0x11,0x3f,0x0e,0x5d,0x6c,0xfb,0xca,0x99,0xa8,
0xc5,0xf4,0xa7,0x96,0x01,0x30,0x63,0x52,0x7c,0x4d,0x1e,0x2f,0xb8,0x89,0xda,0xeb,
0x3d,0x0c,0x5f,0x6e,0xf9,0xc8,0x9b,0xaa,0x84,0xb5,0xe6,0xd7,0x40,0x71,0x22,0x13,
0x7e,0x4f,0x1c,0x2d,0xba,0x8b,0xd8,0xe9,0xc7,0xf6,0xa5,0x94,0x03,0x32,0x61,0x50,
0xbb,0x8a,0xd9,0xe8,0x7f,0x4e,0x1d,0x2c,0x02,0x33,0x60,0x51,0xc6,0xf7,0xa4,0x95,
0xf8,0xc9,0x9a,0xab,0x3c,0x0d,0x5e,0x6f,0x41,0x70,0x23,0x12,0x85,0xb4,0xe7,0xd6,
0x7a,0x4b,0x18,0x29,0xbe,0x8f,0xdc,0xed,0xc3,0xf2,0xa1,0x90,0x07,0x36,0x65,0x54,
0x39,0x08,0x5b,0x6a,0xfd,0xcc,0x9f,0xae,0x80,0xb1,0xe2,0xd3,0x44,0x75,0x26,0x17,
0xfc,0xcd,0x9e,0xaf,0x38,0x09,0x5a,0x6b,0x45,0x74,0x27,0x16,0x81,0xb0,0xe3,0xd2,
0xbf,0x8e,0xdd,0xec,0x7b,0x4a,0x19,0x28,0x06,0x37,0x64,0x55,0xc2,0xf3,0xa0,0x91,
0x47,0x76,0x25,0x14,0x83,0xb2,0xe1,0xd0,0xfe,0xcf,0x9c,0xad,0x3a,0x0b,0x58,0x69,
0x04,0x35,0x66,0x57,0xc0,0xf1,0xa2,0x93,0xbd,0x8c,0xdf,0xee,0x79,0x48,0x1b,0x2a,
0xc1,0xf0,0xa3,0x92,0x05,0x34,0x67,0x56,0x78,0x49,0x1a,0x2b,0xbc,0x8d,0xde,0xef,
0x82,0xb3,0xe0,0xd1,0x46,0x77,0x24,0x15,0x3b,0x0a,0x59,0x68,0xff,0xce,0x9d,0xac
};
uint8_t fibo_crc_calc( uint8_t *datain,uint32_t datalen)
{
uint8_t *input = (uint8_t*)datain;
uint8_t fcs = (uint8_t)0xFF;
int32_t i;
for (i = 0; i < (int32_t)datalen; i++)
fcs = crc_table[fcs ^ (uint8_t)input[i]];
return (uint8_t) (0xFF - fcs);
}
void int_handle(int signo)
{
if(signo == SIGINT)
{
printf("recv signal\n");
exit(1);
}
}
int32_t com_Convbaud(uint32_t iBaudrate)
{
switch(iBaudrate)
{
case 0:
return B0;
case 50:
return B50;
case 75:
return B75;
case 110:
return B110;
case 134:
return B134;
case 150:
return B150;
case 200:
return B200;
case 300:
return B300;
case 600:
return B600;
case 1200:
return B1200;
case 1800:
return B1800;
case 2400:
return B2400;
case 4800:
return B4800;
case 9600:
return B9600;
case 19200:
return B19200;
case 38400:
return B38400;
case 57600:
return B57600;
case 115200:
return B115200;
case 230400:
return B230400;
case 460800:
return B460800;
case 500000:
return B500000;
case 576000:
return B576000;
case 921600:
return B921600;
case 1000000:
return B1000000;
case 1152000:
return B1152000;
case 1500000:
return B1500000;
case 2000000:
return B2000000;
case 2500000:
return B2500000;
case 3000000:
return B3000000;
case 3500000:
return B3500000;
case 4000000:
return B4000000;
default:
return B115200;
}
}
static int com_SetBaud(int32_t iFdCom,int nSpeed)
{
int ret = 0;
struct termios tOldTermios = {0};
int32_t iBaudrate = 0;
bzero(&tOldTermios, sizeof(tOldTermios));
ret = tcgetattr(iFdCom, &tOldTermios); // get the serial port attributions
if(ret)
{
printf("tcgetattr failed! \n");
}
iBaudrate = com_Convbaud(nSpeed);
if(iBaudrate == B115200 && nSpeed != 115200){
//got specil baud, not standerd
printf("the baud set is not standerd, please call other function to set \n");
return 1;
}
tcflush(iFdCom, TCIOFLUSH);
cfsetispeed(&tOldTermios, iBaudrate); //填入串口输入端波特率
cfsetospeed(&tOldTermios, iBaudrate); //填入串口输出端波特率
if(tcsetattr(iFdCom, TCSANOW, &tOldTermios) != 0) //设置新属性, TCSANOW: 所由改变立即生效
{
printf("Set vFnSetBaud error. iFd == %d\n", iFdCom);
return 1;
}
tcflush(iFdCom, TCIOFLUSH);
return 0;
}
static void com_SetnBit(int32_t iFdCom, int nBits)
{
struct termios tOldTermios = {0};
bzero(&tOldTermios, sizeof(tOldTermios));
tcgetattr(iFdCom, &tOldTermios); // get the serial port attributions
switch( nBits )
{
case 7:
tOldTermios.c_cflag |= CS7;
break;
case 8:
default:
tOldTermios.c_cflag |= CS8;
break;
}
if(tcsetattr(iFdCom, TCSANOW, &tOldTermios) != 0) //设置新属性, TCSANOW: 所由改变立即生效
{
printf("Set vFnSetnBit error. iFd == %d\n", iFdCom);
return;
}
tcflush(iFdCom, TCIOFLUSH);
}
static void com_SetParity(int32_t iFdCom,char nEvent)
{
struct termios tOldTermios = {0};
bzero(&tOldTermios, sizeof(tOldTermios));
tcgetattr(iFdCom, &tOldTermios); // get the serial port attributions
switch( nEvent )
{
case 'O': //奇校验
tOldTermios.c_cflag |= PARENB;
tOldTermios.c_cflag |= PARODD;
tOldTermios.c_iflag |= (INPCK | ISTRIP);
break;
case 'E': //偶校验
tOldTermios.c_iflag |= (INPCK | ISTRIP);
tOldTermios.c_cflag |= PARENB;
tOldTermios.c_cflag &= ~PARODD;
break;
case 'N': //无校验
default:
tOldTermios.c_cflag &= ~PARENB;
break;
}
if(tcsetattr(iFdCom, TCSANOW, &tOldTermios) != 0) //设置新属性, TCSANOW: 所由改变立即生效
{
printf("Set vFnSetParity error. iFd == %d\n", iFdCom);
return;
}
tcflush(iFdCom, TCIOFLUSH);
}
static void com_SetnStop(int32_t iFdCom, int nStop)
{
struct termios tOldTermios = {0};
bzero(&tOldTermios, sizeof(tOldTermios));
tcgetattr(iFdCom, &tOldTermios); // get the serial port attributions
switch( nStop )
{
case 1:
tOldTermios.c_cflag &= ~CSTOPB;
break;
case 2:
tOldTermios.c_cflag |= CSTOPB;
break;
default:
tOldTermios.c_cflag &= ~CSTOPB;
break;
}
if(tcsetattr(iFdCom, TCSANOW, &tOldTermios) != 0) //设置新属性, TCSANOW: 所由改变立即生效
{
printf("Set vFnSetnStop error. iFd == %d\n", iFdCom);
return;
}
tcflush(iFdCom, TCIOFLUSH);
}
static void com_SetCtrl(int32_t iFdCom, int nCtrl)
{
struct termios tOldTermios = {0};
bzero(&tOldTermios, sizeof(tOldTermios));
tcgetattr(iFdCom, &tOldTermios); // get the serial port attributions
switch(nCtrl)
{
case 0:
{
tOldTermios.c_cflag &= ~CRTSCTS; //no flow control
tOldTermios.c_iflag |= IGNBRK | IGNPAR;
}break;
case 1:
{
tOldTermios.c_cflag |= CRTSCTS; //hardware flow control
}break;
case 2:
{
tOldTermios.c_iflag |= IXON | IXOFF | IXANY; //software flow control
}break;
default:
break;
}
if(tcsetattr(iFdCom, TCSANOW, &tOldTermios) != 0) //设置新属性, TCSANOW: 所由改变立即生效
{
printf("Set vFnSetCtrl error. iFd == %d\n", iFdCom);
return;
}
tcflush(iFdCom, TCIOFLUSH);
//printf("Set vFnSetCtrl end\n");
}
static void com_SetTimeOut(int32_t iFdCom, int iTime)
{
struct termios tOldTermios = {0};
bzero(&tOldTermios, sizeof(tOldTermios));
tcgetattr(iFdCom, &tOldTermios); // get the serial port attributions
tOldTermios.c_cc[VTIME] = iTime;
tOldTermios.c_cc[VMIN] = 0;
if(tcsetattr(iFdCom, TCSANOW, &tOldTermios) != 0) //设置新属性, TCSANOW: 所由改变立即生效
{
printf("Set TimeOut error. iFd == %d\n", iFdCom);
return;
}
tcflush(iFdCom, TCIOFLUSH);
}
static int zUP_SetPort_0(int32_t iFd ,int ctsrts_en, int iBaud, int iDelay)
{
com_SetBaud(iFd, iBaud);
com_SetnBit(iFd, 8);
com_SetParity(iFd, 'N');
//com_SetParity(iFd, 'O');
com_SetnStop(iFd,1);
com_SetCtrl(iFd,ctsrts_en); //add flow control
com_SetTimeOut(iFd,iDelay); //timeout 100ms
printf("set serial port done!\n");
return 0;
}
int block_select_one_time()
{
int ret;
fd_set rfds;
FD_ZERO(&rfds);
FD_SET(uart_fd_0,&rfds);
ret = select(uart_fd_0+1,&rfds,NULL,NULL,NULL);
if(ret == -1)
{
printf("select error: -1");
return 0;
}
else
{
return 1;
}
return 1;
}
void check_one_time()
{
uint8_t crc_board = 0;
if((dbuf[0] != 0xA5)||(dbuf[1] != 0x5A)||(dbuf[tlen-2] != 0xD5)||(dbuf[tlen-1] != 0x5D))
{
printf("head or tail error \n");
assert(0);
}
uint8_t* dbuf2 = NULL;
dbuf2 = (uint8_t*)malloc(2100000);
if(dbuf2 == NULL)
{
printf("malloc failed!\n");
exit(1);
}
memcpy(dbuf2, dbuf+2, tlen-5);
crc_board = fibo_crc_calc(dbuf2,tlen-5);
if(crc_board != dbuf[tlen-3])
{
printf("crc error, value is %d\n", crc_board);
assert(0);
}
printf("----------------------crc pass! value :%d----------------------\n", crc_board);
if(dbuf2 != NULL)
{
free(dbuf2);
dbuf2 = NULL;
}
}
int send_one_time()
{
int len = 0;
len = write(uart_fd_0, &times, 4);
if(len <= 0)
{
printf("Ack write failed %s\n",strerror(errno));
return 0;
}
printf("Ack send success index :%d\n", times);
return 1;
}
int read_datas_tty()
{
int recv_len = 0;
tlen = 0;
while(1)
{
recv_len = read(uart_fd_0, dbuf+tlen, ONE_LEN);
if(recv_len == 0)
{
printf("read end! please wait for this packet's handle\n");
break;
}
else if(recv_len < 0)
{
printf("read_datas_tty error %s\n",strerror(errno));
return 0;
}
else
{
tlen += recv_len;
}
}
printf("read last time len :%d total len :%d\n",recv_len, tlen);
//printf("0 is %#x, 1 is %#x, -3 is %#x, -2 is %#x, -1 is %#x\n",dbuf[0],dbuf[1],dbuf[tlen-3],dbuf[tlen-2],dbuf[tlen-1]);
return 1;
}
int main(int argc, char** argv)
{
int ret0 = 0;
int baud = atoi(argv[1]);
int delay = atoi(argv[2]);
printf("crc main programe start...\n");
signal(SIGINT,int_handle);
uart_fd_0 = open("/dev/ttyS0",O_RDWR);
if(uart_fd_0 < 0)
{
printf("open uart dev failed :%s\n",strerror(errno));
return -1;
}
zUP_SetPort_0(uart_fd_0, 0, baud, delay);
memset(dbuf,0,2100000);
while(1)
{
ret0 = send_one_time();
if(!ret0)
{
break;
}
if(block_select_one_time())
{
ret0 = read_datas_tty();
if(ret0)
{
check_one_time();
times++;
}
else
{
printf("read_datas_tty failed\n");
break;
}
}
}
printf("crc main programe end...\n");
close(uart_fd_0);
return 1;
}