rs485 [linux c/c++]
http://blog.163.com/zhangzhiyin88@126/blog/static/75966301201010210410908/
###
## There are additional comments related knowledge points
// file: rs485.c
// serial port communiction
// rs485
// tc400 communication protocol
#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <termios.h>
#include <errno.h>
#include <string.h>
#include <time.h>
#define FALSE -1
#define TRUE 0
#define uint16 unsigned short
#define uint8 unsigned char
const uint16 genpoly16 = 0x8408;
// crc table
const uint16 crc16_256_table[256] =
{
0x0000,0x1189,0x2312,0x329B,0x4624,0x57AD,0x6536,0x74BF,
0x8C48,0x9DC1,0xAF5A,0xBED3,0xCA6C,0xDBE5,0xE97E,0xF8F7,
0x1081,0x0108,0x3393,0x221A,0x56A5,0x472C,0x75B7,0x643E,
0x9CC9,0x8D40,0xBFDB,0xAE52,0xDAED,0xCB64,0xF9FF,0xE876,
0x2102,0x308B,0x0210,0x1399,0x6726,0x76AF,0x4434,0x55BD,
0xAD4A,0xBCC3,0x8E58,0x9FD1,0xEB6E,0xFAE7,0xC87C,0xD9F5,
0x3183,0x200A,0x1291,0x0318,0x77A7,0x662E,0x54B5,0x453C,
0xBDCB,0xAC42,0x9ED9,0x8F50,0xFBEF,0xEA66,0xD8FD,0xC974,
0x4204,0x538D,0x6116,0x709F,0x0420,0x15A9,0x2732,0x36BB,
0xCE4C,0xDFC5,0xED5E,0xFCD7,0x8868,0x99E1,0xAB7A,0xBAF3,
0x5285,0x430C,0x7197,0x601E,0x14A1,0x0528,0x37B3,0x263A,
0xDECD,0xCF44,0xFDDF,0xEC56,0x98E9,0x8960,0xBBFB,0xAA72,
0x6306,0x728F,0x4014,0x519D,0x2522,0x34AB,0x0630,0x17B9,
0xEF4E,0xFEC7,0xCC5C,0xDDD5,0xA96A,0xB8E3,0x8A78,0x9BF1,
0x7387,0x620E,0x5095,0x411C,0x35A3,0x242A,0x16B1,0x0738,
0xFFCF,0xEE46,0xDCDD,0xCD54,0xB9EB,0xA862,0x9AF9,0x8B70,
0x8408,0x9581,0xA71A,0xB693,0xC22C,0xD3A5,0xE13E,0xF0B7,
0x0840,0x19C9,0x2B52,0x3ADB,0x4E64,0x5FED,0x6D76,0x7CFF,
0x9489,0x8500,0xB79B,0xA612,0xD2AD,0xC324,0xF1BF,0xE036,
0x18C1,0x0948,0x3BD3,0x2A5A,0x5EE5,0x4F6C,0x7DF7,0x6C7E,
0xA50A,0xB483,0x8618,0x9791,0xE32E,0xF2A7,0xC03C,0xD1B5,
0x2942,0x38CB,0x0A50,0x1BD9,0x6F66,0x7EEF,0x4C74,0x5DFD,
0xB58B,0xA402,0x9699,0x8710,0xF3AF,0xE226,0xD0BD,0xC134,
0x39C3,0x284A,0x1AD1,0x0B58,0x7FE7,0x6E6E,0x5CF5,0x4D7C,
0xC60C,0xD785,0xE51E,0xF497,0x8028,0x91A1,0xA33A,0xB2B3,
0x4A44,0x5BCD,0x6956,0x78DF,0x0C60,0x1DE9,0x2F72,0x3EFB,
0xD68D,0xC704,0xF59F,0xE416,0x90A9,0x8120,0xB3BB,0xA232,
0x5AC5,0x4B4C,0x79D7,0x685E,0x1CE1,0x0D68,0x3FF3,0x2E7A,
0xE70E,0xF687,0xC41C,0xD595,0xA12A,0xB0A3,0x8238,0x93B1,
0x6B46,0x7ACF,0x4854,0x59DD,0x2D62,0x3CEB,0x0E70,0x1FF9,
0xF78F,0xE606,0xD49D,0xC514,0xB1AB,0xA022,0x92B9,0x8330,
0x7BC7,0x6A4E,0x58D5,0x495C,0x3DE3,0x2C6A,0x1EF1,0x0F78
};
// LSB-first transmission, the genpoly need be inversed.
// CRC-16 CCITT
// X^16 + X^12 + X^5 + 1
uint16 cal_crc(uint8 *data, int data_len, uint16 init_val_of_crc)
{
uint16 crc = init_val_of_crc;
while (data_len-- >0)
{
crc ^= *data ++;
crc = (crc >> 8) ^ crc16_256_table[crc & 255];
}
return crc;
}
int open_dev(char *Dev)
{
int fd = open( Dev, O_RDWR);
if (-1 == fd)
{
perror("Can't Open Serial Port");
return -1;
}
if (fcntl(fd, F_SETFL, O_NONBLOCK) < 0)
{
printf("Unable set to NONBLOCK mode");
return -1;
}
return fd;
}
// set serial speed
int speed_arr[] = { B38400, B19200, B9600, B4800, B2400, B1200, B300, \
B38400, B19200, B9600, B4800, B2400, B1200, B300, };
int name_arr[] = { 38400, 19200, 9600, 4800, 2400, 1200, 300, 38400, \
19200, 9600, 4800, 2400, 1200, 300, };
void set_speed(int fd, int speed)
{
int i;
int status;
struct termios Opt;
tcgetattr(fd, &Opt);
for ( i=0; i<sizeof(speed_arr)/sizeof(int); i++)
{
if (speed == name_arr[i])
{
tcflush(fd, TCIOFLUSH);
cfsetispeed(&Opt, speed_arr[i]);
cfsetospeed(&Opt, speed_arr[i]);
status = tcsetattr(fd, TCSANOW, &Opt);
if (status != 0)
{
perror("tcsetattr fd1");
return;
}
tcflush(fd,TCIOFLUSH);
}
}
}
// set serial port data, stop and crc bit.
int set_parity(int fd, int databits, int stopbits, int parity)
{
struct termios options;
if ( tcgetattr(fd, &options) != 0)
{
perror("SetupSerial 1");
return(FALSE);
}
options.c_cflag &= ~CSIZE;
// data bit
switch (databits)
{
case 7:
options.c_cflag |= CS7;
break;
case 8:
options.c_cflag |= CS8;
break;
default:
fprintf(stderr,"Unsupported data size\n");
return (FALSE);
}
switch (parity)
{
case 'n':
case 'N':
options.c_cflag &= ~PARENB; // Clear parity enable
options.c_iflag &= ~INPCK; // Enable parity checking
options.c_lflag &= 0; // add comment it's very important to set this parameter.
options.c_oflag &= ~OPOST; /*Output*/
break;
case 'o':
case 'O':
options.c_cflag |= (PARODD | PARENB); // set odd parity
options.c_iflag |= INPCK; // disnable parity checking
break;
case 'e':
case 'E':
options.c_cflag |= PARENB; // enable parity
options.c_cflag &= ~PARODD; // change into even
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 (FALSE);
}
// set stop bit
switch (stopbits)
{
case 1:
options.c_cflag &= ~CSTOPB;
break;
case 2:
options.c_cflag |= CSTOPB;
break;
default:
fprintf(stderr,"Unsupported stop bits\n");
return (FALSE);
}
// Set input parity option
if (parity != 'n')
options.c_iflag |= INPCK;
tcflush(fd,TCIFLUSH);
options.c_cc[VTIME] = 150; // set time out for 15 seconds
options.c_cc[VMIN] = 0; // update the options and do it now
if (tcsetattr(fd,TCSANOW,&options) != 0)
{
perror("SetupSerial 3");
return (FALSE);
}
return (TRUE);
}
void config_s(int fd)
{
struct termios oldtio, newtio;
tcgetattr(fd, &oldtio);
memset(&newtio, 0, sizeof(newtio));
newtio.c_cflag = B9600 | CS8 | CLOCAL | CREAD | CSTOPB;
newtio.c_cflag &= ~CRTSCTS;
newtio.c_iflag = IGNPAR | ICRNL;
newtio.c_iflag &= ~( IXON | IXOFF | IXANY );
newtio.c_oflag = 0;
newtio.c_lflag = ICANON;
tcflush(fd, TCIFLUSH);
tcsetattr(fd, TCSANOW, &newtio);
}
int main(int argc, char **argv)
{
int nread;
int nwrite;
uint8 rev_buf[512];
uint8 send_buf[512];
uint8 user_name[11];
uint8 rev_tmp[39];
int send_len;
int rev_len;
uint16 send_crc;
uint16 rev_crc;
uint16 tmp_crc;
int i;
int num;
int tmp_num;
time_t seconds;
FILE *fp = 0;
int fd;
char *dev = "/dev/ttyS0";
// open serial port and set parameters
fd = open_dev(dev);
set_speed(fd,9600);
config_s(fd); // it's so important that we must face this.
if (set_parity(fd,8,1,'N') == FALSE)
{
printf("set parity error\n");
exit (0);
}
else
{
printf("set serial ok!\n");
}
// -------------------------------------------
// send cmd common part
// stx
send_buf[0] = 0xa5;
// ch (machine id)
send_buf[1] = 0x00;
send_buf[2] = 0x00;
send_buf[3] = 0x00;
send_buf[4] = 0x00;
while(1)
{
// print menu
printf("0. exit!\n");
printf("1. get counts.\n");
printf("2. get date/time.\n");
printf("3. get device network info.\n");
printf("4. get person info.\n");
printf("5. get records.\n");
printf("6. get fp template.\n");
printf("7. get configure.\n");
printf("\nplsease enter num: ");
scanf("%d", &num);
// num = 3;
switch(num)
{
// exit
case 0:
printf("exiting ..\n");
close(fd);
return 0;
break;
// get the num of the account
case 1:
// send cmd 0x3c
// send cmd
send_buf[5] = 0x3c;
// send length
send_buf[6] = 0x00;
send_buf[7] = 0x00;
// send_crc
send_crc = cal_crc(send_buf, 8, -1);
send_buf[8] = (uint8)(send_crc & 0xFF);
send_buf[9] = (uint8)(send_crc >> 8);
// send and rev data
// send data
send_len = write(fd, send_buf, 10);
printf("send len: %d\n", send_len);
sleep(2);
// receive data
if((rev_len=read(fd, rev_buf, 512)) == -1)
{
printf("read error!\n");
}
else
{
printf("rev len: %d\n", rev_len);
rev_crc = (rev_buf[rev_len-1]*256 + rev_buf[rev_len-2]);
tmp_crc = cal_crc(rev_buf, (rev_len-2), -1);
if (rev_crc==tmp_crc && rev_buf[6]==0)
{
printf("ack successful!\n");
printf("ack information, as follows:\n");
printf("-------------------------------------\n");
printf(" staffs: %d\n", ( rev_buf[9]*256*256 + \
rev_buf[10]*256 + \
rev_buf[11] ) );
printf(" fp: %d\n", ( rev_buf[12]*256*256 + \
rev_buf[13]*256 + \
rev_buf[14] ) );
printf(" records: %d\n", ( rev_buf[21]*256*256 + \
rev_buf[22]*256 + \
rev_buf[23] ) );
printf("-------------------------------------\n");
}
else
{
printf("ack failed!\n");
}
printf("\n");
}
break;
// get data/time
case 2:
// send cmd 0x38
// send cmd
send_buf[5] = 0x38;
// send length
send_buf[6] = 0x00;
send_buf[7] = 0x00;
// send_crc
send_crc = cal_crc(send_buf, 8, -1);
send_buf[8] = (uint8)(send_crc & 0xFF);
send_buf[9] = (uint8)(send_crc >> 8);
// send and rev data
// send data
send_len = write(fd, send_buf, 10);
printf("send len: %d\n", send_len);
sleep(3);
// receive data
if((rev_len = read(fd, rev_buf, 512))==-1)
{
printf("read error!\n");
}
else
{
printf("rev len: %d\n", rev_len);
rev_crc = (rev_buf[rev_len-1]*256 + rev_buf[rev_len-2]);
tmp_crc = cal_crc(rev_buf, (rev_len - 2), -1);
if (rev_crc==tmp_crc && rev_buf[6]==0)
{
printf("ack successful!\n");
printf("ack information, as follows:\n");
printf("-------------------------------------\n");
// date/time
printf(" date/time: 20%d/%02d/%02d \n %02d:%02d:%02d\n", \
rev_buf[9] , rev_buf[10], rev_buf[11], \
rev_buf[12], rev_buf[13], rev_buf[14]);
printf("-------------------------------------\n");
}
else
{
printf("ack failed!\n");
}
printf("\n");
}
break;
// get device net info
case 3:
// send cmd 0x3a
// send cmd
send_buf[5] = 0x3a;
// send length
send_buf[6] = 0x00;
send_buf[7] = 0x00;
// send_crc
send_crc = cal_crc(send_buf, 8, -1);
send_buf[8] = (uint8)(send_crc & 0xFF);
send_buf[9] = (uint8)(send_crc >> 8);
// send and rev data
// send data
send_len = write(fd, send_buf, 10);
printf("send len: %d\n", send_len);
sleep(3);
// receive data
if((rev_len=read(fd, rev_tmp, 512)) == -1)
{
printf("read error!\n");
}
else
{
printf("rev len: %d\n", rev_len);
rev_crc = (rev_tmp[rev_len-1]*256 + rev_tmp[rev_len-2]);
tmp_crc = cal_crc(rev_tmp, (rev_len-2), -1);
if (rev_crc==tmp_crc && rev_buf[6]==0)
{
printf("ack successful!\n");
printf("ack information, as follows:\n");
printf("-------------------------------------\n");
// ip addr
printf(" ip: %d.%d.%d.%d\n", \
rev_tmp[9] ,rev_tmp[10], \
rev_tmp[11], rev_tmp[12]);
// network mask
printf("network mask: %d.%d.%d.%d\n", \
rev_tmp[13] ,rev_tmp[14], \
rev_tmp[15], rev_tmp[16]);
// mac addr
printf(" mac: %02x:%02x:%02x:%02x:%02x:%02x\n", \
rev_tmp[17] ,rev_tmp[18], rev_tmp[19],\
rev_tmp[20], rev_tmp[21], rev_tmp[22]);
// gateway
printf(" gateway: %d.%d.%d.%d\n", \
rev_tmp[23] ,rev_tmp[24], \
rev_tmp[25], rev_tmp[26]);
// server addr
printf(" server: %d.%d.%d.%d\n", \
rev_tmp[27] ,rev_tmp[28], \
rev_tmp[29], rev_tmp[30]);
// limit
printf(" limit: %d\n", rev_tmp[31]);
// port
printf(" port: %d\n", rev_tmp[32]*256 + rev_tmp[33]);
// mode
printf(" mode: %d\n", rev_tmp[34]);
// dhcp
printf(" dhcp: %d\n", rev_tmp[35]);
printf("-------------------------------------\n");
}
else
{
printf("ack failed!\n");
}
printf("\n");
}
break;
// get person info.
case 4:
// send cmd 0x42
// send cmd
send_buf[5] = 0x42;
// send length
send_buf[6] = 0x00;
send_buf[7] = 0x02;
// data
send_buf[8] = 0x01;
send_buf[9] = 0x0c;
// send_crc
send_crc = cal_crc(send_buf, 10, -1);
send_buf[10] = (uint8)(send_crc & 0xFF);
send_buf[11] = (uint8)(send_crc >> 8);
// send and rev data
// send data
send_len = write(fd, send_buf, 12);
printf("send len: %d\n", send_len);
sleep(1);
// receive data
if((rev_len=read(fd, rev_buf, 512)) == -1)
{
printf("read error!\n");
}
else
{
printf("rev len: %d\n", rev_len);
rev_crc = (rev_buf[rev_len-1]*256 + rev_buf[rev_len-2]);
tmp_crc = cal_crc(rev_buf, (rev_len-2), -1);
if (rev_crc==tmp_crc && rev_buf[6]==0)
{
printf("ack successful!\n");
printf("ack information, as follows:\n");
tmp_num = rev_buf[9];
printf("-------------------------------------\n");
printf("=====================\n");
for(i=0; i<tmp_num; i++)
{
// user no
printf(" user no: %d%d%d%d%d\n", \
rev_buf[i*27+10], rev_buf[i*27+11], \
rev_buf[i*27+12], rev_buf[i*27+13], \
rev_buf[i*27+14] );
// passwd
if((rev_buf[i*27+16]*256 + rev_buf[i*27+17]) != 0)
{
printf(" passwd: \n");
}
else
{
printf(" passwd: %d\n", (rev_buf[i*27+16]*256 + \
rev_buf[i*27+17]) );
}
// card no
printf(" card no: %d\n", (rev_buf[i*27+18]*256*256 + \
rev_buf[i*27+19]*256 + rev_buf[i*27+20]));
// name
strncpy(user_name, &rev_buf[i*27+21], 10);
user_name[10] = '\0';
printf(" name: %s\n", user_name);
// dept
printf(" dept: %d\n", rev_buf[i*27+30]);
// group
printf(" group: %d\n", rev_buf[i*27+31]);
// mode
printf(" mode: %d\n", rev_buf[i*27+32]);
printf("=====================\n");
}
printf("-------------------------------------\n");
}
else
{
printf("ack failed!\n");
}
printf("\n");
}
break;
// get records
case 5:
// send cmd 0x40
// send cmd
send_buf[5] = 0x40;
// send length
send_buf[6] = 0x00;
send_buf[7] = 0x02;
// data
send_buf[8] = 0x01;
send_buf[9] = 0x19;
// send_crc
send_crc = cal_crc(send_buf, 10, -1);
send_buf[10] = (uint8)(send_crc & 0xFF);
send_buf[11] = (uint8)(send_crc >> 8);
// send and rev data
// send data
send_len = write(fd, send_buf, 12);
printf("send len: %d\n", send_len);
sleep(1);
// receive data
if((rev_len=read(fd, rev_buf, 512)) == -1)
{
printf("read error!\n");
}
else
{
printf("rev len: %d\n", rev_len);
rev_crc = (rev_buf[rev_len-1]*256 + rev_buf[rev_len-2]);
tmp_crc = cal_crc(rev_buf, (rev_len-2), -1);
if (rev_crc==tmp_crc && rev_buf[6]==0)
{
printf("ack successful!\n");
printf("ack information, as follows:\n");
tmp_num = rev_buf[9];
printf("-------------------------------------\n");
printf("=====================\n");
for(i=0; i<tmp_num; i++)
{
printf(" %d\n", i+1);
// user no
printf(" user no: %d%d%d%d%d\n", \
rev_buf[i*14+10], rev_buf[i*14+11],\
rev_buf[i*14+12], rev_buf[i*14+13], \
rev_buf[i*14+14] );
// date/time
seconds = rev_buf[i*14+15]*256*256*256 + \
rev_buf[i*14+16]*256*256 + \
rev_buf[i*14+17]*256 + \
rev_buf[i*14+18];
printf(" date/time: %d/%02d/%02d \n %02d:%02d:%02d\n",\
gmtime(&seconds)->tm_year+1930, gmtime(&seconds)->tm_mon+1, \
gmtime(&seconds)->tm_mday+1, gmtime(&seconds)->tm_hour, \
gmtime(&seconds)->tm_min, gmtime(&seconds)->tm_sec);
// bac no
printf(" bac no: %d\n", rev_buf[i*14+19]);
// record type
printf("record type: %d\n", rev_buf[i*14+20]);
printf("=====================\n");
}
printf("-------------------------------------\n");
}
else
{
printf("ack failed!\n");
}
printf("\n");
}
break;
// get fp template
case 6:
// send cmd 0x44
// send cmd
send_buf[5] = 0x44;
// send length
send_buf[6] = 0x00;
send_buf[7] = 0x06;
// data
send_buf[8] = 0x00;
send_buf[9] = 0x00;
send_buf[10] = 0x00;
send_buf[11] = 0x00;
send_buf[12] = 0x01;
send_buf[13] = 0x01;
// send_crc
send_crc = cal_crc(send_buf, 14, -1);
send_buf[14] = (uint8)(send_crc & 0xFF);
send_buf[15] = (uint8)(send_crc >> 8);
// send and rev data
// send data
send_len = write(fd, send_buf, 16);
printf("send len: %d\n", send_len);
sleep(2);
// receive data
if((rev_len=read(fd, rev_buf, 512)) == -1)
{
printf("read error!\n");
}
else
{
printf("rev len: %d\n", rev_len);
rev_crc = (rev_buf[rev_len-1]*256 + rev_buf[rev_len-2]);
tmp_crc = cal_crc(rev_buf, (rev_len-2), -1);
if (rev_crc==tmp_crc && rev_buf[6]==0)
{
printf("ack successful!\n");
printf("ack information, as follows:\n");
printf("-------------------------------------\n");
fp = fopen("template/1_1.anv", "wb");
printf(" writing fp template ..\n");
fwrite(&rev_buf[9], 1, 338, fp);
fclose(fp);
printf("-------------------------------------\n");
}
else
{
printf("ack failed!\n");
}
printf("\n");
}
break;
default:
printf("error num!\n");
break;
}
}
close(fd);
return 0;
}
good luck!
~_~
## There are additional comments related knowledge points
// file: rs485.c
// serial port communiction
// rs485
// tc400 communication protocol
#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <termios.h>
#include <errno.h>
#include <string.h>
#include <time.h>
#define FALSE -1
#define TRUE 0
#define uint16 unsigned short
#define uint8 unsigned char
const uint16 genpoly16 = 0x8408;
// crc table
const uint16 crc16_256_table[256] =
{
0x0000,0x1189,0x2312,0x329B,0x4624,0x57AD,0x6536,0x74BF,
0x8C48,0x9DC1,0xAF5A,0xBED3,0xCA6C,0xDBE5,0xE97E,0xF8F7,
0x1081,0x0108,0x3393,0x221A,0x56A5,0x472C,0x75B7,0x643E,
0x9CC9,0x8D40,0xBFDB,0xAE52,0xDAED,0xCB64,0xF9FF,0xE876,
0x2102,0x308B,0x0210,0x1399,0x6726,0x76AF,0x4434,0x55BD,
0xAD4A,0xBCC3,0x8E58,0x9FD1,0xEB6E,0xFAE7,0xC87C,0xD9F5,
0x3183,0x200A,0x1291,0x0318,0x77A7,0x662E,0x54B5,0x453C,
0xBDCB,0xAC42,0x9ED9,0x8F50,0xFBEF,0xEA66,0xD8FD,0xC974,
0x4204,0x538D,0x6116,0x709F,0x0420,0x15A9,0x2732,0x36BB,
0xCE4C,0xDFC5,0xED5E,0xFCD7,0x8868,0x99E1,0xAB7A,0xBAF3,
0x5285,0x430C,0x7197,0x601E,0x14A1,0x0528,0x37B3,0x263A,
0xDECD,0xCF44,0xFDDF,0xEC56,0x98E9,0x8960,0xBBFB,0xAA72,
0x6306,0x728F,0x4014,0x519D,0x2522,0x34AB,0x0630,0x17B9,
0xEF4E,0xFEC7,0xCC5C,0xDDD5,0xA96A,0xB8E3,0x8A78,0x9BF1,
0x7387,0x620E,0x5095,0x411C,0x35A3,0x242A,0x16B1,0x0738,
0xFFCF,0xEE46,0xDCDD,0xCD54,0xB9EB,0xA862,0x9AF9,0x8B70,
0x8408,0x9581,0xA71A,0xB693,0xC22C,0xD3A5,0xE13E,0xF0B7,
0x0840,0x19C9,0x2B52,0x3ADB,0x4E64,0x5FED,0x6D76,0x7CFF,
0x9489,0x8500,0xB79B,0xA612,0xD2AD,0xC324,0xF1BF,0xE036,
0x18C1,0x0948,0x3BD3,0x2A5A,0x5EE5,0x4F6C,0x7DF7,0x6C7E,
0xA50A,0xB483,0x8618,0x9791,0xE32E,0xF2A7,0xC03C,0xD1B5,
0x2942,0x38CB,0x0A50,0x1BD9,0x6F66,0x7EEF,0x4C74,0x5DFD,
0xB58B,0xA402,0x9699,0x8710,0xF3AF,0xE226,0xD0BD,0xC134,
0x39C3,0x284A,0x1AD1,0x0B58,0x7FE7,0x6E6E,0x5CF5,0x4D7C,
0xC60C,0xD785,0xE51E,0xF497,0x8028,0x91A1,0xA33A,0xB2B3,
0x4A44,0x5BCD,0x6956,0x78DF,0x0C60,0x1DE9,0x2F72,0x3EFB,
0xD68D,0xC704,0xF59F,0xE416,0x90A9,0x8120,0xB3BB,0xA232,
0x5AC5,0x4B4C,0x79D7,0x685E,0x1CE1,0x0D68,0x3FF3,0x2E7A,
0xE70E,0xF687,0xC41C,0xD595,0xA12A,0xB0A3,0x8238,0x93B1,
0x6B46,0x7ACF,0x4854,0x59DD,0x2D62,0x3CEB,0x0E70,0x1FF9,
0xF78F,0xE606,0xD49D,0xC514,0xB1AB,0xA022,0x92B9,0x8330,
0x7BC7,0x6A4E,0x58D5,0x495C,0x3DE3,0x2C6A,0x1EF1,0x0F78
};
// LSB-first transmission, the genpoly need be inversed.
// CRC-16 CCITT
// X^16 + X^12 + X^5 + 1
uint16 cal_crc(uint8 *data, int data_len, uint16 init_val_of_crc)
{
uint16 crc = init_val_of_crc;
while (data_len-- >0)
{
crc ^= *data ++;
crc = (crc >> 8) ^ crc16_256_table[crc & 255];
}
return crc;
}
int open_dev(char *Dev)
{
int fd = open( Dev, O_RDWR);
if (-1 == fd)
{
perror("Can't Open Serial Port");
return -1;
}
if (fcntl(fd, F_SETFL, O_NONBLOCK) < 0)
{
printf("Unable set to NONBLOCK mode");
return -1;
}
return fd;
}
// set serial speed
int speed_arr[] = { B38400, B19200, B9600, B4800, B2400, B1200, B300, \
B38400, B19200, B9600, B4800, B2400, B1200, B300, };
int name_arr[] = { 38400, 19200, 9600, 4800, 2400, 1200, 300, 38400, \
19200, 9600, 4800, 2400, 1200, 300, };
void set_speed(int fd, int speed)
{
int i;
int status;
struct termios Opt;
tcgetattr(fd, &Opt);
for ( i=0; i<sizeof(speed_arr)/sizeof(int); i++)
{
if (speed == name_arr[i])
{
tcflush(fd, TCIOFLUSH);
cfsetispeed(&Opt, speed_arr[i]);
cfsetospeed(&Opt, speed_arr[i]);
status = tcsetattr(fd, TCSANOW, &Opt);
if (status != 0)
{
perror("tcsetattr fd1");
return;
}
tcflush(fd,TCIOFLUSH);
}
}
}
// set serial port data, stop and crc bit.
int set_parity(int fd, int databits, int stopbits, int parity)
{
struct termios options;
if ( tcgetattr(fd, &options) != 0)
{
perror("SetupSerial 1");
return(FALSE);
}
options.c_cflag &= ~CSIZE;
// data bit
switch (databits)
{
case 7:
options.c_cflag |= CS7;
break;
case 8:
options.c_cflag |= CS8;
break;
default:
fprintf(stderr,"Unsupported data size\n");
return (FALSE);
}
switch (parity)
{
case 'n':
case 'N':
options.c_cflag &= ~PARENB; // Clear parity enable
options.c_iflag &= ~INPCK; // Enable parity checking
options.c_lflag &= 0; // add comment it's very important to set this parameter.
options.c_oflag &= ~OPOST; /*Output*/
break;
case 'o':
case 'O':
options.c_cflag |= (PARODD | PARENB); // set odd parity
options.c_iflag |= INPCK; // disnable parity checking
break;
case 'e':
case 'E':
options.c_cflag |= PARENB; // enable parity
options.c_cflag &= ~PARODD; // change into even
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 (FALSE);
}
// set stop bit
switch (stopbits)
{
case 1:
options.c_cflag &= ~CSTOPB;
break;
case 2:
options.c_cflag |= CSTOPB;
break;
default:
fprintf(stderr,"Unsupported stop bits\n");
return (FALSE);
}
// Set input parity option
if (parity != 'n')
options.c_iflag |= INPCK;
tcflush(fd,TCIFLUSH);
options.c_cc[VTIME] = 150; // set time out for 15 seconds
options.c_cc[VMIN] = 0; // update the options and do it now
if (tcsetattr(fd,TCSANOW,&options) != 0)
{
perror("SetupSerial 3");
return (FALSE);
}
return (TRUE);
}
void config_s(int fd)
{
struct termios oldtio, newtio;
tcgetattr(fd, &oldtio);
memset(&newtio, 0, sizeof(newtio));
newtio.c_cflag = B9600 | CS8 | CLOCAL | CREAD | CSTOPB;
newtio.c_cflag &= ~CRTSCTS;
newtio.c_iflag = IGNPAR | ICRNL;
newtio.c_iflag &= ~( IXON | IXOFF | IXANY );
newtio.c_oflag = 0;
newtio.c_lflag = ICANON;
tcflush(fd, TCIFLUSH);
tcsetattr(fd, TCSANOW, &newtio);
}
int main(int argc, char **argv)
{
int nread;
int nwrite;
uint8 rev_buf[512];
uint8 send_buf[512];
uint8 user_name[11];
uint8 rev_tmp[39];
int send_len;
int rev_len;
uint16 send_crc;
uint16 rev_crc;
uint16 tmp_crc;
int i;
int num;
int tmp_num;
time_t seconds;
FILE *fp = 0;
int fd;
char *dev = "/dev/ttyS0";
// open serial port and set parameters
fd = open_dev(dev);
set_speed(fd,9600);
config_s(fd); // it's so important that we must face this.
if (set_parity(fd,8,1,'N') == FALSE)
{
printf("set parity error\n");
exit (0);
}
else
{
printf("set serial ok!\n");
}
// -------------------------------------------
// send cmd common part
// stx
send_buf[0] = 0xa5;
// ch (machine id)
send_buf[1] = 0x00;
send_buf[2] = 0x00;
send_buf[3] = 0x00;
send_buf[4] = 0x00;
while(1)
{
// print menu
printf("0. exit!\n");
printf("1. get counts.\n");
printf("2. get date/time.\n");
printf("3. get device network info.\n");
printf("4. get person info.\n");
printf("5. get records.\n");
printf("6. get fp template.\n");
printf("7. get configure.\n");
printf("\nplsease enter num: ");
scanf("%d", &num);
// num = 3;
switch(num)
{
// exit
case 0:
printf("exiting ..\n");
close(fd);
return 0;
break;
// get the num of the account
case 1:
// send cmd 0x3c
// send cmd
send_buf[5] = 0x3c;
// send length
send_buf[6] = 0x00;
send_buf[7] = 0x00;
// send_crc
send_crc = cal_crc(send_buf, 8, -1);
send_buf[8] = (uint8)(send_crc & 0xFF);
send_buf[9] = (uint8)(send_crc >> 8);
// send and rev data
// send data
send_len = write(fd, send_buf, 10);
printf("send len: %d\n", send_len);
sleep(2);
// receive data
if((rev_len=read(fd, rev_buf, 512)) == -1)
{
printf("read error!\n");
}
else
{
printf("rev len: %d\n", rev_len);
rev_crc = (rev_buf[rev_len-1]*256 + rev_buf[rev_len-2]);
tmp_crc = cal_crc(rev_buf, (rev_len-2), -1);
if (rev_crc==tmp_crc && rev_buf[6]==0)
{
printf("ack successful!\n");
printf("ack information, as follows:\n");
printf("-------------------------------------\n");
printf(" staffs: %d\n", ( rev_buf[9]*256*256 + \
rev_buf[10]*256 + \
rev_buf[11] ) );
printf(" fp: %d\n", ( rev_buf[12]*256*256 + \
rev_buf[13]*256 + \
rev_buf[14] ) );
printf(" records: %d\n", ( rev_buf[21]*256*256 + \
rev_buf[22]*256 + \
rev_buf[23] ) );
printf("-------------------------------------\n");
}
else
{
printf("ack failed!\n");
}
printf("\n");
}
break;
// get data/time
case 2:
// send cmd 0x38
// send cmd
send_buf[5] = 0x38;
// send length
send_buf[6] = 0x00;
send_buf[7] = 0x00;
// send_crc
send_crc = cal_crc(send_buf, 8, -1);
send_buf[8] = (uint8)(send_crc & 0xFF);
send_buf[9] = (uint8)(send_crc >> 8);
// send and rev data
// send data
send_len = write(fd, send_buf, 10);
printf("send len: %d\n", send_len);
sleep(3);
// receive data
if((rev_len = read(fd, rev_buf, 512))==-1)
{
printf("read error!\n");
}
else
{
printf("rev len: %d\n", rev_len);
rev_crc = (rev_buf[rev_len-1]*256 + rev_buf[rev_len-2]);
tmp_crc = cal_crc(rev_buf, (rev_len - 2), -1);
if (rev_crc==tmp_crc && rev_buf[6]==0)
{
printf("ack successful!\n");
printf("ack information, as follows:\n");
printf("-------------------------------------\n");
// date/time
printf(" date/time: 20%d/%02d/%02d \n %02d:%02d:%02d\n", \
rev_buf[9] , rev_buf[10], rev_buf[11], \
rev_buf[12], rev_buf[13], rev_buf[14]);
printf("-------------------------------------\n");
}
else
{
printf("ack failed!\n");
}
printf("\n");
}
break;
// get device net info
case 3:
// send cmd 0x3a
// send cmd
send_buf[5] = 0x3a;
// send length
send_buf[6] = 0x00;
send_buf[7] = 0x00;
// send_crc
send_crc = cal_crc(send_buf, 8, -1);
send_buf[8] = (uint8)(send_crc & 0xFF);
send_buf[9] = (uint8)(send_crc >> 8);
// send and rev data
// send data
send_len = write(fd, send_buf, 10);
printf("send len: %d\n", send_len);
sleep(3);
// receive data
if((rev_len=read(fd, rev_tmp, 512)) == -1)
{
printf("read error!\n");
}
else
{
printf("rev len: %d\n", rev_len);
rev_crc = (rev_tmp[rev_len-1]*256 + rev_tmp[rev_len-2]);
tmp_crc = cal_crc(rev_tmp, (rev_len-2), -1);
if (rev_crc==tmp_crc && rev_buf[6]==0)
{
printf("ack successful!\n");
printf("ack information, as follows:\n");
printf("-------------------------------------\n");
// ip addr
printf(" ip: %d.%d.%d.%d\n", \
rev_tmp[9] ,rev_tmp[10], \
rev_tmp[11], rev_tmp[12]);
// network mask
printf("network mask: %d.%d.%d.%d\n", \
rev_tmp[13] ,rev_tmp[14], \
rev_tmp[15], rev_tmp[16]);
// mac addr
printf(" mac: %02x:%02x:%02x:%02x:%02x:%02x\n", \
rev_tmp[17] ,rev_tmp[18], rev_tmp[19],\
rev_tmp[20], rev_tmp[21], rev_tmp[22]);
// gateway
printf(" gateway: %d.%d.%d.%d\n", \
rev_tmp[23] ,rev_tmp[24], \
rev_tmp[25], rev_tmp[26]);
// server addr
printf(" server: %d.%d.%d.%d\n", \
rev_tmp[27] ,rev_tmp[28], \
rev_tmp[29], rev_tmp[30]);
// limit
printf(" limit: %d\n", rev_tmp[31]);
// port
printf(" port: %d\n", rev_tmp[32]*256 + rev_tmp[33]);
// mode
printf(" mode: %d\n", rev_tmp[34]);
// dhcp
printf(" dhcp: %d\n", rev_tmp[35]);
printf("-------------------------------------\n");
}
else
{
printf("ack failed!\n");
}
printf("\n");
}
break;
// get person info.
case 4:
// send cmd 0x42
// send cmd
send_buf[5] = 0x42;
// send length
send_buf[6] = 0x00;
send_buf[7] = 0x02;
// data
send_buf[8] = 0x01;
send_buf[9] = 0x0c;
// send_crc
send_crc = cal_crc(send_buf, 10, -1);
send_buf[10] = (uint8)(send_crc & 0xFF);
send_buf[11] = (uint8)(send_crc >> 8);
// send and rev data
// send data
send_len = write(fd, send_buf, 12);
printf("send len: %d\n", send_len);
sleep(1);
// receive data
if((rev_len=read(fd, rev_buf, 512)) == -1)
{
printf("read error!\n");
}
else
{
printf("rev len: %d\n", rev_len);
rev_crc = (rev_buf[rev_len-1]*256 + rev_buf[rev_len-2]);
tmp_crc = cal_crc(rev_buf, (rev_len-2), -1);
if (rev_crc==tmp_crc && rev_buf[6]==0)
{
printf("ack successful!\n");
printf("ack information, as follows:\n");
tmp_num = rev_buf[9];
printf("-------------------------------------\n");
printf("=====================\n");
for(i=0; i<tmp_num; i++)
{
// user no
printf(" user no: %d%d%d%d%d\n", \
rev_buf[i*27+10], rev_buf[i*27+11], \
rev_buf[i*27+12], rev_buf[i*27+13], \
rev_buf[i*27+14] );
// passwd
if((rev_buf[i*27+16]*256 + rev_buf[i*27+17]) != 0)
{
printf(" passwd: \n");
}
else
{
printf(" passwd: %d\n", (rev_buf[i*27+16]*256 + \
rev_buf[i*27+17]) );
}
// card no
printf(" card no: %d\n", (rev_buf[i*27+18]*256*256 + \
rev_buf[i*27+19]*256 + rev_buf[i*27+20]));
// name
strncpy(user_name, &rev_buf[i*27+21], 10);
user_name[10] = '\0';
printf(" name: %s\n", user_name);
// dept
printf(" dept: %d\n", rev_buf[i*27+30]);
// group
printf(" group: %d\n", rev_buf[i*27+31]);
// mode
printf(" mode: %d\n", rev_buf[i*27+32]);
printf("=====================\n");
}
printf("-------------------------------------\n");
}
else
{
printf("ack failed!\n");
}
printf("\n");
}
break;
// get records
case 5:
// send cmd 0x40
// send cmd
send_buf[5] = 0x40;
// send length
send_buf[6] = 0x00;
send_buf[7] = 0x02;
// data
send_buf[8] = 0x01;
send_buf[9] = 0x19;
// send_crc
send_crc = cal_crc(send_buf, 10, -1);
send_buf[10] = (uint8)(send_crc & 0xFF);
send_buf[11] = (uint8)(send_crc >> 8);
// send and rev data
// send data
send_len = write(fd, send_buf, 12);
printf("send len: %d\n", send_len);
sleep(1);
// receive data
if((rev_len=read(fd, rev_buf, 512)) == -1)
{
printf("read error!\n");
}
else
{
printf("rev len: %d\n", rev_len);
rev_crc = (rev_buf[rev_len-1]*256 + rev_buf[rev_len-2]);
tmp_crc = cal_crc(rev_buf, (rev_len-2), -1);
if (rev_crc==tmp_crc && rev_buf[6]==0)
{
printf("ack successful!\n");
printf("ack information, as follows:\n");
tmp_num = rev_buf[9];
printf("-------------------------------------\n");
printf("=====================\n");
for(i=0; i<tmp_num; i++)
{
printf(" %d\n", i+1);
// user no
printf(" user no: %d%d%d%d%d\n", \
rev_buf[i*14+10], rev_buf[i*14+11],\
rev_buf[i*14+12], rev_buf[i*14+13], \
rev_buf[i*14+14] );
// date/time
seconds = rev_buf[i*14+15]*256*256*256 + \
rev_buf[i*14+16]*256*256 + \
rev_buf[i*14+17]*256 + \
rev_buf[i*14+18];
printf(" date/time: %d/%02d/%02d \n %02d:%02d:%02d\n",\
gmtime(&seconds)->tm_year+1930, gmtime(&seconds)->tm_mon+1, \
gmtime(&seconds)->tm_mday+1, gmtime(&seconds)->tm_hour, \
gmtime(&seconds)->tm_min, gmtime(&seconds)->tm_sec);
// bac no
printf(" bac no: %d\n", rev_buf[i*14+19]);
// record type
printf("record type: %d\n", rev_buf[i*14+20]);
printf("=====================\n");
}
printf("-------------------------------------\n");
}
else
{
printf("ack failed!\n");
}
printf("\n");
}
break;
// get fp template
case 6:
// send cmd 0x44
// send cmd
send_buf[5] = 0x44;
// send length
send_buf[6] = 0x00;
send_buf[7] = 0x06;
// data
send_buf[8] = 0x00;
send_buf[9] = 0x00;
send_buf[10] = 0x00;
send_buf[11] = 0x00;
send_buf[12] = 0x01;
send_buf[13] = 0x01;
// send_crc
send_crc = cal_crc(send_buf, 14, -1);
send_buf[14] = (uint8)(send_crc & 0xFF);
send_buf[15] = (uint8)(send_crc >> 8);
// send and rev data
// send data
send_len = write(fd, send_buf, 16);
printf("send len: %d\n", send_len);
sleep(2);
// receive data
if((rev_len=read(fd, rev_buf, 512)) == -1)
{
printf("read error!\n");
}
else
{
printf("rev len: %d\n", rev_len);
rev_crc = (rev_buf[rev_len-1]*256 + rev_buf[rev_len-2]);
tmp_crc = cal_crc(rev_buf, (rev_len-2), -1);
if (rev_crc==tmp_crc && rev_buf[6]==0)
{
printf("ack successful!\n");
printf("ack information, as follows:\n");
printf("-------------------------------------\n");
fp = fopen("template/1_1.anv", "wb");
printf(" writing fp template ..\n");
fwrite(&rev_buf[9], 1, 338, fp);
fclose(fp);
printf("-------------------------------------\n");
}
else
{
printf("ack failed!\n");
}
printf("\n");
}
break;
default:
printf("error num!\n");
break;
}
}
close(fd);
return 0;
}
good luck!
~_~
浙公网安备 33010602011771号