//--------------------------------------------------------------------- #include /*标准输入输出定义*/ #include /*标准函数库定义*/ #include #include /*Unix 标准函数定义*/ #include #include #include /*文件控制定义*/ #include /*PPSIX 终端控制定义*/ #include /*错误号定义*/ //--------------------------------------------------------------------- #include "rs485_driver.h" //--------------------------------------------------------------------- const unsigned char auchCRCHi[] = { 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40 }; const unsigned char auchCRCLo[] = { 0x00, 0xC0, 0xC1, 0x01, 0xC3, 0x03, 0x02, 0xC2, 0xC6, 0x06, 0x07, 0xC7, 0x05, 0xC5, 0xC4, 0x04, 0xCC, 0x0C, 0x0D, 0xCD, 0x0F, 0xCF, 0xCE, 0x0E, 0x0A, 0xCA, 0xCB, 0x0B, 0xC9, 0x09, 0x08, 0xC8, 0xD8, 0x18, 0x19, 0xD9, 0x1B, 0xDB, 0xDA, 0x1A, 0x1E, 0xDE, 0xDF, 0x1F, 0xDD, 0x1D, 0x1C, 0xDC, 0x14, 0xD4, 0xD5, 0x15, 0xD7, 0x17, 0x16, 0xD6, 0xD2, 0x12, 0x13, 0xD3, 0x11, 0xD1, 0xD0, 0x10, 0xF0, 0x30, 0x31, 0xF1, 0x33, 0xF3, 0xF2, 0x32, 0x36, 0xF6, 0xF7, 0x37, 0xF5, 0x35, 0x34, 0xF4, 0x3C, 0xFC, 0xFD, 0x3D, 0xFF, 0x3F, 0x3E, 0xFE, 0xFA, 0x3A, 0x3B, 0xFB, 0x39, 0xF9, 0xF8, 0x38, 0x28, 0xE8, 0xE9, 0x29, 0xEB, 0x2B, 0x2A, 0xEA, 0xEE, 0x2E, 0x2F, 0xEF, 0x2D, 0xED, 0xEC, 0x2C, 0xE4, 0x24, 0x25, 0xE5, 0x27, 0xE7, 0xE6, 0x26, 0x22, 0xE2, 0xE3, 0x23, 0xE1, 0x21, 0x20, 0xE0, 0xA0, 0x60, 0x61, 0xA1, 0x63, 0xA3, 0xA2, 0x62, 0x66, 0xA6, 0xA7, 0x67, 0xA5, 0x65, 0x64, 0xA4, 0x6C, 0xAC, 0xAD, 0x6D, 0xAF, 0x6F, 0x6E, 0xAE, 0xAA, 0x6A, 0x6B, 0xAB, 0x69, 0xA9, 0xA8, 0x68, 0x78, 0xB8, 0xB9, 0x79, 0xBB, 0x7B, 0x7A, 0xBA, 0xBE, 0x7E, 0x7F, 0xBF, 0x7D, 0xBD, 0xBC, 0x7C, 0xB4, 0x74, 0x75, 0xB5, 0x77, 0xB7, 0xB6, 0x76, 0x72, 0xB2, 0xB3, 0x73, 0xB1, 0x71, 0x70, 0xB0, 0x50, 0x90, 0x91, 0x51, 0x93, 0x53, 0x52, 0x92, 0x96, 0x56, 0x57, 0x97, 0x55, 0x95, 0x94, 0x54, 0x9C, 0x5C, 0x5D, 0x9D, 0x5F, 0x9F, 0x9E, 0x5E, 0x5A, 0x9A, 0x9B, 0x5B, 0x99, 0x59, 0x58, 0x98, 0x88, 0x48, 0x49, 0x89, 0x4B, 0x8B, 0x8A, 0x4A, 0x4E, 0x8E, 0x8F, 0x4F, 0x8D, 0x4D, 0x4C, 0x8C, 0x44, 0x84, 0x85, 0x45, 0x87, 0x47, 0x46, 0x86, 0x82, 0x42, 0x43, 0x83, 0x41, 0x81, 0x80, 0x40 }; static QMutex rs485_mutex; //--------------------------------------------------------------------- RS485Driver::RS485Driver(const char *dev) { RS485_RUN_EN = false; MonomerNum = 24; CommTick = 0; if (-1 == this->OpenDev(dev)) qDebug("Can't Open %s\n", dev); else qDebug("Open %s OK!\n", dev); this->SetDevAttr(9600, 8,1,'N'); } RS485Driver::~RS485Driver() { qDebug("Close rs485 OK!\n"); RS485_RUN_EN = false; quit(); wait(); } void RS485Driver::SetMonomerNum(const quint16 num) { MonomerNum = num; } int RS485Driver::GetCommTick(void) { return CommTick; } void RS485Driver::IncCommTick(void) { CommTick++; } //--------------------------------------------------------------------- //--------------------------------------------------------------------- /** *@brief 设置串口通信速率 *@param fd 类型 int 打开串口的文件句柄 *@param speed 类型 int 串口速度 *@return void */ //--------------------------------------------------------------------- //--------------------------------------------------------------------- int speed_arr[] = { B115200, B57600, B38400, B19200, B9600}; int name_arr[] = { 115200, 57600, 38400, 19200, 9600}; void RS485Driver::set_speed(int fd, int speed) { int status; struct termios Opt; tcgetattr(fd, &Opt); for ( unsigned int 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); } } } //--------------------------------------------------------------------- /** *@brief 设置串口数据位，停止位和效验位 *@param fd 类型 int 打开的串口文件句柄 *@param databits 类型 int 数据位 取值 为 7 或者8 *@param stopbits 类型 int 停止位 取值为 1 或者2 *@param parity 类型 int 效验类型 取值为N,E,O,,S */ //--------------------------------------------------------------------- int RS485Driver::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_iflag = 0; options.c_oflag = 0; //------------------------------------------------------ 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; /* 0.1S */ options.c_cc[VMIN] = 0; /* Update the options and do it NOW */ if (tcsetattr(fd,TCSANOW,&options) != 0) { perror("SetupSerial 3"); return (-1); } return (0); } //--------------------------------------------------------------------- int RS485Driver::OpenDev(const char *Dev) { FD = open(Dev, O_RDWR|O_NOCTTY|O_NDELAY); return FD; } //--------------------------------------------------------------------- void RS485Driver::SetDevAttr(int bitrate, char bitlen, char stopbitlen, char checktype) { if(FD < 0) return; set_speed(FD, bitrate); if(set_Parity(FD, bitlen, stopbitlen, checktype) < 0) { qDebug("Set Parity Error\n"); } if(fcntl(FD, F_SETFL, FNDELAY) < 0)//非阻塞，覆盖前面open的属性 { qDebug("fcntl failed\n"); } } //--------------------------------------------------------------------- int RS485Driver::WriteDev(void *buf, int len) { if(FD < 0) return 0; return write(FD, (char *)buf, len); } //--------------------------------------------------------------------- int RS485Driver::ReadDev(void *buf, int len) { if(FD < 0) return 0; char *pbuff = (char *)buf; return (read(FD, pbuff, len)); } //--------------------------------------------------------------------- unsigned short RS485Driver::CalModbusCRC16(void *puchMsg, unsigned short usDataLen) { unsigned char *pdata = (unsigned char *)puchMsg; unsigned short uchCRCHi = 0xFF; unsigned short uchCRCLo = 0xFF; unsigned int uIndex ; while (usDataLen--) { uIndex = uchCRCHi ^ *pdata++ ; uchCRCHi = uchCRCLo ^ auchCRCHi[uIndex]; uchCRCLo = auchCRCLo[uIndex]; } return (uchCRCLo | uchCRCHi<< 8); //((uchCRCLo << 8) | uchCRCHi); } //--------------------------------------------------------------------- //--------------------------------------------------------------------- //--------------------------------------------------------------------- int RS485Driver::ReadFromIOModule( const quint8 device_addr,const quint16 data_addr, const quint16 read_data_num, void *read_data_buf) { int res = CommOK; quint8 txData[16] = {0}; quint8 rxData[264] = {0}; rs485_mutex.lock(); txData[0] = device_addr; txData[1] = FUNC_CODE_READ; txData[2] = data_addr/256; txData[3] = data_addr%256; txData[4] = read_data_num/256; txData[5] = read_data_num%256; unsigned short crc = CalModbusCRC16(txData,6); txData[6] = (quint8)(crc>>8); txData[7] = (quint8)crc; struct timeval tv; fd_set rfds; int timeout = 0; const quint16 tx_data_len = 8; quint16 rx_data_len = 0; for(quint8 t = 0;t<3;t++) //retry 3 times { res = CommOK; //flush rx buffer char tmp[64] = {0}; while(1) { int len = ReadDev(tmp, 64); if(len > 0) continue; else break; } if(tx_data_len != WriteDev(txData, tx_data_len)) res = CommTxError; rx_data_len = read_data_num*2+5; if(rx_data_len>264) rx_data_len = 264; timeout = rx_data_len*1000+200000; if(timeout > 400000) timeout = 400000; if(CommOK == res) { tv.tv_sec = 0; tv.tv_usec = timeout; FD_ZERO(&rfds); FD_SET( FD,&rfds ); int sres = select(FD+1,&rfds,NULL,NULL,&tv); //block wait if(sres > 0) { if(rx_data_len != ReadDev(rxData, rx_data_len)) { res = CommRxError; } } else { res = CommRxError; } } if(CommOK == res) { crc = rxData[rx_data_len-2]; crc = (crc<<8) + rxData[rx_data_len-1]; if(crc == CalModbusCRC16(rxData, rx_data_len-2)) { if(NULL != read_data_buf) { quint8 *pRecvData = (quint8 *)read_data_buf; for (quint8 i = 3; i48) wrdatanum = 48; quint16 lenth = 0; txData[lenth++] = device_addr; txData[lenth++] = FUNC_CODE_MULTY_WRITE; //多点写 txData[lenth++] = data_addr/256; txData[lenth++] = data_addr%256; txData[lenth++] = wrdatanum/256; txData[lenth++] = wrdatanum%256; txData[lenth++] = wrdatanum*2; for(int i=0;i>8); txData[lenth++] = (quint8)crc; struct timeval tv; fd_set rfds; const quint16 rx_data_len = 8; quint16 rx_data = 0; for(quint8 t = 0;t<3;t++) { res = CommOK; char tmp[64] = {0}; while(1) { int len = ReadDev(tmp, 64); if(len > 0) continue; else break; } if(lenth != WriteDev(txData, lenth)) res = CommTxError; if(CommOK == res) { tv.tv_sec = 0; tv.tv_usec = 300000; FD_ZERO(&rfds); FD_SET( FD,&rfds ); int sres = select(FD+1,&rfds,NULL,NULL,&tv); if(sres > 0) { if(rx_data_len != ReadDev(rxData, rx_data_len)) { res = CommRxError; } } else res = CommRxError; } if(CommOK == res) { crc = rxData[rx_data_len-2]; crc = (crc<<8) + rxData[rx_data_len-1]; if(crc == CalModbusCRC16(rxData, rx_data_len-2)) { rx_data = (quint16)(rxData[4]<<8)+rxData[5]; if(0 == rx_data) //pass==1 res = CommWrFailError; } else { res = CommDataError; } } msleep(20); if(CommOK == res) break; else { msleep(200); //qDebug("MultiWrite Error,ErrorCode = %d",res); } } rs485_mutex.unlock(); return res; } //--------------------------------------------------------------------- int RS485Driver::SingleWriteIOModule( const quint8 device_addr,const quint16 data_addr, const quint16 wr_data, const quint16 timeout_ms) { int res = CommOK; quint8 txData[16] = {0}; quint8 rxData[16] = {0}; rs485_mutex.lock(); txData[0] = device_addr; txData[1] = FUNC_CODE_SINGLE_WRITE; txData[2] = data_addr/256; txData[3] = data_addr%256; txData[4] = wr_data/256; txData[5] = wr_data%256; unsigned short crc = CalModbusCRC16(txData,6); txData[6] = (quint8)(crc>>8); txData[7] = (quint8)crc; struct timeval tv; fd_set rfds; const quint16 rx_data_len = 8; const quint16 tx_data_len = 8; quint16 rx_data = 0; for(quint8 t = 0;t<3;t++) { res = CommOK; char tmp[64] = {0}; while(1) { int len = ReadDev(tmp, 64); if(len > 0) continue; else break; } for(quint8 i=0;i 0) { if(rx_data_len != ReadDev(rxData, rx_data_len)) { res = CommRxError; } } else res = CommRxError; } if(CommOK == res) { crc = rxData[rx_data_len-2]; crc = (crc<<8) + rxData[rx_data_len-1]; if(crc == CalModbusCRC16(rxData, rx_data_len-2)) { rx_data = (quint16)(rxData[4]<<8)+rxData[5]; if(0 == rx_data) //pass==1 res = CommWrFailError; } else { res = CommDataError; } } msleep(20); if(CommOK == res) break; else { //qDebug("SingleWrite Error,ErrorCode = %d",res); msleep(200); } } rs485_mutex.unlock(); return res; } //--------------------------------------------------------------------- void RS485Driver::run() { RS485_RUN_EN = true; if(FD < 0) RS485_RUN_EN = false; quint16 databuff[32] = {0}; COMM_DATA commData; quint16 ctrl_index = 0; quint16 commerror_count = 0; quint16 mindex = 0; IF_MONCLEAR = 0; moncount = 0; memset(&commData,0x00,sizeof(commData)); // int j=0; while(true == RS485_RUN_EN) { if (CommOK == ReadFromIOModule(DeviceAddr,RegAddr_SoftVersion, 21, databuff)) { commerror_count = 0; quint16 tmpdata = 0; for(int i=0;i<21;i++) { tmpdata = databuff[i]; databuff[i] = Swap16(tmpdata); } memcpy(&commData.SoftVersion,databuff,21*sizeof(quint16)); } else commerror_count++; msleep(200); if (CommOK == ReadFromIOModule(DeviceAddr,RegAddr_SetRUN_State, 1, databuff)) { quint16 tmpdata = 0; tmpdata = databuff[0]; commData.Work_State = Swap16(tmpdata); } msleep(200); if(ctrl_index++%3 == 1) { if (CommOK == ReadFromIOModule(DeviceAddr,RegAddr_ReadDCDC1Alarm, 20, databuff)) { commerror_count = 0; for(int i=0;i<20;i++) { commData.DCDCdata[i] = Swap16(databuff[i]); } } else commerror_count++; } if(ctrl_index++%3 == 0 && mon_use_type == 0) { //qDebug("mindex = %d",mindex); if (CommOK == ReadFromIOModule(DeviceAddr,RegAddr_Monomer+mindex*24, 24, databuff)) { //qDebug("RegAddr_Monomer+mindex*24 = %d",RegAddr_Monomer+mindex*24); commerror_count = 0; for(int i=0;i<24;i++) { commData.MonomerVol[i+mindex*24] = Swap16(databuff[i]); //if(commData.MonomerVol[i+mindex*24] != 0) // qDebug("MonomerVol[%d] = %d",i+mindex*24,commData.MonomerVol[i+mindex*24]); } } else commerror_count++; if((24+mindex*24) < MonomerNum) { mindex++; } else mindex = 0; } if(commerror_count >= 6) { memset(&commData, 0x00, sizeof(commData)); commData.RLY_OK |= R_OK_INIT; } if(( IF_MONCLEAR == 1)&&(moncount<3)) { moncount++; memset(&commData.MonomerVol[0], 0x00, MONOMER_NUM_MAX); } else { IF_MONCLEAR = 0; moncount = 0; } // j++; // commData.SoftVersion = 1; // commData.OnlineVol = 411+j; // commData.GroupVol = 411+j; // commData.InnerCurrVal = 201+j; // for(int i=0;i<300;i++) // commData.MonomerVol[i] = 2000+i*2+j*3; emit SendCommData(commData); msleep(200); CommTick = 0; } } //--------------------------------------------------------------------- //---------------------------------------------------------------------