#include "mmodbus.h" #include "usart.h" #include "timer.h" #include "log.h" #include "gateway_message.h" #include "tcp_server.h" MModBus_t mmodbus; // ##################################################################################################### #if (_MMODBUS_RTU == 1) static const uint16_t wCRCTable[] = { 0X0000, 0XC0C1, 0XC181, 0X0140, 0XC301, 0X03C0, 0X0280, 0XC241, 0XC601, 0X06C0, 0X0780, 0XC741, 0X0500, 0XC5C1, 0XC481, 0X0440, 0XCC01, 0X0CC0, 0X0D80, 0XCD41, 0X0F00, 0XCFC1, 0XCE81, 0X0E40, 0X0A00, 0XCAC1, 0XCB81, 0X0B40, 0XC901, 0X09C0, 0X0880, 0XC841, 0XD801, 0X18C0, 0X1980, 0XD941, 0X1B00, 0XDBC1, 0XDA81, 0X1A40, 0X1E00, 0XDEC1, 0XDF81, 0X1F40, 0XDD01, 0X1DC0, 0X1C80, 0XDC41, 0X1400, 0XD4C1, 0XD581, 0X1540, 0XD701, 0X17C0, 0X1680, 0XD641, 0XD201, 0X12C0, 0X1380, 0XD341, 0X1100, 0XD1C1, 0XD081, 0X1040, 0XF001, 0X30C0, 0X3180, 0XF141, 0X3300, 0XF3C1, 0XF281, 0X3240, 0X3600, 0XF6C1, 0XF781, 0X3740, 0XF501, 0X35C0, 0X3480, 0XF441, 0X3C00, 0XFCC1, 0XFD81, 0X3D40, 0XFF01, 0X3FC0, 0X3E80, 0XFE41, 0XFA01, 0X3AC0, 0X3B80, 0XFB41, 0X3900, 0XF9C1, 0XF881, 0X3840, 0X2800, 0XE8C1, 0XE981, 0X2940, 0XEB01, 0X2BC0, 0X2A80, 0XEA41, 0XEE01, 0X2EC0, 0X2F80, 0XEF41, 0X2D00, 0XEDC1, 0XEC81, 0X2C40, 0XE401, 0X24C0, 0X2580, 0XE541, 0X2700, 0XE7C1, 0XE681, 0X2640, 0X2200, 0XE2C1, 0XE381, 0X2340, 0XE101, 0X21C0, 0X2080, 0XE041, 0XA001, 0X60C0, 0X6180, 0XA141, 0X6300, 0XA3C1, 0XA281, 0X6240, 0X6600, 0XA6C1, 0XA781, 0X6740, 0XA501, 0X65C0, 0X6480, 0XA441, 0X6C00, 0XACC1, 0XAD81, 0X6D40, 0XAF01, 0X6FC0, 0X6E80, 0XAE41, 0XAA01, 0X6AC0, 0X6B80, 0XAB41, 0X6900, 0XA9C1, 0XA881, 0X6840, 0X7800, 0XB8C1, 0XB981, 0X7940, 0XBB01, 0X7BC0, 0X7A80, 0XBA41, 0XBE01, 0X7EC0, 0X7F80, 0XBF41, 0X7D00, 0XBDC1, 0XBC81, 0X7C40, 0XB401, 0X74C0, 0X7580, 0XB541, 0X7700, 0XB7C1, 0XB681, 0X7640, 0X7200, 0XB2C1, 0XB381, 0X7340, 0XB101, 0X71C0, 0X7080, 0XB041, 0X5000, 0X90C1, 0X9181, 0X5140, 0X9301, 0X53C0, 0X5280, 0X9241, 0X9601, 0X56C0, 0X5780, 0X9741, 0X5500, 0X95C1, 0X9481, 0X5440, 0X9C01, 0X5CC0, 0X5D80, 0X9D41, 0X5F00, 0X9FC1, 0X9E81, 0X5E40, 0X5A00, 0X9AC1, 0X9B81, 0X5B40, 0X9901, 0X59C0, 0X5880, 0X9841, 0X8801, 0X48C0, 0X4980, 0X8941, 0X4B00, 0X8BC1, 0X8A81, 0X4A40, 0X4E00, 0X8EC1, 0X8F81, 0X4F40, 0X8D01, 0X4DC0, 0X4C80, 0X8C41, 0X4400, 0X84C1, 0X8581, 0X4540, 0X8701, 0X47C0, 0X4680, 0X8641, 0X8201, 0X42C0, 0X4380, 0X8341, 0X4100, 0X81C1, 0X8081, 0X4040}; // crc校验 uint16_t mmodbus_crc16(const uint8_t *nData, uint16_t wLength) { uint8_t nTemp; uint16_t wCRCWord = 0xFFFF; while (wLength--) { nTemp = *nData++ ^ wCRCWord; wCRCWord >>= 8; wCRCWord ^= wCRCTable[nTemp]; } return wCRCWord; } #endif void mmodbus_callback(UART_HandleTypeDef *husart) { if(__HAL_UART_GET_FLAG(husart, UART_FLAG_RXNE) && __HAL_UART_GET_IT_SOURCE(husart, UART_IT_RXNE)) { if (mmodbus.rxIndex < _MMODBUS_RXSIZE - 1) { mmodbus.rxBuf[mmodbus.rxIndex] = husart->Instance->DR; mmodbus.rxIndex++; } else { uint8_t data = husart->Instance->DR; } } if ((mmodbus.rxIndex > 0) && RESET != __HAL_UART_GET_FLAG(husart, USART_FLAG_IDLE) && __HAL_UART_GET_IT_SOURCE(husart, UART_IT_IDLE)) { uint8_t i; mmodbus.done = 1; i = husart->Instance->SR; i = husart->Instance->DR; return; } mmodbus.rxTime = gettick(); } // ################################################################################################## uint16_t mmodbus_receiveRaw(uint32_t timeout) { uint32_t startTime = gettick(); while (1) { if (gettick() - startTime> timeout * 1000) return 0; if (mmodbus.done == 1) { return mmodbus.rxIndex; } mmodbus_delay(5); } } // ################################################################################################## bool mmodbus_sendRaw(uint8_t *data, uint16_t size, uint32_t timeout) { GATEWAY_PARAMS *get; get= get_gateway_config_params(); while(mmodbus.txBusy == 1) mmodbus_delay(1); mmodbus.txBusy = 1; memset(mmodbus.rxBuf, 0, _MMODBUS_RXSIZE); mmodbus.rxIndex = 0; mmodbus.done = 0; uint32_t startTime = gettick(); portENTER_CRITICAL(); if(get->comProtocol){ // get->protocol 1:232 0:485 USART_232_Send(data,size); }else{ USART_485_Send(data,size); } portEXIT_CRITICAL(); mmodbus.done=0; mmodbus.txBusy = 0; return true; } // ################################################################################################## bool mmodbus_init(uint32_t timeout) { // HAL_GPIO_WritePin(_MMODBUS_CTRL_GPIO, _MMODBUS_CTRL_PIN, GPIO_PIN_RESET); 此处初始化在485 init过 HAL_GPIO_WritePin(_MMODBUS_CTRL_GPIO, _MMODBUS_CTRL_PIN,GPIO_PIN_RESET); memset(&mmodbus, 0, sizeof(mmodbus)); mmodbus.timeout = timeout; return true; } // ################################################################################################## void mmodbus_set16bitOrder(MModBus_16bitOrder_t MModBus_16bitOrder_) { mmodbus.byteOrder16 = MModBus_16bitOrder_; } // ################################################################################################## void mmodbus_set32bitOrder(MModBus_32bitOrder_t MModBus_32bitOrder_) { mmodbus.byteOrder32 = MModBus_32bitOrder_; } // ################################################################################################## bool mmodbus_readCoil(uint8_t slaveAddress, uint16_t number, uint8_t *data) { return mmodbus_readCoils(slaveAddress, number, 1, data); } // ################################################################################################## // 读线圈 bool mmodbus_readCoils(uint8_t slaveAddress, uint16_t startnumber, uint16_t length, uint8_t *data) { #if (_MMODBUS_RTU == 1) uint8_t txData[8]; txData[0] = slaveAddress; txData[1] = MModbusCMD_ReadCoilStatus; txData[2] = (startnumber & 0xFF00) >> 8; txData[3] = (startnumber & 0x00FF); txData[4] = (length & 0xFF00) >> 8; txData[5] = (length & 0x00FF); static uint16_t crc; crc = mmodbus_crc16(txData, 6); txData[6] = (crc & 0x00FF); txData[7] = (crc & 0xFF00) >> 8; mmodbus_sendRaw(txData, 8, 100); uint16_t recLen = mmodbus_receiveRaw(mmodbus.timeout); if (recLen == 0) return false; if (mmodbus.rxBuf[0] != slaveAddress) return false; if (mmodbus.rxBuf[1] != MModbusCMD_ReadCoilStatus) return false; crc = mmodbus_crc16(mmodbus.rxBuf, mmodbus.rxBuf[2] + 3); if (((crc & 0x00FF) != mmodbus.rxBuf[mmodbus.rxBuf[2] + 3]) || (((crc & 0xFF00) >> 8) != mmodbus.rxBuf[mmodbus.rxBuf[2] + 4])) return false; if (data != NULL) memcpy(data, &mmodbus.rxBuf[3], mmodbus.rxBuf[2]); return true; #endif #if (_MMODBUS_ASCII == 1) #endif } // ################################################################################################## bool mmodbus_readDiscreteInput(uint8_t slaveAddress, uint16_t number, uint8_t *data) { return mmodbus_readDiscreteInputs(slaveAddress, number, 1, data); } // ################################################################################################## // 读取线圈功能码处理 bool mmodbus_readDiscreteInputs(uint8_t slaveAddress, uint16_t startnumber, uint16_t length, uint8_t *data) { #if (_MMODBUS_RTU == 1) uint8_t txData[8]; txData[0] = slaveAddress; txData[1] = MModbusCMD_ReadDiscreteInputs; txData[2] = (startnumber & 0xFF00) >> 8; txData[3] = (startnumber & 0x00FF); txData[4] = (length & 0xFF00) >> 8; txData[5] = (length & 0x00FF); static uint16_t crc; crc = mmodbus_crc16(txData, 6); txData[6] = (crc & 0x00FF); txData[7] = (crc & 0xFF00) >> 8; mmodbus_sendRaw(txData, 8, 100); uint16_t recLen = mmodbus_receiveRaw(mmodbus.timeout); if (recLen == 0) return false; if (mmodbus.rxBuf[0] != slaveAddress) return false; if (mmodbus.rxBuf[1] != MModbusCMD_ReadDiscreteInputs) return false; crc = mmodbus_crc16(mmodbus.rxBuf, mmodbus.rxBuf[2] + 3); if (((crc & 0x00FF) != mmodbus.rxBuf[mmodbus.rxBuf[2] + 3]) || (((crc & 0xFF00) >> 8) != mmodbus.rxBuf[mmodbus.rxBuf[2] + 4])) return false; if (data != NULL) memcpy(data, &mmodbus.rxBuf[3], mmodbus.rxBuf[2]); return true; #endif } // ################################################################################################## bool mmodbus_readInputRegisters8i(uint8_t slaveAddress, uint16_t startnumber, uint16_t length, uint8_t *data) { #if (_MMODBUS_RTU == 1) uint8_t txData[8]; txData[0] = slaveAddress; txData[1] = MModbusCMD_ReadInputRegisters; txData[2] = (startnumber & 0xFF00) >> 8; txData[3] = (startnumber & 0x00FF); txData[4] = (length & 0xFF00) >> 8; txData[5] = (length & 0x00FF); static uint16_t crc; crc = mmodbus_crc16(txData, 6); txData[6] = (crc & 0x00FF); txData[7] = (crc & 0xFF00) >> 8; mmodbus_sendRaw(txData, 8, 100); uint16_t recLen = mmodbus_receiveRaw(mmodbus.timeout); if (recLen == 0) return false; if (mmodbus.rxBuf[0] != slaveAddress) return false; if (mmodbus.rxBuf[1] != MModbusCMD_ReadInputRegisters) return false; crc = mmodbus_crc16(mmodbus.rxBuf, mmodbus.rxBuf[2] + 3); if (((crc & 0x00FF) != mmodbus.rxBuf[mmodbus.rxBuf[2] + 3]) || (((crc & 0xFF00) >> 8) != mmodbus.rxBuf[mmodbus.rxBuf[2] + 4])) return false; if (data != NULL) memcpy(data, &mmodbus.rxBuf[3], mmodbus.rxBuf[2]); return true; #endif } // ################################################################################################## bool mmodbus_readInputRegister32f(uint8_t slaveAddress, uint16_t number, float *data) { return mmodbus_readInputRegisters32f(slaveAddress, number, 1, data); } // ################################################################################################## bool mmodbus_readInputRegisters32f(uint8_t slaveAddress, uint16_t startnumber, uint16_t length, float *data) { bool ret = mmodbus_readInputRegisters8i(slaveAddress, startnumber, length * 2, (uint8_t *)data); if (ret == true) { for (uint16_t i = 0; i < length; i++) { uint8_t tmp1[4], tmp2[4]; switch (mmodbus.byteOrder32) { case MModBus_32bitOrder_DCBA: memcpy(tmp1, &data[i], 4); tmp2[0] = tmp1[3]; tmp2[1] = tmp1[2]; tmp2[2] = tmp1[1]; tmp2[3] = tmp1[0]; memcpy(&data[i], tmp2, 4); break; case MModBus_32bitOrder_BADC: memcpy(tmp1, &data[i], 4); tmp2[0] = tmp1[1]; tmp2[1] = tmp1[0]; tmp2[2] = tmp1[3]; tmp2[3] = tmp1[2]; memcpy(&data[i], tmp2, 4); break; case MModBus_32bitOrder_CDAB: memcpy(tmp1, &data[i], 4); tmp2[0] = tmp1[2]; tmp2[1] = tmp1[3]; tmp2[2] = tmp1[0]; tmp2[3] = tmp1[1]; memcpy(&data[i], tmp2, 4); break; default: break; } } return true; } else return false; } // ################################################################################################## bool mmodbus_readInputRegister32i(uint8_t slaveAddress, uint16_t number, uint32_t *data) { return mmodbus_readInputRegisters32i(slaveAddress, number, 1, data); } // ################################################################################################## bool mmodbus_readInputRegisters32i(uint8_t slaveAddress, uint16_t startnumber, uint16_t length, uint32_t *data) { return mmodbus_readInputRegisters32f(slaveAddress, startnumber, length, (float *)data); } // ################################################################################################## bool mmodbus_readInputRegister16i(uint8_t slaveAddress, uint16_t number, uint16_t *data) { return mmodbus_readInputRegisters16i(slaveAddress, number, 1, data); } // ################################################################################################## bool mmodbus_readInputRegisters16i(uint8_t slaveAddress, uint16_t startnumber, uint16_t length, uint16_t *data) { bool ret = mmodbus_readInputRegisters8i(slaveAddress, startnumber, length * 1, (uint8_t *)data); if (ret == true) { uint8_t tmp1[2], tmp2[2]; for (uint16_t i = 0; i < length; i++) { switch (mmodbus.byteOrder16) { case MModBus_16bitOrder_AB: memcpy(tmp1, &data[i], 2); tmp2[0] = tmp1[0]; tmp2[1] = tmp1[1]; memcpy(&data[i], tmp2, 2); break; default: memcpy(tmp1, &data[i], 2); tmp2[0] = tmp1[1]; tmp2[1] = tmp1[0]; memcpy(&data[i], tmp2, 2); break; } } return true; } else return false; } // ################################################################################################## bool mmodbus_readHoldingRegisters8i(uint8_t slaveAddress, uint16_t startnumber, uint16_t length, uint8_t *data) { #if (_MMODBUS_RTU == 1) uint8_t txData[8]; txData[0] = slaveAddress; txData[1] = MModbusCMD_ReadHoldingRegisters; txData[2] = (startnumber & 0xFF00) >> 8; txData[3] = (startnumber & 0x00FF); txData[4] = (length & 0xFF00) >> 8; txData[5] = (length & 0x00FF); static uint16_t crc; crc = mmodbus_crc16(txData, 6); txData[6] = (crc & 0x00FF); txData[7] = (crc & 0xFF00) >> 8; mmodbus_sendRaw(txData, 8, 100); uint16_t recLen = mmodbus_receiveRaw(mmodbus.timeout); if (recLen == 0) return false; if (mmodbus.rxBuf[0] != slaveAddress) return false; if (mmodbus.rxBuf[1] != MModbusCMD_ReadHoldingRegisters) return false; crc = mmodbus_crc16(mmodbus.rxBuf, mmodbus.rxBuf[2] + 3); if (((crc & 0x00FF) != mmodbus.rxBuf[mmodbus.rxBuf[2] + 3]) || (((crc & 0xFF00) >> 8) != mmodbus.rxBuf[mmodbus.rxBuf[2] + 4])) return false; if(TransparentModeFlag) return true; if (data != NULL) { for (uint8_t i = 0; i < mmodbus.rxBuf[2]; i += 2) { uint8_t H = mmodbus.rxBuf[i + 3]; mmodbus.rxBuf[i + 3] = mmodbus.rxBuf[i + 3 + 1]; mmodbus.rxBuf[i + 3 + 1] = H; } memcpy(data, &mmodbus.rxBuf[3], mmodbus.rxBuf[2]); } return true; #endif } // ################################################################################################## bool mmodbus_readHoldingRegister32f(uint8_t slaveAddress, uint16_t number, float *data) { return mmodbus_readHoldingRegisters32f(slaveAddress, number, 1, data); } // ################################################################################################## bool mmodbus_readHoldingRegisters32f(uint8_t slaveAddress, uint16_t startnumber, uint16_t length, float *data) { bool ret = mmodbus_readHoldingRegisters8i(slaveAddress, startnumber, length * 2, (uint8_t *)data); if (ret == true) { for (uint16_t i = 0; i < length; i++) { uint8_t tmp1[4], tmp2[4]; switch (mmodbus.byteOrder32) { case MModBus_32bitOrder_DCBA: memcpy(tmp1, &data[i], 4); tmp2[0] = tmp1[3]; tmp2[1] = tmp1[2]; tmp2[2] = tmp1[1]; tmp2[3] = tmp1[0]; memcpy(&data[i], tmp2, 4); break; case MModBus_32bitOrder_BADC: memcpy(tmp1, &data[i], 4); tmp2[0] = tmp1[1]; tmp2[1] = tmp1[0]; tmp2[2] = tmp1[3]; tmp2[3] = tmp1[2]; memcpy(&data[i], tmp2, 4); break; case MModBus_32bitOrder_CDAB: memcpy(tmp1, &data[i], 4); tmp2[0] = tmp1[2]; tmp2[1] = tmp1[3]; tmp2[2] = tmp1[0]; tmp2[3] = tmp1[1]; memcpy(&data[i], tmp2, 4); break; default: break; } } return true; } else return false; } // ################################################################################################## bool mmodbus_readHoldingRegister32i(uint8_t slaveAddress, uint16_t number, uint32_t *data) { return mmodbus_readHoldingRegisters32i(slaveAddress, number, 1, data); } // ################################################################################################## bool mmodbus_readHoldingRegisters32i(uint8_t slaveAddress, uint16_t startnumber, uint16_t length, uint32_t *data) { return mmodbus_readHoldingRegisters32f(slaveAddress, startnumber, length, (float *)data); } // ################################################################################################## bool mmodbus_readHoldingRegister16i(uint8_t slaveAddress, uint16_t number, uint16_t *data) { return mmodbus_readHoldingRegisters16i(slaveAddress, number, 1, data); } // ################################################################################################## bool mmodbus_readHoldingRegisters16i(uint8_t slaveAddress, uint16_t startnumber, uint16_t length, uint16_t *data) { bool ret = mmodbus_readHoldingRegisters8i(slaveAddress, startnumber, length * 1, (uint8_t *)data); if (ret == true) { uint8_t tmp1[2], tmp2[2]; for (uint16_t i = 0; i < length; i++) { switch (mmodbus.byteOrder16) { case MModBus_16bitOrder_AB: memcpy(tmp1, &data[i], 2); tmp2[0] = tmp1[0]; tmp2[1] = tmp1[1]; memcpy(&data[i], tmp2, 2); break; default: memcpy(tmp1, &data[i], 2); tmp2[0] = tmp1[1]; tmp2[1] = tmp1[0]; memcpy(&data[i], tmp2, 2); break; } } return true; } else return false; } // ################################################################################################## bool mmodbus_writeCoil(uint8_t slaveAddress, uint16_t number, uint8_t data) { #if (_MMODBUS_RTU == 1) uint8_t txData[8]; txData[0] = slaveAddress; txData[1] = MModbusCMD_WriteSingleCoil; txData[2] = (number & 0xFF00) >> 8; txData[3] = (number & 0x00FF); if (data == 0) txData[4] = 0; else txData[4] = 0xFF; txData[5] = 0; static uint16_t crc; crc = mmodbus_crc16(txData, 6); txData[6] = (crc & 0x00FF); txData[7] = (crc & 0xFF00) >> 8; mmodbus_sendRaw(txData, 8, 100); uint16_t recLen = mmodbus_receiveRaw(mmodbus.timeout); if (recLen == 0) return false; if (memcmp(txData, mmodbus.rxBuf, 8) == 0) return true; else return false; #endif #if (_MMODBUS_ASCII == 1) #endif } // ################################################################################################## bool mmodbus_writeHoldingRegister16i(uint8_t slaveAddress, uint16_t number, uint16_t data) { #if (_MMODBUS_RTU == 1) uint8_t txData[8]; txData[0] = slaveAddress; txData[1] = MModbusCMD_WriteSingleRegister; txData[2] = (number & 0xFF00) >> 8; txData[3] = (number & 0x00FF); txData[4] = (data & 0xFF00) >> 8; txData[5] = data & 0x00FF; static uint16_t crc; crc = mmodbus_crc16(txData, 6); txData[6] = (crc & 0x00FF); txData[7] = (crc & 0xFF00) >> 8; mmodbus_sendRaw(txData, 8, 100); uint16_t recLen = mmodbus_receiveRaw(mmodbus.timeout); if (recLen == 0) return false; if (memcmp(txData, mmodbus.rxBuf, 8) == 0) return true; else return false; #endif #if (_MMODBUS_ASCII == 1) #endif } // ################################################################################################## bool mmodbus_writeHoldingRegisters16i(uint8_t slaveAddress, uint16_t startnumber, uint16_t length, uint16_t *data) { #if (_MMODBUS_RTU == 1) if (length == 1) { return mmodbus_writeHoldingRegister16i(slaveAddress, startnumber, data[0]); } else { uint8_t txData[7 + length * 2 + 2]; txData[0] = slaveAddress; txData[1] = MModbusCMD_WriteMultipleRegisters; txData[2] = (startnumber & 0xFF00) >> 8; txData[3] = (startnumber & 0x00FF); txData[4] = (length & 0xFF00) >> 8; txData[5] = (length & 0x00FF); txData[6] = (length * 2); uint8_t tmp1[2], tmp2[2]; for (uint16_t i = 0; i < length; i++) { switch (mmodbus.byteOrder16) { case MModBus_16bitOrder_AB: memcpy(tmp1, &data[i], 2); tmp2[0] = tmp1[1]; tmp2[1] = tmp1[0]; memcpy(&txData[7 + i * 2], tmp2, 2); break; default: memcpy(tmp1, &data[i], 2); tmp2[0] = tmp1[0]; tmp2[1] = tmp1[1]; memcpy(&txData[7 + i * 2], tmp2, 2); break; } } static uint16_t crc; crc = mmodbus_crc16(txData, 7 + length * 2); txData[7 + length * 2 + 0] = (crc & 0x00FF); txData[7 + length * 2 + 1] = (crc & 0xFF00) >> 8; mmodbus_sendRaw(txData, 7 + length * 2 + 2, 100); uint16_t recLen = mmodbus_receiveRaw(mmodbus.timeout); if (recLen == 0) return false; crc = mmodbus_crc16(txData, 6); txData[6] = (crc & 0x00FF); txData[7] = (crc & 0xFF00) >> 8; if (memcmp(txData, mmodbus.rxBuf, 8) == 0) return true; else return false; } #endif #if (_MMODBUS_ASCII == 1) #endif } // ##################################################################################################