ppi.zip_I Can Read_S7 PPI_s7-200_same1uu_siemens s7-200

#include <stdio.h> #include <stdlib.h> #include <errno.h> #include <termios.h> #include <string.h> #include <ctype.h> #include <fcntl.h> #include <unistd.h> #include <netdb.h> #include <sys/types.h> #include <netinet/in.h> #include <sys/socket.h> #include <arpa/inet.h> #include <netinet/if_ether.h> #include <linux/sockios.h> #include <sys/ioctl.h> #include <net/if.h> #include <linux/ioctl.h> #include <linux/watchdog.h> #include <signal.h> #include <mysql.h> #define FALSE -1 #define TRUE 0 #define uint16_t (unsigned short int) #define uint32_t (unsigned int) int wd,fd; MYSQL mysql; MYSQL_RES *res = NULL; MYSQL_ROW row; MYSQL_FIELD *fieldname= NULL; char query_str[1024],ins_str[1024],mymac[20],myip[30]; char my485[] = "/dev/ttyO2"; int plc_no =3; //slave is number 3 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, }; /* unsigned char req_vb[] = {0x68,0x1B,0x1B,0x68,0x2,0x0,0x6C, 0x32,0x1,0x0,0x0,0x0,0x0,0x0, 0xE,0x0,0x0,0x4,0x1,0x12,0xA,0x10,0x2,0x0,0x14,0x0,0x1,0x84,0x0,0x0,0x0,0x7b,0x16}; */ unsigned char req_vw2[] = {0x68,0x1B,0x1B,0x68,0x2,0x0,0x6C, 0x32,0x1,0x0,0x0,0x0,0x0,0x0, 0xE,0x0,0x0,0x4,0x1,0x12,0xA,0x10,0x4,0x0,0x7,0x0,0x1,0x84,0x0,0x0,0x0,0x70,0x16}; unsigned char req_vd6[] = {0x68,0x1B,0x1B,0x68,0x2,0x0,0x6C, 0x32,0x1,0x0,0x0,0x0,0x0,0x0, 0xE,0x0,0x0,0x4,0x1,0x12,0xA,0x10,0x6,0x0,0x2,0x0,0x1,0x84,0x0,0x0,0x30,0x9d,0x16}; unsigned char req_vd10[] = {0x68,0x1B,0x1B,0x68,0x2,0x0,0x6C, 0x32,0x1,0x0,0x0,0x0,0x0,0x0, 0xE,0x0,0x0,0x4,0x1,0x12,0xA,0x10,0x6,0x0,0x2,0x0,0x1,0x84,0x0,0x00,0x50,0xbd,0x16}; unsigned char req_vd14[] = {0x68,0x1B,0x1B,0x68,0x2,0x0,0x6C, 0x32,0x1,0x0,0x0,0x0,0x0,0x0, 0xE,0x0,0x0,0x4,0x1,0x12,0xA,0x10,0x6,0x0,0x2,0x0,0x1,0x84,0x0,0x0,0x70,0xdd,0x16}; unsigned char ack_ppi[] = {0x10,2,0,0x5C,0x5E,0x16}; float vd2f(unsigned char *src) { float f; unsigned int i; i = ntohl((unsigned int)(src[1]*16777216+src[0]*65536+src[3]*256+src[2])); // i= src[2]*16777216+src[3]*65536+src[0]*256+src[1]; memcpy(&f, &i, sizeof(float)); return f; } 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); } } } 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; 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; options.c_iflag &= ~INPCK; break; case 'o': case 'O': options.c_cflag |= (PARODD | PARENB); options.c_iflag |= INPCK; break; case 'e': case 'E': options.c_cflag |= PARENB; options.c_cflag &= ~PARODD; options.c_iflag |= INPCK; break; case 'S': case 's': options.c_cflag &= ~PARENB; options.c_cflag &= ~CSTOPB; break; default: fprintf(stderr,"Unsupported parity\n"); return (FALSE); } 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); } options.c_iflag &= ~(IGNBRK|BRKINT|PARMRK|ISTRIP|INLCR|IGNCR|ICRNL|IXON); options.c_oflag &= ~OPOST; options.c_lflag &= ~(ECHO|ECHONL|ICANON|ISIG|IEXTEN); /* Set input parity option */ if (parity != 'n') options.c_iflag |= INPCK; options.c_cc[VTIME] = 150; // 15 seconds options.c_cc[VMIN] = 0; tcflush(fd,TCIFLUSH); /* Update the options and do it NOW */ if (tcsetattr(fd,TCSANOW,&options) != 0) { perror("SetupSerial 3"); return (FALSE); } return (TRUE); } unsigned char checksum(char *reqstr,int count) { int i=0,j,sum=0; while(i<5){if(reqstr[i]==0x68) break;i++;} for(j=i;j<count;j++) { sum+=(unsigned char)reqstr[j]; //printf("j=%d,%x ,sum %2x\n",j,reqstr[j],sum); } return (sum &0xff); } int readvb(int start,int len,unsigned char *myvb) { int x; unsigned char blk[512]; unsigned char req_str[] = {0x68,0x1B,0x1B,0x68,0x2,0x0,0x6C, 0x32,0x1,0x0,0x0,0x0,0x0,0x0, 0xE,0x0,0x0,0x4,0x1,0x12,0xA,0x10,0x2,0x0,0x12,0x0,0x1,0x84,0x0,0x0,0x0,0x7b,0x16}; req_str[22]=0x02; //vb:02 VW:04 VD:06... req_str[24]=len; //number of data req_str[29]=((start *8)>>8) & 0xff; //offset high req_str[30]=(start*8)&0xff; //offset low, number of bytes from 0 * 8 int checksum=0; for(x=4;x<=30;x++) checksum+=req_str[x]; req_str[31]=checksum & 0xFF; //for(x=0;x<33;x++) printf(" %02X",req_str[x]&0xff);printf("\n"); //printf(" 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2\n"); ////////// ready ///////////// int n = write(fd,req_str,33); //send req pack to PLC // printf("VBreq:%02d\n",n); usleep(1000*100); int nread = read(fd, blk, 1); if(nread<=0) { printf("error\n");return -1; } if ((unsigned char)blk[0]==0xE5) // E5 PLC confirm got req pack { n = write(fd,ack_ppi,6); // make suree do request command ... // printf("REQ has RECV, %02d\n",n); } // usleep(1000*100); //wait more if get more data int hasread=0; while(hasread<27+len) { nread = read(fd, blk+hasread, 1); if(nread<=0) { printf("error\n");break; } hasread+=nread; } // for( x=0;x<hasread;x++) myvb[x]=blk[x]; // printf("%d==",hasread); // printf(" 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 \n"); // for(ix=0;x<hasread;x++) printf("%02X ",blk[x]&0xff);printf("\n"); if ((blk[19]==04)&&(blk[20]==01)&&(blk[21]==0xff)&&(blk[22]==04)) for( x=25;x<hasread-2;x++) {myvb[x-25]=blk[x];} usleep(1000*200); //wait more if get more data /* unsigned char F[4]; F[0]=(unsigned char)blk[33]; F[1]=(unsigned char)blk[34]; F[2]=(unsigned char)blk[35]; F[3]=(unsigned char)blk[36]; printf("+++++++%02x %02x %02x %02x +++++++++++%f++++++++++++++++\n",F[0],F[1],F[2],F[3],vd2f((unsigned char*)F)); */ } int readvw(int start,int len,unsigned char *myvw) { int x; unsigned char blk[512]; //////////////////////////////////////////////////////////////////////////////////////////////// unsigned char req_str[] = {0x68,0x1B,0x1B,0x68,0x2,0x0,0x6C, 0x32,0x1,0x0,0x0,0x0,0x0,0x0, 0xE,0x0,0x0,0x4,0x1,0x12,0xA,0x10,0x2,0x0,0x12,0x0,0x1,0x84,0x0,0x0,0x0,0x7b,0x16}; req_str[22]=0x04; //vb:02 VW:04 VDW:06... req_str[24]=len; //number of data req_str[29]=((start *8)>>8) & 0xff; //offset high req_str[30]=(start*8)&0xff; //offset low, number of bytes from 0 * 8 int checksum=0; for( x=4;x<=30;x++) checksum+=req_str[x]; req_str[31]=checksum & 0xFF; //for( x=0;x<33;x++) printf("%02X ",req_str[x]&0xff);printf("\n"); ////////// ready ///////////// int n = write(fd,req_str,33); //send req pack to PLC // printf("VWreq:%02d\n",n); usleep(1000*100); int nread = read(fd, blk, 1); if(nread<=0) { print